From 2e872c0c712d5ea0cb9eccb84291fba9c39265a8 Mon Sep 17 00:00:00 2001 From: yincheng.zhong <634916154@qq.com> Date: 星期二, 30 五月 2023 12:47:30 +0800 Subject: [PATCH] 1 --- Src/application/dw_ancapp.c | 11 ++++++++--- 1 files changed, 8 insertions(+), 3 deletions(-) diff --git a/Src/application/dw_ancapp.c b/Src/application/dw_ancapp.c index 88b0bae..1aa0f5c 100644 --- a/Src/application/dw_ancapp.c +++ b/Src/application/dw_ancapp.c @@ -60,7 +60,8 @@ static uint64_t final_rx_ts; static uint32_t status_reg = 0; extern uint8_t tx_near_msg[80]; -static uint8_t motor_state,result; +uint8_t motor_state; +static u8 result; static uint64_t get_tx_timestamp_u64(void) { uint8_t ts_tab[5]; @@ -108,7 +109,7 @@ *ts += ts_field[i] << (i * 8); } } -u8 send_buffer[100]; +u8 send_buffer[100],outside_count; #define FZ_NEARBASENUM_INDEX 10 #define FZ_NEARBASEID_INDEX 11 void FZNearPoll(void) @@ -352,7 +353,11 @@ memcpy(&usart_send[4+report_num*6],&checksum,2); USART_puts(usart_send,6+report_num*6); #endif - + if(motor_state==2) + {outside_count=0; + }else{ + outside_count++; + } for(i=0;i<MAX_NEARBASE_NUM;i++) { nearbase_distlist[i]=0x1ffff; -- Gitblit v1.9.3