| | |
| | | #include <stdio.h> |
| | | #include "beep.h" |
| | | #include "modbus.h" |
| | | |
| | | #define DEBUG_OUTPUT |
| | | /*------------------------------------ Marcos ------------------------------------------*/ |
| | | /* Inter-ranging delay period, in milliseconds. */ |
| | | #define RNG_DELAY_MS 100 |
| | |
| | | * 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) |
| | |
| | | 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; |
| | |
| | | } |
| | | 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; |
| | |
| | | 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)))///䏿æ¥è¯¢è¯çç¶æç´å°æ¥æ¶æåæè
åºç°é误 |
| | |
| | | // 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; |
| | |
| | | } |
| | | }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) |
| | |
| | | } |
| | | 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); |
| | | } |