改回SFD模式

zhyinch

2021-04-05 499fc8166ddc4d71251c27329b026810759ec5a7

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

@@ -828,6 +828,7 @@
            dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_ALL_RX_ERR);
         }
}
extern u16 dist_threshold;
u8 misdist_num[TAG_NUM_IN_SYS],seize_anchor,getrange_success=0;
u8 Anchor_RecNearPoll(u8 ancrec_nearbasepos) //0 mainbase  1 first near_base
{
@@ -924,16 +925,17 @@
               /*--------------------------以下为非测距逻辑------------------------*/
               //dist_cm=33000;
               getrange_success = 1;
               g_Resttimer=0;
					
               LED0_BLINK; //每成功一次通讯则闪烁一次
               dis_after_filter=dist_cm;
               hex_dist = dist_cm+(int16_t)g_com_map[DIST_OFFSET]*10;
               g_flag_Taggetdist[taglist_pos]=0;
               if(hex_dist>0&&hex_dist<2000000)
               if(hex_dist>-10000&&hex_dist<2000000)
               {
               if(abs(hex_dist-his_dist[taglist_pos])<10000||misdist_num[taglist_pos]>3)
               if(abs(hex_dist-his_dist[taglist_pos])<dist_threshold||misdist_num[taglist_pos]>3)
               {
                  int32_t filter_dist;
                        g_Resttimer=0;
                  #ifdef TDFILTER
                  NewTrackingDiffUpdate(taglist_pos, (float)hex_dist);
                  filter_dist=pos_predict[taglist_pos]/10;