| | |
| | | dwt_configuresleep(0x940, 0x7); |
| | | dwt_entersleep(); |
| | | } |
| | | uint16_t g_Resttimer; |
| | | uint8_t result; |
| | | void Tag_App(void)//å鿍¡å¼(TAGæ ç¾) |
| | | { |
| | | uint32_t frame_len; |
| | | uint32_t final_tx_time; |
| | | |
| | | g_Resttimer=0; |
| | | UART_CheckReceive(); |
| | | GPIO_ResetBits(SPIx_GPIO, SPIx_CS); |
| | | delay_us(2500); |
| | | GPIO_SetBits(SPIx_GPIO, SPIx_CS); |
| | |
| | | dwt_entersleep(); |
| | | |
| | | } |
| | | uint16_t g_Resttimer; |
| | | extern uint8_t g_pairstart; |
| | | void Anchor_App(void) |
| | | { |
| | | uint32_t frame_len; |
| | |
| | | while (!((status_reg = dwt_read32bitreg(SYS_STATUS_ID)) & (SYS_STATUS_RXFCG | SYS_STATUS_ALL_RX_ERR)))//䏿æ¥è¯¢è¯çç¶æç´å°æ¥æ¶æåæè
åºç°é误 |
| | | { |
| | | UART_CheckReceive(); |
| | | UART_CheckSend(); |
| | | g_Resttimer=0; |
| | | }; |
| | | |
| | |
| | | tx_resp_msg[TAG_ID_IDX] = tag_id_recv; |
| | | |
| | | |
| | | if (rx_buffer[MESSAGE_TYPE_IDX] == POLL&&tag_id_recv!= g_com_map[DEV_ID]) //夿æ¯å¦æ¯pollå
æ°æ® |
| | | if (rx_buffer[MESSAGE_TYPE_IDX] == POLL&&tag_id_recv!= g_com_map[PAIR_ID]) //夿æ¯å¦æ¯pollå
æ°æ® |
| | | { |
| | | /* Retrieve poll reception timestamp. */ |
| | | poll_rx_ts = get_rx_timestamp_u64();//è·å¾Pollå
æ¥æ¶æ¶é´T2 |
| | |
| | | g_UWB_com_interval = 0; |
| | | dis_after_filter=dist_cm; |
| | | g_Tagdist[tag_id_recv]=dist_cm; |
| | | if(g_pairstart==1&&dist_cm<20) |
| | | { |
| | | g_pairstart=0; |
| | | g_com_map[PAIR_ID]=tag_id_recv; |
| | | save_com_map_to_flash(); |
| | | printf("Pair Finish PairID: %d. \r\n",g_com_map[PAIR_ID]); |
| | | } |
| | | 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); |