| | |
| | | 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]; |
| | |
| | | //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]; |
| | | 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; |