From ce4dd5cba076e7ae21faffcc02ab0bf08d1b0949 Mon Sep 17 00:00:00 2001 From: yincheng.zhong <634916154@qq.com> Date: 星期二, 22 八月 2023 16:33:01 +0800 Subject: [PATCH] 修改uwb文件逻辑,方便移植 --- Src/application/dw_app.h | 78 ++++++++++++++++++++++++++++++++++----- 1 files changed, 68 insertions(+), 10 deletions(-) diff --git a/Src/application/dw_app.h b/Src/application/dw_app.h index e655a38..56ea256 100644 --- a/Src/application/dw_app.h +++ b/Src/application/dw_app.h @@ -8,15 +8,20 @@ #include "ADC.h" #include "TrackingDiff.h" -//#define WORK_MODE_TAG -#define WORK_MODE_ANCHOR +//BITSTATE +#define GOINGSLEEPBIT 1 //#define NEWBOARD //#define TAG_OUTPUT +#define MAX_RFPOWER 67 +#define DEFAULT_RFPOWER 30 +#define REGISTER_FREQUENCY 1 #define HEX_OUTPUT - +#define TOTAL_SLOTNUM 200 +#define SLOTTIME_MS 48 +#define SLOT_SCALE 0.55 #define MAX_NEARBASE_NUM 12 -#define KEEP_TIMES 5 +#define KEEP_TIMES 3 #define REPOET_ANC_NUM 1 #define REPOET_ANC_NUM_MIN 1 @@ -27,6 +32,8 @@ #define THRESHOLD_CHANGE_MAINBASE_DIST 50 #define MIN_ANCHOR_NUM 2 #define SYNC_SEQ_IDX 5 +#define REMOTEPARA_LEN 18 +#define OUTRANGE_RESTARTTIMES 5 #define POLL 0x01 @@ -37,19 +44,50 @@ #define NEAR_POLL 0x06 #define NEAR_RESPONSE 0x07 #define NEAR_FINAL 0x08 +#define SPOLL 0x09 + +#define DISCOVERPOLL 0x0A +#define DISCOVERRESPONSE 0x0B +#define DISCOVERFINAL 0x0C + +#define DISCOVERPOLL2 0x1A + + +#define POS_MSG 0x15 +#define POS_POLL 0x16 +#define POS_RESPONSE 0x17 +#define POS_FINAL 0x18 + +#define REG_POLL 0x10 // +#define REG_RESPONSE 0x11 // +#define REG_POLL2 0x20 // //General #define GROUP_ID_IDX 0 #define ANCHOR_ID_IDX 1 #define TAG_ID_IDX 5 -#define MESSAGE_TYPE_IDX 9 +#define MESSAGE_TYPE_IDX 9 +#define POLL_USERDATA_IDX 32 +#define NEARBASENUM_INDEX 18 +#define NEARBASEID_INDEX 19 //Poll +#define TAGSTATE 7 #define ANC_TYPE_IDX 14 //respose #define DIST_IDX 10 #define ANCTIMEMS 14 #define ANCTIMEUS 16 #define TAGSLOTPOS 7 +#define MOTORSTATE_INDEX 19 +#define NR_NEARSWITCH_DISTANCE 20 +#define REMOTEPARA_INDEX 22 +#define MAXRANGE_DISTANCE 22 +#define ANC_SIGNALPOWER 24 +#define RESP_MSG_POLL_RX_TS_IDX 26 +#define RESP_MSG_RESP_TX_TS_IDX 30 +#define RESP_MSG_ANC_DISTOFFSET 34 + //Final +#define TAGCONFIGSUCCESS_INDEX 7 #define FINAL_MSG_POLL_TX_TS_IDX 10 #define FINAL_MSG_RESP_RX_TS_IDX 14 #define FINAL_MSG_FINAL_TX_TS_IDX 18 @@ -59,12 +97,31 @@ #define SYNC_SEQ_IDX 5 //NEAR MSG #define NEARMSG_EMPTYSLOTPOS_INDEX 1 //RESPONSE -#define NEARBASENUM_INDEX 10 -#define NEARBASEID_INDEX 11 //NEAR POLL -#define BATTARY_IDX 1 -#define BUTTON_IDX 2 +#define NEARP_TAGFREQ_INDEX 10 +#define NEARP_TAGSLOTPOS_INDEX 12 + + +//REG POLL +#define REGP_TAGSTATE_INDEX 10 +#define REGP_VERSION_INDEX 11 +#define REGP_FREQUENCY_INDEX 13 +#define REGP_POWER_INDEX 14 +#define REGP_IMUTHRES_INDEX 15 +#define REGP_NOMOVESLEEPTIME_INDEX 17 +#define REGP_HEIGHTOFFSET_INDEX 19 +#define REGP_BATTARY_INDEX 19 +//REG RESPONSE +#define REGR_TAGFREQ_INDEX 10 +#define REGR_TAGSLOTPOS_INDEX 12 +#define REGR_BASENUM_INDEX 18 +#define REGR_BASEID_INDEX 19 + + #define SEQUENCE_IDX 3 +#define BATTARY_IDX 4 +#define BUTTON_IDX 7 +#define SEQUENCEH_IDX 8 #define DW_CTRL_GPIO GPIOA #define DW_ENABLE HAL_GPIO_WritePin(DW_CTRL_GPIO, DW_CTRL_Pin, GPIO_PIN_RESET) @@ -80,7 +137,7 @@ extern uint32_t g_UWB_com_interval; extern float dis_after_filter; -extern uint8_t usart_send[25]; +extern uint8_t usart_send[40]; void IdleTask(void); uint16_t Checksum_u16(uint8_t* pdata, uint32_t len); @@ -92,4 +149,5 @@ extern void TagDistClear(void); void Dw1000_App_Init(void); +void DelayOneSlot(void); #endif -- Gitblit v1.9.3