| | |
| | | tx_nearresp_msg[MESSAGE_TYPE_IDX]=NEAR_RESPONSE; |
| | | tx_nearresp_msg[MOTORSTATE_INDEX]=(remotesend_state<<4)|motorstate; |
| | | waittagconfig_reponse=0; |
| | | if(remotesend_state&&!memcmp(&rx_buffer[TAG_ID_IDX],&configremotetagID,2)) |
| | | { |
| | | memcpy(&tx_nearresp_msg[REMOTEPARA_INDEX],remotetag_para,remotetag_paralen); |
| | | dwt_writetxdata(22+remotetag_paralen, tx_nearresp_msg, 0);//åå
¥åéæ°æ® |
| | | dwt_writetxfctrl(22+remotetag_paralen, 0);//设å®åéé¿åº¦ |
| | | waittagconfig_reponse=1; |
| | | }else{ |
| | | dwt_writetxdata(22, tx_nearresp_msg, 0);//åå
¥åéæ°æ® |
| | | dwt_writetxfctrl(22, 0);//设å®åéé¿åº¦ |
| | | } |
| | | if(pwtag.remain_time>0) |
| | | {uint8_t i; |
| | | for(i=0;i<pwtag.groupnum;i++) |
| | | { |
| | | if(pwtag.groupid[i][0]<=tag_id_recv&&tag_id_recv<=pwtag.groupid[i][1]) |
| | | { |
| | | remotesend_state=1; |
| | | tx_nearresp_msg[MOTORSTATE_INDEX]=(remotesend_state<<4)|motorstate; |
| | | remotetag_paralen = 2+3; |
| | | remotetag_para[0] = 2; |
| | | remotetag_para[1] = 6; |
| | | remotetag_para[2] = 2; |
| | | memcpy(&remotetag_para[3],&pwtag.group_interval[i],2); |
| | | memcpy(&tx_nearresp_msg[REMOTEPARA_INDEX],remotetag_para,remotetag_paralen); |
| | | dwt_writetxdata(22+remotetag_paralen, tx_nearresp_msg, 0);//åå
¥åéæ°æ® |
| | | dwt_writetxfctrl(22+remotetag_paralen, 0);//设å®åéé¿åº¦ |
| | | remotesend_state=0; |
| | | break; |
| | | } |
| | | } |
| | | |
| | | }else{ |
| | | dwt_writetxdata(22, tx_nearresp_msg, 0);//åå
¥åéæ°æ® |
| | | dwt_writetxfctrl(22, 0);//设å®åéé¿åº¦ |
| | | } |
| | | |
| | | // if(remotesend_state&&tag_id_recv==configremotetagID) |
| | | // { |
| | | // memcpy(&tx_nearresp_msg[REMOTEPARA_INDEX],remotetag_para,remotetag_paralen); |
| | | // dwt_writetxdata(22+remotetag_paralen, tx_nearresp_msg, 0);//åå
¥åéæ°æ® |
| | | // dwt_writetxfctrl(22+remotetag_paralen, 0);//设å®åéé¿åº¦ |
| | | // waittagconfig_reponse=1; |
| | | // }else{ |
| | | |
| | | result = dwt_starttx(DWT_START_TX_DELAYED | DWT_RESPONSE_EXPECTED);//å»¶è¿åéï¼çå¾
æ¥æ¶ |
| | | |
| | | battary = rx_buffer[BATTARY_IDX]; |