From 9b5beb905d2c3846b912adcce8051ce4ea3377de Mon Sep 17 00:00:00 2001 From: zhyinch <zhyinch@gmail.com> Date: 星期一, 13 一月 2020 22:09:52 +0800 Subject: [PATCH] v1.18 标签可调距离补偿 第一个测距信息bug --- 源码/核心板/Src/main.c | 18 +++++++++++++++--- 1 files changed, 15 insertions(+), 3 deletions(-) diff --git "a/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/main.c" "b/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/main.c" index ec26f99..260c956 100644 --- "a/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/main.c" +++ "b/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/main.c" @@ -11,6 +11,7 @@ #include "global_param.h" #include "ADC.h" +//#define DEBUG_MODE void Device_Init(void) { @@ -44,6 +45,7 @@ memcpy(&hbsend[14],&checksum,2); } u16 tyncpoll_time; +TrackingDiffClass *pUWBDistanceTrackingDiff; void Program_Init(void) {uint16_t i; float temp; @@ -52,19 +54,29 @@ parameter_init(); //deca_sleep(1000); HeartBeatInit(); - dev_id = g_com_map[DEV_ID]; // g_com_map[DEV_ROLE]=1; // g_com_map[DEV_ID]=1; // g_com_map[COM_INTERVAL]=10; OUT485_ENABLE; - g_com_map[VERSION] = 0x0107; + +#ifdef DEBUG_MODE + + g_com_map[COM_INTERVAL]=50; + g_com_map[MAX_REPORT_ANC_NUM]=3; + g_com_map[DEV_ID]=1; + g_com_map[ANC_POLL]=0; + g_com_map[ALARM_DISTANCE1]=100; +#endif + //pUWBDistanceTrackingDiff = NewTrackingDiffClass(2, 4, 0.03); + dev_id = g_com_map[DEV_ID]; + g_com_map[VERSION] = 0x0112; temp=(float)g_com_map[MAX_REPORT_ANC_NUM]*4/3; temp2=g_com_map[DEV_ID]*g_com_map[MAX_REPORT_ANC_NUM]*4/3; if(temp2<temp) { temp2++; } - tyncpoll_time=g_com_map[DEV_ID]*(temp2); + tyncpoll_time=g_com_map[DEV_ID]*(temp2); if(g_com_map[DEV_ROLE]) { printf("标签ID: %d .\r\n",dev_id); -- Gitblit v1.9.3