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 | 4 +++- 1 files changed, 3 insertions(+), 1 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 78c42c8..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,7 +58,7 @@ // g_com_map[DEV_ID]=1; // g_com_map[COM_INTERVAL]=10; OUT485_ENABLE; - + #ifdef DEBUG_MODE g_com_map[COM_INTERVAL]=50; @@ -66,6 +67,7 @@ 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] = 0x010b; temp=(float)g_com_map[MAX_REPORT_ANC_NUM]*4/3; -- Gitblit v1.9.3