| | |
| | | int8_t tag_delaytime; |
| | | extern uint16_t sync_timer; |
| | | u16 tmp_time; |
| | | int32_t temp_dist; |
| | | void Tag_App(void)//å鿍¡å¼(TAGæ ç¾) |
| | | { |
| | | uint32_t frame_len; |
| | |
| | | for(i=0;i<g_com_map[MAX_REPORT_ANC_NUM];i++) |
| | | { |
| | | /* Write frame data to DW1000 and prepare transmission. See NOTE 7 below. */ |
| | | tx_poll_msg[ANC_TYPE_IDX] = i-1; |
| | | tx_poll_msg[ANC_TYPE_IDX] = i; |
| | | |
| | | dwt_writetxdata(sizeof(tx_poll_msg), tx_poll_msg, 0);//å°Pollå
æ°æ®ä¼ ç»DW1000ï¼å°å¨å¼å¯åéæ¶ä¼ åºå» |
| | | dwt_writetxfctrl(sizeof(tx_poll_msg), 0);//设置è¶
宽带åéæ°æ®é¿åº¦ |
| | |
| | | tag_succ_times++; |
| | | |
| | | LED0_BLINK; |
| | | |
| | | // temp_dist=anchor_dist_last_frm[0]; |
| | | // if(anchor_dist_last_frm[0]>1000000) |
| | | // { |
| | | // temp_dist=anchor_dist_last_frm[0]-0xffffffff; |
| | | // temp_dist+=0xffff; |
| | | // anchor_dist_last_frm[0]=temp_dist; |
| | | // } |
| | | |
| | | |
| | | usart_send[2] = 1;//æ£å¸¸æ¨¡å¼ |
| | | usart_send[3] = 17;//æ°æ®æ®µé¿åº¦ |
| | | usart_send[4] = frame_seq_nb;//æ°æ®æ®µé¿åº¦ |
| | | memcpy(&usart_send[5],&dev_id,2); |
| | | memcpy(&usart_send[7],&rx_buffer[ANCHOR_ID_IDX],2); |
| | | hex_dist = anchor_dist_last_frm[0];; |
| | | hex_dist = anchor_dist_last_frm[0]+(int16_t)g_com_map[DIST_OFFSET]; |
| | | memcpy(&usart_send[9],&hex_dist,4); |
| | | usart_send[13] = battary; |
| | | usart_send[14] = button; |
| | |
| | | // dist[TAG_ID] = LP(dis, TAG_ID); //LP 为ä½é滤波å¨ï¼è®©æ°æ®æ´ç¨³å® |
| | | |
| | | /*--------------------------以ä¸ä¸ºéæµè·é»è¾------------------------*/ |
| | | //dist_cm=33000; |
| | | |
| | | LED0_BLINK; //æ¯æå䏿¬¡é讯åéªç䏿¬¡ |
| | | g_UWB_com_interval = 0; |
| | | dis_after_filter=dist_cm; |