From dd419489dbf20d52ec89e7d280b0c1bbfbdbaef6 Mon Sep 17 00:00:00 2001 From: yincheng.zhong <634916154@qq.com> Date: 星期四, 03 八月 2023 16:15:18 +0800 Subject: [PATCH] V2.5 --- Src/application/dw_app.c | 32 ++++++++++++++++++++------------ 1 files changed, 20 insertions(+), 12 deletions(-) diff --git a/Src/application/dw_app.c b/Src/application/dw_app.c index 7f10309..896be93 100644 --- a/Src/application/dw_app.c +++ b/Src/application/dw_app.c @@ -29,7 +29,7 @@ #include <stdio.h> #include "beep.h" #include "modbus.h" - +#include "BMP390.h" /*------------------------------------ Marcos ------------------------------------------*/ /* Inter-ranging delay period, in milliseconds. */ #define RNG_DELAY_MS 100 @@ -81,7 +81,7 @@ SINGLEPOLL, }tag_state=STARTPOLL; dwt_config_t config = { - 2, /* Channel number. */ + 5, /* Channel number. */ DWT_PRF_64M, /* Pulse repetition frequency. */ DWT_PLEN_128, /* Preamble length. */ DWT_PAC8, /* Preamble acquisition chunk size. Used in RX only. */ @@ -118,7 +118,7 @@ LPFilter_Frac* p_Dis_Filter; //测距用的低通滤波器 - +void GetNearMsg(void); static uint64_t get_tx_timestamp_u64(void) { uint8_t ts_tab[5]; @@ -185,6 +185,7 @@ /* Apply default antenna delay value. See NOTE 1 below. */ dwt_setrxantennadelay(RX_ANT_DLY); //设置接收天线延迟 dwt_settxantennadelay(TX_ANT_DLY); //设置发射天线延迟 + /* Set expected response's delay and timeout. See NOTE 4 and 5 below. * As this example only handles one incoming frame with always the same delay and timeout, those values can be set here once for all. */ //设置接收超时时间 @@ -609,8 +610,9 @@ if(minddist!=0x1ffff&&minddist!=0) { trygetnearmsg_times = 0; - tag_state = GETNEARMSG; + tag_state = GETNEARMSG; mainbase_id = mindist_ancid; + GetNearMsg(); } if(getsync_flag==0) @@ -1054,7 +1056,7 @@ } nearbase_distlist[rec_nearbasepos+1]=temp_dist; // nearbase_distlist[1]对应 rec_nearbaseid[0]的距离 final_msg_set_ts(&tx_near_msg[FINAL_MSG_RESP_RX_NEARBASE_IDX+(rec_nearbasepos)*4], resp_rx_ts); - if(temp_dist<salvebase_mindist&&nearbase_switchdistlist[rec_nearbasepos]!=0&&(nearbase_switchdistlist[rec_nearbasepos]==1||temp_dist<nearbase_switchdistlist[rec_nearbasepos])) + if(temp_dist<salvebase_mindist&&nearbase_switchdistlist[rec_nearbasepos]!=0&&(nearbase_switchdistlist[rec_nearbasepos]==1||temp_dist<nearbase_switchdistlist[rec_nearbasepos])) { salvebase_mindist = temp_dist; mindist_slavebaseid = rec_nearbaseid; @@ -1095,10 +1097,11 @@ changemainbase_count++; if(changemainbase_count>2) { - changemainbase_count = 0; - mainbase_id = mindist_slavebaseid; - tag_state = GETNEARMSG; - trygetnearmsg_times = 0; + changemainbase_count = 0; + mainbase_id = mindist_slavebaseid; + tag_state = GETNEARMSG; + trygetnearmsg_times = 0; + GetNearMsg(); } }else{ changemainbase_count = 0; @@ -1108,6 +1111,7 @@ { mainbase_lost_count = 0; tag_state = DISCPOLL; + DiscPoll(); } if(mainbase_lost_count!=0) { @@ -1168,6 +1172,7 @@ if(nearbaseid_list[i]!=nearbaseid_list2[i]) { tag_state = GETNEARMSG; + GetNearMsg(); trygetnearmsg_times = 0; nearbaseid_list0[i]=1; } @@ -1264,8 +1269,8 @@ } } u32 id,error_times=0; - extern float Height; +extern float Altitude; void Tag_App(void)//发送模式(TAG标签) { @@ -1293,6 +1298,7 @@ LED_LG_ON; Registor_Poll(); LED_LG_OFF; +// GetPressAndHeight(); break; case DISCPOLL: LED_LG_ON; @@ -1311,13 +1317,15 @@ break; case NEARPOLL: NearPoll(); - //GetPressAndHeight(); - //intheight = Height*100; + GetPressAndHeight(); + intheight =Altitude*100; break; case SINGLEPOLL: // Poll(); break; } + GetPressAndHeight(); + intheight =Altitude*100; userkey_state = !GET_USERKEY; dwt_forcetrxoff(); dwt_setinterrupt( DWT_INT_RFCG | (DWT_INT_ARFE | DWT_INT_RFSL | DWT_INT_SFDT | DWT_INT_RPHE | DWT_INT_RFCE | DWT_INT_RFTO | DWT_INT_RXPTO), 1); -- Gitblit v1.9.3