V1.28 修改MIS_NUM标志位错误

zhyinch

2020-05-31 5ab92d7ff87870ce55ecb46c86d25ae79aa834e1

 Ô´Âë/ºËÐÄ°å/Src/application/dw_app.c

@@ -506,11 +506,11 @@
#define TDFILTER
//#define CHECK_UID
extern uint8_t UID_ERROR;
u8 misdist_num[TAG_NUM_IN_SYS];
void Anchor_App(void)
{
   uint32_t frame_len;
   uint32_t resp_tx_time;
   static u8 misdist_num;
   /* Clear reception timeout to start next ranging process. */
   dwt_setrxtimeout(0);//设定接收超时时间，0位没有超时时间

@@ -648,9 +648,10 @@
               hex_dist = dist_cm+(int16_t)g_com_map[DIST_OFFSET]*10;
               if(tag_id_recv-TAG_ID_START<=TAG_NUM_IN_SYS)
               {
               if(hex_dist-his_dist[tag_id_recv-TAG_ID_START]<15000||misdist_num>4)
               {int32_t filter_dist;
                  misdist_num=0;
               if(hex_dist-his_dist[tag_id_recv-TAG_ID_START]<15000||misdist_num[tag_id_recv-TAG_ID_START]>4)
               {
                  int32_t filter_dist;
                  misdist_num[tag_id_recv-TAG_ID_START]=0;
               if(hex_dist<1000000&&hex_dist>-10000)
               {      
                  #ifdef TDFILTER
@@ -685,8 +686,9 @@
               //dis_after_filter = LP_Frac_Update(p_Dis_Filter, dist_cm);
                  }
               
               }else{
                  misdist_num++;
               }
               else{
                  misdist_num[tag_id_recv-TAG_ID_START]++;
               }
            }
            }