1
zhyinch
2019-12-15 bb37bc0f05735470caaf3f7e4d7eec9551bf3d44
源码/核心板/Src/application/dw_app.c
@@ -238,7 +238,7 @@
      for(i=0;i<255;i++)
      {
         g_flag_Taggetdist[i]++;
         if(g_flag_Taggetdist[i]>=2)
         if(g_flag_Taggetdist[i]>=20)
         {
            g_Tagdist[i]=0xffff;
         }
@@ -474,6 +474,7 @@
}
int8_t correction_time;
extern uint8_t sync_seq;
#define TDFILTER
void Anchor_App(void)
{
@@ -623,6 +624,10 @@
                  g_Tagdist[tag_id_recv-TAG_ID_START] = hex_dist;
                  anchor_dist_last_frm[tag_id_recv-TAG_ID_START] = hex_dist;
                  g_Tagdist[tag_id_recv]=   hex_dist;
                  #ifdef TDFILTER
                  TrackingDiffUpdate(pUWBDistanceTrackingDiff, (float)hex_dist);
                  hex_dist=pUWBDistanceTrackingDiff->pos_predict;
                  #endif
               }
               his_dist[tag_id_recv-TAG_ID_START]=hex_dist;
               g_flag_Taggetdist[tag_id_recv]=0;