| | |
| | | } |
| | | u8 test=0; |
| | | u8 anclost_times=0; |
| | | u8 exsistbase_list[MAX_NEARBASE_NUM],report_num,get_newbase=0; |
| | | u8 exsistbase_list[MAX_NEARBASE_NUM],report_num,get_newbase=0,rec_extratag_battary; |
| | | u16 temp_sync_timer1,temp_sync_timer2,rec_extratag_id; |
| | | int32_t rec_extratag_dist; |
| | | void NearPoll(void) |
| | |
| | | memcpy(&rec_extratag_dist,&rx_buffer[EXTRA_TAGDIST_INDEX],4); |
| | | |
| | | memcpy(&temp_dist,&rx_buffer[DIST_IDX],4); |
| | | temp_dist = temp_dist&0xffffff; |
| | | rec_extratag_dist = rec_extratag_dist&0xffffff; |
| | | |
| | | nearbase_distlist[rec_nearbasepos]=temp_dist; |
| | | if(temp_dist!=0x1ffff) |
| | | exsistbase_list[rec_nearbasepos]=KEEP_TIMES; |
| | |
| | | memcpy(&usart_send[5],&rec_nearbaseid,2); |
| | | memcpy(&usart_send[7],&dev_id,2); |
| | | } |
| | | memcpy(&usart_send[9],&rx_buffer[DIST_IDX],4); |
| | | usart_send[13] = battary; |
| | | memcpy(&usart_send[9],&temp_dist,4); |
| | | usart_send[13] = rx_buffer[DIST_IDX+3]; |
| | | usart_send[14] = button; |
| | | checksum = Checksum_u16(&usart_send[2],17); |
| | | memcpy(&usart_send[19],&checksum,2); |
| | |
| | | memcpy(&usart_send[7],&rec_extratag_id,2); |
| | | } |
| | | memcpy(&usart_send[9],&rec_extratag_dist,4); |
| | | usart_send[13] = battary; |
| | | usart_send[13] = rx_buffer[EXTRA_TAGDIST_INDEX+3]; |
| | | usart_send[14] = button; |
| | | checksum = Checksum_u16(&usart_send[2],17); |
| | | memcpy(&usart_send[19],&checksum,2); |
| | |
| | | memcpy(&rec_extratag_id,&rx_buffer[EXTRA_TAGID_INDEX],2); |
| | | memcpy(&rec_extratag_dist,&rx_buffer[EXTRA_TAGDIST_INDEX],4); |
| | | memcpy(&temp_dist,&rx_buffer[DIST_IDX],4); |
| | | temp_dist = temp_dist&0xffffff; |
| | | rec_extratag_dist = rec_extratag_dist&0xffffff; |
| | | nearbase_distlist[rec_nearbasepos]=temp_dist; |
| | | |
| | | if(temp_dist!=0x1ffff) |
| | |
| | | memcpy(&usart_send[5],&rec_nearbaseid,2); |
| | | memcpy(&usart_send[7],&dev_id,2); |
| | | } |
| | | memcpy(&usart_send[9],&rx_buffer[DIST_IDX],4); |
| | | usart_send[13] = battary; |
| | | memcpy(&usart_send[9],&temp_dist,4); |
| | | usart_send[13] = rx_buffer[DIST_IDX+3]; //çµééæå°è·ç¦»éé¢è¾åºäº |
| | | usart_send[14] = button; |
| | | checksum = Checksum_u16(&usart_send[2],17); |
| | | memcpy(&usart_send[19],&checksum,2); |
| | |
| | | }else{ |
| | | memcpy(&usart_send[5],&rec_nearbaseid,2); |
| | | memcpy(&usart_send[7],&rec_extratag_id,2); |
| | | } |
| | | } |
| | | memcpy(&usart_send[9],&rec_extratag_dist,4); |
| | | usart_send[13] = battary; |
| | | usart_send[13] = rx_buffer[EXTRA_TAGDIST_INDEX+3]; |
| | | usart_send[14] = button; |
| | | checksum = Checksum_u16(&usart_send[2],17); |
| | | memcpy(&usart_send[19],&checksum,2); |
| | |
| | | tx_nearresp_msg[GROUP_ID_IDX] = group_id; |
| | | tx_nearresp_msg[MAINBASE_INDEX]=flag_syncbase; |
| | | tx_nearresp_msg[MESSAGE_TYPE_IDX]=NEAR_RESPONSE; |
| | | tx_nearresp_msg[MOTORSTATE_INDEX]=(remotesend_state<<4)|motorstate; |
| | | if(remotesend_state) |
| | | { |
| | | memcpy(&tx_nearresp_msg[REMOTEPARA_INDEX],remotetag_para,REMOTEPARA_LEN); |
| | | dwt_writetxdata(22+REMOTEPARA_LEN, tx_nearresp_msg, 0);//åå
¥åéæ°æ® |
| | | dwt_writetxfctrl(22+REMOTEPARA_LEN, 0);//设å®åéé¿åº¦ |
| | | }else{ |
| | | tx_nearresp_msg[MOTORSTATE_INDEX]=0;//(remotesend_state<<4)|motorstate; |
| | | // if(remotesend_state) |
| | | // { |
| | | // memcpy(&tx_nearresp_msg[REMOTEPARA_INDEX],remotetag_para,REMOTEPARA_LEN); |
| | | // dwt_writetxdata(22+REMOTEPARA_LEN, tx_nearresp_msg, 0);//åå
¥åéæ°æ® |
| | | // dwt_writetxfctrl(22+REMOTEPARA_LEN, 0);//设å®åéé¿åº¦ |
| | | // }else{ |
| | | if(taglist_pos==1) |
| | | { |
| | | memcpy(&tx_nearresp_msg[EXTRA_TAGID_INDEX], &tagid_list[0], 2); |
| | |
| | | } |
| | | dwt_writetxdata(28, tx_nearresp_msg, 0);//åå
¥åéæ°æ® |
| | | dwt_writetxfctrl(28, 0);//设å®åéé¿åº¦ |
| | | } |
| | | // } |
| | | result = dwt_starttx(DWT_START_TX_DELAYED | DWT_RESPONSE_EXPECTED);//å»¶è¿åéï¼çå¾
æ¥æ¶ |
| | | |
| | | |
| | |
| | | if(tagdist_list[taglist_pos]<=0) |
| | | tagdist_list[taglist_pos]=10; |
| | | memcpy(&usart_send[9],&tagdist_list[taglist_pos],4); |
| | | tagdist_list[taglist_pos] =tagdist_list[taglist_pos]| (battary<<24); |
| | | usart_send[13] = battary; |
| | | usart_send[14] = button; |
| | | usart_send[15] = firstpath_power; |
| | |
| | | memcpy(&tag_id_recv,&rx_buffer[TAG_ID_IDX],2); |
| | | memcpy(&rec_ancidlist,&rx_buffer[NEARBASEID_INDEX],2*rec_nearbase_num); |
| | | memcpy(&rec_ancdistlist,&rx_buffer[NEARBASEID_INDEX+2*rec_nearbase_num],2*rec_nearbase_num); |
| | | memcpy(&rec_antdelay,&rx_buffer[NEARBASEID_INDEX+nearbase_num*4],2); |
| | | memcpy(&rec_antdelay,&rx_buffer[NEARBASEID_INDEX+rec_nearbase_num*4],2); |
| | | #ifdef USART_ALL_OUTPUT |
| | | usart_send[2] = 0x0c;//æ£å¸¸æ¨¡å¼ |
| | | usart_send[3] = 8+rec_nearbase_num*4;//æ°æ®æ®µé¿åº¦ |