From 038ffb0327e40886b4db2eb8b3fcd1653aa264a3 Mon Sep 17 00:00:00 2001 From: zhyinch <zhyinch@gmail.com> Date: 星期五, 29 七月 2022 14:32:15 +0800 Subject: [PATCH] V1.68 去掉时间同步,解决互测距延迟bug --- 源码/核心板/Src/application/dw_app.c | 62 +++++++++++++----------------- 1 files changed, 27 insertions(+), 35 deletions(-) diff --git "a/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/application/dw_app.c" "b/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/application/dw_app.c" index 447970a..f1b6560 100644 --- "a/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/application/dw_app.c" +++ "b/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/application/dw_app.c" @@ -474,14 +474,10 @@ usart_send[2] = 1;//正常模式 usart_send[3] = 17;//数据段长度 usart_send[4] = frame_seq_nb;//数据段长度 - if(g_com_map[DEV_ROLE]) - { + memcpy(&usart_send[5],&dev_id,2); memcpy(&usart_send[7],&rec_nearbaseid,2); - }else{ - 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; usart_send[14] = button; @@ -524,14 +520,10 @@ usart_send[2] = 1;//正常模式 usart_send[3] = 17;//数据段长度 usart_send[4] = frame_seq_nb;//数据段长度 - if(g_com_map[DEV_ROLE]) - { + memcpy(&usart_send[5],&dev_id,2); memcpy(&usart_send[7],&rec_nearbaseid,2); - }else{ - 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; usart_send[14] = button; @@ -1109,29 +1101,29 @@ // Anchor_RecPoll(); // break; case SYNC: - memcpy(&rec_syncid,&rx_buffer[ANCHOR_ID_IDX],4); - if(rec_syncid<current_syncid) - { - current_syncid=rec_syncid; - flag_syncbase=0; - sync_seq=rx_buffer[SYNC_SEQ_IDX]+1; - TIM3->CNT = sync_seq*325%1000+15; - sync_timer = sync_seq*325/1000; - synclost_timer=0; - //SyncPoll(sync_seq,rec_syncid); - }else if(rec_syncid==current_syncid) - { - if(rx_buffer[SYNC_SEQ_IDX]<sync_seq) - { - flag_syncbase=0; - sync_seq=rx_buffer[SYNC_SEQ_IDX]+1; - TIM3->CNT = sync_seq*325%1000+5; - sync_timer = sync_seq*325/1000+995; - synclost_timer=0; - //SyncPoll(sync_seq,rec_syncid); - } - - } +// memcpy(&rec_syncid,&rx_buffer[ANCHOR_ID_IDX],4); +// if(rec_syncid<current_syncid) +// { +// current_syncid=rec_syncid; +// flag_syncbase=0; +// sync_seq=rx_buffer[SYNC_SEQ_IDX]+1; +// TIM3->CNT = sync_seq*325%1000+15; +// sync_timer = sync_seq*325/1000; +// synclost_timer=0; +// //SyncPoll(sync_seq,rec_syncid); +// }else if(rec_syncid==current_syncid) +// { +// if(rx_buffer[SYNC_SEQ_IDX]<sync_seq) +// { +// flag_syncbase=0; +// sync_seq=rx_buffer[SYNC_SEQ_IDX]+1; +// TIM3->CNT = sync_seq*325%1000+5; +// sync_timer = sync_seq*325/1000+995; +// synclost_timer=0; +// //SyncPoll(sync_seq,rec_syncid); +// } +// +// } break; case NEAR_MSG: if(anc_id_recv==flag_syncbase) -- Gitblit v1.9.3