增加跟踪微分器

zhyinch

2019-12-15 d56da5b9006bfb55a4c7ae2dbb00c026fa3148ae

 源码/核心板/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;
@@ -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;