TWR-400的测距代码怎么改成一标签对多标签的

陈一

因为要用到距离和rssi值，提供的测距代码中只能一标签对应一基站，想要改成一标签对应多个基站的，请问要怎么修改呢？

陈一

void BPhero_Distance_Measure_Specail_TAG(void)
{               

                msg_f_send.destAddr[0] =(0x0002) &0xFF;
                msg_f_send.destAddr[1] =  ((0x0002)>>8) &0xFF;

                                msg_f_send.seqNum = distance_seqnum;
                msg_f_send.messageData[0]='P';//Poll message
       
       
       
                msg_f_send.destAddr[0] =(0x0003) &0xFF;
                msg_f_send.destAddr[1] =  ((0x0003)>>8) &0xFF;

                                msg_f_send.seqNum = distance_seqnum;
                msg_f_send.messageData[0]='P';//Poll message
       
       
       
       
                        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_5, !GPIO_PIN_RESET);
                         dwt_writetxdata(psduLength ,(uint8 *)&msg_f_send, 0) ; // write the frame data
                                dwt_writetxfctrl(psduLength, 0);
                                dwt_starttx(DWT_START_TX_IMMEDIATE);
       
                while (!(dwt_read32bitreg(SYS_STATUS_ID) & SYS_STATUS_TXFRS))
                { };

                                dwt_enableframefilter(DWT_FF_DATA_EN);
                dwt_setrxtimeout(RESP_RX_TIMEOUT_UUS*10);
                                dwt_rxenable(0);

                                if(++distance_seqnum == 255)
                                                distance_seqnum = 0;
                Tag_State = TAG_POLL_SENT;
                                               
}

你好，如果两个基站的地址分别为0x0002和0x0003时，这里的代码我这样改有什么问题吗，改了之后行不通，可以帮我写一下两个基站的代码怎么改吗？

陈一

解决了，谢谢技术人员