From d56da5b9006bfb55a4c7ae2dbb00c026fa3148ae Mon Sep 17 00:00:00 2001
From: zhyinch <zhyinch@gmail.com>
Date: 星期日, 15 十二月 2019 11:08:21 +0800
Subject: [PATCH] 增加跟踪微分器
---
源码/核心板/Src/main.c | 9 ++++++---
1 files changed, 6 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 42fbbea..43f6f36 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"
@@ -45,6 +45,7 @@
memcpy(&hbsend[14],&checksum,2);
}
u16 tyncpoll_time;
+TrackingDiffClass *pUWBDistanceTrackingDiff;
void Program_Init(void)
{uint16_t i;
float temp;
@@ -57,16 +58,18 @@
// g_com_map[DEV_ID]=1;
// g_com_map[COM_INTERVAL]=10;
OUT485_ENABLE;
-
+
#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]=1;
+ g_com_map[ANC_POLL]=0;
+ g_com_map[ALARM_DISTANCE1]=100;
#endif
+ pUWBDistanceTrackingDiff = NewTrackingDiffClass(2, 4, 0.1);
dev_id = g_com_map[DEV_ID];
- g_com_map[VERSION] = 0x010a;
+ g_com_map[VERSION] = 0x010b;
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)
--
Gitblit v1.9.3