67 功率

zhyinch

2021-06-21 083ca82eb09340e71de8694fbb5bae9b99489b38

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

@@ -1,6 +1,7 @@
#include "dw_app.h"
#include "ADC.h"
#define TDFILTER
#define CONT_FRAME_PERIOD 124800
enum enumtagstate
{
   DISCPOLL,
@@ -14,7 +15,7 @@
   DWT_PAC8,        /* Preamble acquisition chunk size. Used in RX only. */
   9,               /* TX preamble code. Used in TX only. */
   9,               /* RX preamble code. Used in RX only. */
   1,               /* Use non-standard SFD (Boolean) */
   0,               /* Use non-standard SFD (Boolean) */
   DWT_BR_6M8,      /* Data rate. */
   DWT_PHRMODE_STD, /* PHY header mode. */
   (129 + 8 - 8)    /* SFD timeout (preamble length + 1 + SFD length - PAC size). Used in RX only. */
@@ -122,7 +123,7 @@
     * performance. */
    Reset_DW1000();//重启DW1000 /* Target specific drive of RSTn line into DW1000 low for a period. */
    dwt_initialise(DWT_LOADUCODE);//初始化DW1000
   Spi_ChangePrescaler(SPIx_PRESCALER_FAST);   //设置为快速模式
   Spi_ChangePrescaler(SPIx_PRESCALER_SLOW);   //设置为快速模式

    /* Configure DW1000. See NOTE 6 below. */
    dwt_configure(&config);//配置DW1000
@@ -345,12 +346,16 @@
    {
        nearbase_distlist[i]=0x1ffff;
    }
      dwt_configcontinuousframemode(CONT_FRAME_PERIOD);
   tx_nearpoll_msg[MESSAGE_TYPE_IDX] = NEAR_POLL;   
   memcpy(&tx_nearpoll_msg[ANCHOR_ID_IDX],&mainbase_id,2);   
   dwt_writetxdata(13+4*nearbase_num, tx_nearpoll_msg, 0);//将Poll包数据传给DW1000，将在开启发送时传出去
   dwt_writetxfctrl(13+4*nearbase_num, 0);//设置超宽带发送数据长度
   dwt_starttx(DWT_START_TX_IMMEDIATE | DWT_RESPONSE_EXPECTED);//开启发送，发送完成后等待一段时间开启接收，等待时间在dwt_setrxaftertxdelay中设置
	
   dwt_starttx(DWT_START_TX_IMMEDIATE);//开启发送，发送完成后等待一段时间开启接收，等待时间在dwt_setrxaftertxdelay中设置
   while(1)
    {
    IdleTask();
    }
   flag_finalsend=0;
   flag_rxon=1;
   neartimout_timer=0;
@@ -925,7 +930,7 @@
               /*--------------------------以下为非测距逻辑------------------------*/
               //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;
@@ -935,6 +940,7 @@
               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;