| | |
| | | #include "Usart.h" |
| | | #include "global_param.h" |
| | | #include "filters.h" |
| | | #include <stdio.h> |
| | | |
| | | |
| | | |
| | |
| | | } |
| | | void Dw1000_App_Init(void) |
| | | { |
| | | g_com_map[DEV_ID]=0x03; |
| | | // g_com_map[DEV_ID] = 0x02; |
| | | tx_poll_msg[MESSAGE_TYPE_IDX]=POLL; |
| | | tx_resp_msg[MESSAGE_TYPE_IDX]=RESPONSE; |
| | | tx_final_msg[MESSAGE_TYPE_IDX]=FINAL; |
| | |
| | | tx_resp_msg[TAG_ID_IDX] = tag_id_recv; |
| | | |
| | | |
| | | if (rx_buffer[MESSAGE_TYPE_IDX] == POLL) //夿æ¯å¦æ¯pollå
æ°æ® |
| | | if (rx_buffer[MESSAGE_TYPE_IDX] == POLL&&tag_id_recv!= g_com_map[DEV_ID]) //夿æ¯å¦æ¯pollå
æ°æ® |
| | | { |
| | | /* Retrieve poll reception timestamp. */ |
| | | poll_rx_ts = get_rx_timestamp_u64();//è·å¾Pollå
æ¥æ¶æ¶é´T2 |
| | |
| | | dis_after_filter=dist_cm; |
| | | g_Tagdist[tag_id_recv]=dist_cm; |
| | | g_flag_Taggetdist[tag_id_recv]=0; |
| | | printf("Anchor ID: %d, Tag ID: %d, Dist = %d cm\n", g_com_map[DEV_ID], tag_id_recv, (uint16_t)dis_after_filter); |
| | | //dis_after_filter = LP_Frac_Update(p_Dis_Filter, dist_cm); |
| | | |
| | | } |