| | |
| | | } |
| | | return i; |
| | | } |
| | | uint8_t uwb_rec_userdata[2]; |
| | | uint8_t Anchor_RecNearPoll(uint8_t ancrec_nearbasepos) //0 mainbase 1 first near_base |
| | | { |
| | | uint8_t motorstate; |
| | |
| | | usart_send[13] = battary; |
| | | usart_send[14] = button; |
| | | usart_send[15] = firstpath_power; |
| | | usart_send[16] = rx_power; |
| | | usart_send[16] = rx_power; |
| | | memcpy(&usart_send[17],&uwb_rec_userdata,2); |
| | | checksum = Checksum_u16(&usart_send[2],17); |
| | | memcpy(&usart_send[19],&checksum,2); |
| | | USART_puts(usart_send,21); |
| | |
| | | memcpy(&anc_id_recv,&rx_buffer[ANCHOR_ID_IDX],2); |
| | | //将收到的tag_id分别写入各次通讯的包中,为多标签通讯服务,防止一次通讯中接收到不同ID标签的数据 |
| | | memcpy(&tag_id_recv,&rx_buffer[TAG_ID_IDX],2); |
| | | memcpy(&uwb_rec_userdata,&rx_buffer[POLL_USERDATA_IDX],2); |
| | | if(group_id== rx_buffer[GROUP_ID_IDX]) |
| | | { |
| | | switch(rx_buffer[MESSAGE_TYPE_IDX]) |