| | |
| | | dwt_configure(&config);//é
ç½®DW1000 |
| | | |
| | | |
| | | |
| | | dwt_setinterrupt(DWT_INT_TFRS | DWT_INT_RFCG | (DWT_INT_ARFE | DWT_INT_RFSL | DWT_INT_SFDT | DWT_INT_RPHE | DWT_INT_RFCE | DWT_INT_RFTO | DWT_INT_RXPTO), 1); |
| | | /* Apply default antenna delay value. See NOTE 1 below. */ |
| | | dwt_setrxantennadelay(RX_ANT_DLY); //è®¾ç½®æ¥æ¶å¤©çº¿å»¶è¿ |
| | | dwt_settxantennadelay(TX_ANT_DLY); //设置åå°å¤©çº¿å»¶è¿ |
| | |
| | | poll_rx_ts_32 = (uint32_t)poll_rx_ts;//使ç¨32使°æ®è®¡ç® |
| | | resp_tx_ts_32 = (uint32_t)resp_tx_ts; |
| | | final_rx_ts_32 = (uint32_t)final_rx_ts; |
| | | time_monitor[1] = sync_timer*1000+TIM3->CNT; |
| | | // time_monitor[1] = sync_timer*1000+TIM3->CNT; |
| | | Ra = (double)(resp_rx_ts - poll_tx_ts);//Tround1 = T4 - T1 |
| | | Rb = (double)(final_rx_ts_32 - resp_tx_ts_32);//Tround2 = T6 - T3 |
| | | Da = (double)(final_tx_ts - resp_rx_ts);//Treply2 = T5 - T4 |
| | |
| | | dwt_readdiagnostics(&d1); |
| | | // time_monitor[2] = sync_timer*1000+TIM3->CNT; |
| | | LOS(&d1); |
| | | time_monitor[3] = sync_timer*1000+TIM3->CNT; |
| | | // time_monitor[3] = sync_timer*1000+TIM3->CNT; |
| | | /*--------------------------以ä¸ä¸ºéæµè·é»è¾------------------------*/ |
| | | //dist_cm=33000; |
| | | GPIO_WriteBit(GPIOB, GPIO_Pin_10, Bit_RESET); |
| | |
| | | extern u16 synclost_count; |
| | | uint32_t current_syncid=0xffffffff,synclost_timer; |
| | | extern u8 flag_syncbase,waitsync_flag; |
| | | u8 tagpos_rec[50],tagpos_send[50],ancidlist_num; |
| | | u8 tagpos_rec[50],tagpos_send[50],ancidlist_num,zero_matrix[100]={0}; |
| | | u16 ancidlist_rec[20],ancidlist_send[20]; |
| | | u16 recnearbaselist_id[30]; |
| | | int32_t recnearbaselist_dist[30]; |
| | | int16_t rec_tagheight; |
| | | void Anchor_Start(void) |
| | | { |
| | | dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_ALL_RX_ERR| SYS_STATUS_TXFRS |SYS_STATUS_RXFCG); |
| | | g_start_sync_flag=0; |
| | | |
| | | dwt_setrxtimeout(1000);//è®¾å®æ¥æ¶è¶
æ¶æ¶é´ï¼0使²¡æè¶
æ¶æ¶é´ |
| | | dwt_rxenable(0);//æå¼æ¥æ¶ |
| | | // while (!((status_reg = dwt_read32bitreg(SYS_STATUS_ID)) & (SYS_STATUS_RXFCG | SYS_STATUS_ALL_RX_ERR))&&!g_start_send_flag&&!g_start_sync_flag)//䏿æ¥è¯¢è¯çç¶æç´å°æ¥æ¶æåæè
åºç°é误 |
| | | // { |
| | | // //IdleTask(); |
| | | // }; |
| | | } |
| | | void Anchor_App(void) |
| | | { |
| | | |
| | |
| | | u16 tempid; |
| | | uint32_t rec_syncid; |
| | | |
| | | dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_ALL_RX_ERR| SYS_STATUS_TXFRS |SYS_STATUS_RXFCG); |
| | | g_start_sync_flag=0; |
| | | // dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_ALL_RX_ERR| SYS_STATUS_TXFRS |SYS_STATUS_RXFCG); |
| | | // g_start_sync_flag=0; |
| | | |
| | | dwt_setrxtimeout(0);//è®¾å®æ¥æ¶è¶
æ¶æ¶é´ï¼0使²¡æè¶
æ¶æ¶é´ |
| | | dwt_rxenable(0);//æå¼æ¥æ¶ |
| | | // GPIO_WriteBit(GPIOA, GPIO_Pin_10, Bit_SET); |
| | | while (!((status_reg = dwt_read32bitreg(SYS_STATUS_ID)) & (SYS_STATUS_RXFCG | SYS_STATUS_ALL_RX_ERR))&&!g_start_send_flag&&!g_start_sync_flag)//䏿æ¥è¯¢è¯çç¶æç´å°æ¥æ¶æåæè
åºç°é误 |
| | | { |
| | | IdleTask(); |
| | | }; |
| | | // dwt_setrxtimeout(0);//è®¾å®æ¥æ¶è¶
æ¶æ¶é´ï¼0使²¡æè¶
æ¶æ¶é´ |
| | | // dwt_rxenable(0);//æå¼æ¥æ¶ |
| | | //// GPIO_WriteBit(GPIOA, GPIO_Pin_10, Bit_SET); |
| | | // while (!((status_reg = dwt_read32bitreg(SYS_STATUS_ID)) & (SYS_STATUS_RXFCG | SYS_STATUS_ALL_RX_ERR))&&!g_start_send_flag&&!g_start_sync_flag)//䏿æ¥è¯¢è¯çç¶æç´å°æ¥æ¶æåæè
åºç°é误 |
| | | // { |
| | | // IdleTask(); |
| | | // }; |
| | | status_reg = dwt_read32bitreg(SYS_STATUS_ID); |
| | | //GPIO_WriteBit(GPIOA, GPIO_Pin_10, Bit_RESET); |
| | | if (status_reg & SYS_STATUS_RXFCG)//æåæ¥æ¶ |
| | | { u16 tag_recv_interval; |
| | | float temp_tagpos; |
| | | time_monitor[0] = sync_timer*1000+TIM3->CNT; |
| | | //time_monitor[0] = sync_timer*1000+TIM3->CNT; |
| | | g_Resttimer=0; |
| | | dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_RXFCG);//æ¸
餿 å¿ä½ |
| | | frame_len = dwt_read32bitreg(RX_FINFO_ID) & RX_FINFO_RXFL_MASK_1023;//è·å¾æ¥æ¶æ°æ®é¿åº¦ |
| | |
| | | //if (anchor_type == rx_buffer[ANC_TYPE_IDX]) |
| | | if(dev_id==anc_id_recv) |
| | | { |
| | | taglist_pos=CmpTagInList(tag_id_recv); |
| | | if(taglist_pos==taglist_num) |
| | | { |
| | | taglist_pos=taglist_num; |
| | | tagid_list[taglist_num++]=tag_id_recv; |
| | | |
| | | new_tagid=1; |
| | | }else{ |
| | | new_tagid=0; |
| | | } |
| | | tagofflinetime[taglist_pos]=0; |
| | | |
| | | rec_nearbase_num=rx_buffer[NEARBASENUM_INDEX]; |
| | | if(rec_nearbase_num>=30) |
| | | { |
| | | break; |
| | | } |
| | | battary = rx_buffer[BATTARY_IDX]; |
| | | button = rx_buffer[BUTTON_IDX]; |
| | | frame_seq_nb2 = rx_buffer[SEQUENCE_IDX]; |
| | | tag_frequency = rx_buffer[NEARP_TAGFREQ_INDEX]; |
| | | tag_slotpos = rx_buffer[NEARP_TAGSLOTPOS_INDEX]; |
| | | |
| | | ////////////////åºç«æ±æ»æ¨¡å¼æ°æ® |
| | | memcpy(&rec_tagheight,&rx_buffer[NEARBASEID_INDEX+rec_nearbase_num*6+4],2); |
| | | memcpy(&rec_tagheight,&rx_buffer[NEARBASEID_INDEX+rec_nearbase_num*6],2); |
| | | memcpy(&recnearbaselist_id,&rx_buffer[NEARBASEID_INDEX],rec_nearbase_num*2); |
| | | memcpy(&recnearbaselist_dist,&rx_buffer[NEARBASEID_INDEX+rec_nearbase_num*2],rec_nearbase_num*4+4); |
| | | memcpy(&recnearbaselist_dist,&rx_buffer[NEARBASEID_INDEX+rec_nearbase_num*2],rec_nearbase_num*4); |
| | | usart_send[2] = 0x0c;//æ£å¸¸æ¨¡å¼ |
| | | usart_send[3] = 15+8*(rec_nearbase_num+1);//æ°æ®æ®µé¿åº¦ |
| | | usart_send[3] = 15+8*(rec_nearbase_num);//æ°æ®æ®µé¿åº¦ |
| | | memcpy(&usart_send[4],&tag_id_recv,2); |
| | | usart_send[6] = rx_buffer[SEQUENCE_IDX]; |
| | | usart_send[7] = rx_buffer[SEQUENCEH_IDX]; |
| | |
| | | usart_send[13] = tag_slotpos; |
| | | usart_send[14] = 0; |
| | | usart_send[15] = 0; |
| | | usart_send[16] = rec_nearbase_num+1; |
| | | usart_send[16] = rec_nearbase_num; |
| | | |
| | | memcpy(&usart_send[17],&recnearbaselist_id,2*rec_nearbase_num+2); |
| | | memcpy(&usart_send[19+rec_nearbase_num*2],&recnearbaselist_dist,4*rec_nearbase_num+4); |
| | | |
| | | checksum = Checksum_u16(&usart_send[2],23+8*rec_nearbase_num); |
| | | memcpy(&usart_send[25+8*rec_nearbase_num],&checksum,2); |
| | | UART_PushFrame(usart_send,27+8*rec_nearbase_num); |
| | | memcpy(&usart_send[17],&recnearbaselist_id,2*rec_nearbase_num); |
| | | memcpy(&usart_send[17+rec_nearbase_num*2],&recnearbaselist_dist,4*rec_nearbase_num); |
| | | memcpy(&usart_send[17+rec_nearbase_num*6],zero_matrix,2*rec_nearbase_num); |
| | | |
| | | checksum = Checksum_u16(&usart_send[2],15+8*rec_nearbase_num); |
| | | memcpy(&usart_send[17+8*rec_nearbase_num],&checksum,2); |
| | | UART_PushFrame(usart_send,19+8*rec_nearbase_num); |
| | | Anchor_RecPoll(); |
| | | } |
| | | break; |
| | |
| | | temp_tagpos=round((float)(sync_timer%g_com_map[COM_INTERVAL])/slottime); |
| | | tagpos_rec[(u8)temp_tagpos]=1; |
| | | rec_nearbase_num=rx_buffer[NEARBASENUM_INDEX]; |
| | | if(rec_nearbase_num>30) |
| | | { |
| | | break; |
| | | } |
| | | battary = rx_buffer[BATTARY_IDX]; |
| | | button = rx_buffer[BUTTON_IDX]; |
| | | frame_seq_nb2 = rx_buffer[SEQUENCE_IDX]; |