| | |
| | | dwt_forcetrxoff(); |
| | | dwt_setdelayedtrxtime(final_tx_time); |
| | | result=dwt_starttx(DWT_START_TX_DELAYED);//设å®ä¸ºå»¶è¿åé |
| | | if(result!=DWT_SUCCESS) |
| | | if(result!=DWT_SUCCESS&&g_com_map[MODBUS_ID1]==1) |
| | | { |
| | | #ifdef DBGMSG_OUTPUT |
| | | dbgmsg_len = sprintf(dbgmsg,"%s status_reg:%x",__debug_info__,status_reg); |
| | |
| | | }; |
| | | if(status_reg==0xffffffff) |
| | | { |
| | | NVIC_SystemReset(); |
| | | //NVIC_SystemReset(); |
| | | } |
| | | if (status_reg & SYS_STATUS_RXFCG)//妿æåæ¥æ¶ |
| | | { |
| | | rflosttimer = 0; |
| | | dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_RXFCG | SYS_STATUS_TXFRS);//æ¸
æ¥å¯å卿 å¿ä½ |
| | | frame_len = dwt_read32bitreg(RX_FINFO_ID) & RX_FINFO_RXFLEN_MASK; //è·å¾æ¥æ¶å°çæ°æ®é¿åº¦ |
| | | dwt_readrxdata(rx_buffer, frame_len, 0); //è¯»åæ¥æ¶æ°æ® |
| | | dwt_setrxtimeout(0);//DELAY_BETWEEN_TWO_FRAME_UUS*(nearbase_num+1-recbase_num)+10);//è®¾å®æ¥æ¶è¶
æ¶æ¶é´ï¼0使²¡æè¶
æ¶æ¶é´ |
| | | dwt_rxenable(0);//æå¼æ¥æ¶ |
| | | rflosttimer = 0; |
| | | if (rx_buffer[MESSAGE_TYPE_IDX] == NEAR_RESPONSE&&!memcmp(&rx_buffer[TAG_ID_IDX],&dev_id,2)&&rx_buffer[GROUP_ID_IDX] == group_id) //å¤ææ¥æ¶å°çæ°æ®æ¯å¦æ¯responseæ°æ® |
| | | { u16 rec_nearbaseid,rec_nearbasepos; |
| | | int32_t temp_dist; |
| | |
| | | if(temp_dist!=0x1ffff ) |
| | | { |
| | | #ifdef USART_SINGLE_OUTPUT |
| | | |
| | | usart_send[2] = 1;//æ£å¸¸æ¨¡å¼ |
| | | usart_send[3] = 29;//æ°æ®æ®µé¿åº¦ |
| | | usart_send[4] = frame_seq_nb;//æ°æ®æ®µé¿åº¦ |
| | |
| | | if(flag_rxon) |
| | | { |
| | | dwt_rxenable(0); |
| | | if(g_com_map[MODBUS_ID1]==1) |
| | | { |
| | | #ifdef DBGMSG_OUTPUT |
| | | dbgmsg_len = sprintf(dbgmsg,"%s status_reg:%x",__debug_info__,status_reg); |
| | | SendDbgMsg(dbgmsg,dbgmsg_len); |
| | | #endif |
| | | #endif |
| | | } |
| | | } |
| | | } |
| | | } |
| | |
| | | while (!((status_reg = dwt_read32bitreg(SYS_STATUS_ID)) & (SYS_STATUS_RXFCG | SYS_STATUS_ALL_RX_ERR))&&!g_start_sync_flag)///䏿æ¥è¯¢è¯çç¶æç´å°æ¥æ¶æåæè
åºç°é误 |
| | | { }; |
| | | }else{ |
| | | if(g_com_map[MODBUS_ID1]==1) |
| | | { |
| | | #ifdef DBGMSG_OUTPUT |
| | | dbgmsg_len = sprintf(dbgmsg,"%s status_reg:%x",__debug_info__,status_reg); |
| | | SendDbgMsg(dbgmsg,dbgmsg_len); |
| | | #endif |
| | | #endif |
| | | } |
| | | } |
| | | |
| | | if (status_reg & SYS_STATUS_RXFCG)//æ¥æ¶æå |
| | |
| | | g_Tagdist[taglist_pos]= 0x2ffff; |
| | | } |
| | | #ifdef USART_SINGLE_OUTPUT |
| | | |
| | | usart_send[2] = 1;//æ£å¸¸æ¨¡å¼ |
| | | usart_send[3] = 29;//æ°æ®æ®µé¿åº¦ |
| | | usart_send[4] = frame_seq_nb2;//æ°æ®æ®µé¿åº¦ |
| | |
| | | } |
| | | }else{ |
| | | //printf("%x/n",status_reg); |
| | | if(g_com_map[MODBUS_ID1]==1) |
| | | { |
| | | #ifdef DBGMSG_OUTPUT |
| | | dbgmsg_len = sprintf(dbgmsg,"%s status_reg:%x",__debug_info__,status_reg); |
| | | SendDbgMsg(dbgmsg,dbgmsg_len); |
| | | #endif |
| | | } |
| | | dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_ALL_RX_ERR); |
| | | } |
| | | } |
| | |
| | | { u16 tag_recv_interval; |
| | | float temp_tagpos; |
| | | |
| | | |
| | | rflosttimer = 0; |
| | | dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_RXFCG);//æ¸
餿 å¿ä½ |
| | | frame_len = dwt_read32bitreg(RX_FINFO_ID) & RX_FINFO_RXFL_MASK_1023;//è·å¾æ¥æ¶æ°æ®é¿åº¦ |
| | | recpoll_len = frame_len; |
| | |
| | | } |
| | | }else{ |
| | | #ifdef DBGMSG_OUTPUT |
| | | if(status_reg&SYS_STATUS_ALL_RX_ERR) |
| | | if((status_reg&SYS_STATUS_ALL_RX_ERR)&&g_com_map[MODBUS_ID1]==1) |
| | | { dbgmsg_len = sprintf(dbgmsg,"%s status_reg:%x",__debug_info__,status_reg); |
| | | SendDbgMsg(dbgmsg,dbgmsg_len); |
| | | } |