| | |
|---|
| | | #define FINAL_MSG_RESP_RX_TS_IDX 14 |
|---|
| | | #define FINAL_MSG_FINAL_TX_TS_IDX 18 |
|---|
| | | #define DELAY_DEFAULT 1000 |
|---|
| | | #define DELAY_BETWEEN_TWO_FRAME_UUS 400 |
|---|
| | | #define DELAY_BETWEEN_TWO_FRAME_UUS 1400 |
|---|
| | | #define HALF_SECOND_TIME 62400000 |
|---|
| | | |
|---|
| | | static uint16_t CmpTagInList(uint16_t tagid); |
|---|
| | |
|---|
| | | resp_rx_num++; |
|---|
| | | freq_offset=phy_freq_offset_get(); |
|---|
| | | freq_offset_filter=average_filter(freq_offset);//获取频偏 |
|---|
| | | int32_t ppm = freq_offset_filter / (int32_t)(ch_center_freq_map[UWB_CH_NUM] * 1e-6); |
|---|
| | | calib_xtal38m4_load_cap_auto_tune(ppm);//利用电容调整晶振适配频偏应在完整的一包之后调整，需要关闭XTAL_AUTO_TUNE_EN 宏定义避免收包中途校准导致测距错误 |
|---|
| | | // int32_t ppm = freq_offset_filter / (int32_t)(ch_center_freq_map[UWB_CH_NUM] * 1e-6); |
|---|
| | | // calib_xtal38m4_load_cap_auto_tune(ppm);//利用电容调整晶振适配频偏应在完整的一包之后调整，需要关闭XTAL_AUTO_TUNE_EN 宏定义避免收包中途校准导致测距错误 |
|---|
| | | //LOG_INFO(TRACE_MODULE_APP, "poll_tx_num is %d,resp_rx_num is %d,distance is %lf\r\n",poll_tx_num,resp_rx_num,distance); |
|---|
| | | receive_flag=1; |
|---|
| | | |
|---|
| | |
|---|
| | | } |
|---|
| | | //gpio_pin_clr(IO_PIN_5);//测试 |
|---|
| | | } |
|---|
| | | //dwt_forecetrxoff(); |
|---|
| | | delay_us(1); |
|---|
| | | uwb_rx_force_off(1); |
|---|
| | | CalculateDists(poll_tx_ts_i64); //计算距离并更新距离表 |
|---|
| | | AnchorListUpdate();//更新存活基站列表 |
|---|
| | | Rank_ANchor_list_by_dis();//冒泡排序重新按距离重新排列基站列表最小距离存货基站放到最前面 |
|---|
| | | LOG_INFO(TRACE_MODULE_APP,"基站ID：%X,距离: %lf\r\n",rec_nearbaseid,distance_tag); |
|---|
| | | LOG_INFO(TRACE_MODULE_APP,"基站ID：%X,距离: %d\r\n",rec_nearbaseid,nearbase_distlist[0]); |
|---|
| | | } |
|---|
| | | |
|---|
| | | |
|---|
