| | |
| | | #define ANC_TYPE_IDX 14 |
| | | #define BATTARY_IDX 15 |
| | | #define BUTTON_IDX 16 |
| | | |
| | | #define SEQUENCE_IDX 17 |
| | | //respose |
| | | #define TIMECORRE 14 |
| | | |
| | |
| | | }; |
| | | |
| | | /* Frames used in the ranging process. See NOTE 2 below. */ |
| | | static uint8_t tx_poll_msg[19] = {0}; |
| | | static uint8_t tx_poll_msg[20] = {0}; |
| | | //static uint8_t rx_resp_msg[] = {0x41, 0x88, 0, 0xCA, 0xDE, 'V', 'E', 'W', 'A', 0x10, 0x02, 0, 0, 0, 0}; |
| | | static uint8_t tx_final_msg[] = {0x41, 0x88, 0, 0xCA, 0xDE, 'W', 'A', 'V', 'E', 0x23, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}; |
| | | |
| | |
| | | uint16_t g_Resttimer; |
| | | uint8_t result; |
| | | u8 tag_succ_times=0; |
| | | u32 hex_dist; |
| | | int32_t hex_dist; |
| | | u16 checksum; |
| | | int8_t tag_delaytime; |
| | | void Tag_App(void)//å鿍¡å¼(TAGæ ç¾) |
| | |
| | | tag_succ_times = 0; |
| | | tx_poll_msg[BATTARY_IDX] = Get_Battary(); |
| | | tx_poll_msg[BUTTON_IDX] = !READ_KEY0; |
| | | tx_poll_msg[SEQUENCE_IDX] = frame_seq_nb++; |
| | | |
| | | for(i=0;i<g_com_map[MAX_REPORT_ANC_NUM];i++) |
| | | { |
| | |
| | | |
| | | usart_send[2] = 1;//æ£å¸¸æ¨¡å¼ |
| | | usart_send[3] = 17;//æ°æ®æ®µé¿åº¦ |
| | | usart_send[4] = frame_seq_nb++;//æ°æ®æ®µé¿åº¦ |
| | | 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];; |
| | |
| | | |
| | | if (rx_buffer[MESSAGE_TYPE_IDX] == POLL&&(anchor_type == rx_buffer[ANC_TYPE_IDX])) //夿æ¯å¦æ¯pollå
æ°æ® |
| | | { |
| | | correction_time=tag_timer-(tag_id_recv%GROUP_TAG_NUM)*3; |
| | | correction_time=tag_timer-tag_id_recv*3; |
| | | if(correction_time == g_com_map[COM_INTERVAL]) |
| | | correction_time = 0; |
| | | tx_resp_msg[TIMECORRE] = correction_time; |
| | |
| | | |
| | | battary = rx_buffer[BATTARY_IDX]; |
| | | button = rx_buffer[BUTTON_IDX]; |
| | | frame_seq_nb = rx_buffer[SEQUENCE_IDX]; |
| | | /* We assume that the transmission is achieved correctly, now poll for reception of expected "final" frame or error/timeout. |
| | | * See NOTE 7 below. */ |
| | | if(result==0) |
| | |
| | | |
| | | usart_send[2] = 1;//æ£å¸¸æ¨¡å¼ |
| | | usart_send[3] = 17;//æ°æ®æ®µé¿åº¦ |
| | | usart_send[4] = frame_seq_nb++;//æ°æ®æ®µé¿åº¦ |
| | | usart_send[4] = frame_seq_nb;//æ°æ®æ®µé¿åº¦ |
| | | memcpy(&usart_send[5],&tag_id_recv,2); |
| | | memcpy(&usart_send[7],&dev_id,2); |
| | | hex_dist = dist_cm; |
| | | |
| | | memcpy(&usart_send[9],&hex_dist,4); |
| | | usart_send[13] = battary; |
| | | usart_send[14] = button; |