zhyinch
2021-03-03 9f049e78d88d78f74bdaa35676ead5841bc8278c
Ô´Âë/ºËÐİå/Src/application/dw_app.c
@@ -28,7 +28,7 @@
#include <stdio.h>
#include "beep.h"
#include "modbus.h"
#define DEBUG_OUTPUT
/*------------------------------------ Marcos ------------------------------------------*/
/* Inter-ranging delay period, in milliseconds. */
#define RNG_DELAY_MS 100
@@ -361,6 +361,9 @@
    * set by dwt_setrxaftertxdelay() has elapsed. */
   dwt_starttx(DWT_START_TX_IMMEDIATE | DWT_RESPONSE_EXPECTED);//开启发送,发送完成后等待一段时间开启接收,等待时间在dwt_setrxaftertxdelay中设置
   start_poll = time32_incr;
               #ifdef DEBUG_OUTPUT
        printf("P包发送,基站ID: %d .\r\n",i);
            #endif
   /* We assume that the transmission is achieved correctly, poll for reception of a frame or error/timeout. See NOTE 8 below. */
   while (!((status_reg = dwt_read32bitreg(SYS_STATUS_ID)) & (SYS_STATUS_RXFCG | SYS_STATUS_ALL_RX_ERR)))//不断查询芯片状态直到成功接收或者发生错误
   { if(time32_incr - start_poll>20)
@@ -439,6 +442,10 @@
         dwt_writetxfctrl(sizeof(tx_final_msg), 0);//设定发送数据长度
         result=dwt_starttx(DWT_START_TX_DELAYED);//设定为延迟发送
         
             #ifdef DEBUG_OUTPUT
            printf("F包发送,基站ID: %d .\r\n",i);
            #endif
         tag_succ_times++;
         
            LED0_BLINK;
@@ -488,6 +495,9 @@
   }
   else
   {
          #ifdef DEBUG_OUTPUT
            printf("R包失败错误信息: %x .\r\n",status_reg);
            #endif
      /* Clear RX error events in the DW1000 status register. */
      dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_ALL_RX_ERR);
      random_delay_tim = DFT_RAND_DLY_TIM_MS;
@@ -585,6 +595,9 @@
         frame_seq_nb2 = rx_buffer[SEQUENCE_IDX];
         /* We assume that the transmission is achieved correctly, now poll for reception of expected "final" frame or error/timeout.
          * See NOTE 7 below. */
            #ifdef DEBUG_OUTPUT
            printf("收到POLL包,标签ID: %d .\r\n",tag_id_recv);
            #endif
         if(result==0)
         {
            while (!((status_reg = dwt_read32bitreg(SYS_STATUS_ID)) & (SYS_STATUS_RXFCG | SYS_STATUS_ALL_RX_ERR)))///不断查询芯片状态直到接收成功或者出现错误
@@ -644,6 +657,9 @@
//               dist[TAG_ID] = LP(dis, TAG_ID); //LP ä¸ºä½Žé€šæ»¤æ³¢å™¨ï¼Œè®©æ•°æ®æ›´ç¨³å®š
               
               /*--------------------------以下为非测距逻辑------------------------*/
             #ifdef DEBUG_OUTPUT
            printf("收到FINAL包,标签ID: %d .\r\n",tag_id_recv);
            #endif
               LED0_BLINK; //每成功一次通讯则闪烁一次
               g_UWB_com_interval = 0;
               g_Resttimer=0;
@@ -696,6 +712,9 @@
            }
         }else{
            /* Clear RX error events in the DW1000 status register. */
            #ifdef DEBUG_OUTPUT
            printf("F包失败错误信息: %x .\r\n",status_reg);
            #endif
            dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_ALL_RX_ERR);
         }
      }else if(rx_buffer[MESSAGE_TYPE_IDX] == SYNC)
@@ -711,6 +730,9 @@
   }
   else
   {
         #ifdef DEBUG_OUTPUT
            printf("P包失败错误信息: %x .\r\n",status_reg);
            #endif
      /* Clear RX error events in the DW1000 status register. */
      dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_ALL_RX_ERR);
   }