| | |
|---|
| | | void GetNearMsg(void) |
|---|
| | | { |
|---|
| | | u32 start_poll,frame_len; |
|---|
| | | |
|---|
| | | u8 nearmsg_i=0; |
|---|
| | | for(nearmsg_i=0;nearmsg_i<20;nearmsg_i++) |
|---|
| | | { |
|---|
| | | nearbase_distlist[nearmsg_i] = 0x1ffff; |
|---|
| | | } |
|---|
| | | //mainbase_id = 0x9724; |
|---|
| | | memcpy(&tx_near_msg[ANCHOR_ID_IDX],&mainbase_id,2); |
|---|
| | | memcpy(&tx_near_msg[TAG_ID_IDX],&dev_id,2); |
|---|
| | | tx_near_msg[MESSAGE_TYPE_IDX] = NEAR_MSG; |
|---|
| | | |
|---|
| | | |
|---|
| | | dwt_setrxaftertxdelay(POLL_TX_TO_RESP_RX_DLY_UUS); //设置发送后开启接收，并设定延迟时间 |
|---|
| | | dwt_setrxtimeout(RESP_RX_TIMEOUT_UUS); |
|---|
| | |
|---|
| | | memcpy(&nearbase_switchdistlist[rec_nearbasepos],&rx_buffer[NR_NEARSWITCH_DISTANCE],2); |
|---|
| | | nearbase_distlist[rec_nearbasepos+1]=temp_dist; // nearbase_distlist[1]对应 rec_nearbaseid[0]的距离 |
|---|
| | | final_msg_set_ts(&tx_near_msg[FINAL_MSG_RESP_RX_NEARBASE_IDX+(rec_nearbasepos)*4], resp_rx_ts); |
|---|
| | | if(temp_dist<salvebase_mindist) |
|---|
| | | if(temp_dist<salvebase_mindist&&nearbase_switchdistlist[rec_nearbasepos]==1) |
|---|
| | | { |
|---|
| | | salvebase_mindist = temp_dist; |
|---|
| | | mindist_slavebaseid = rec_nearbaseid; |
|---|
| | | } |
|---|
| | | #ifdef SWITCHBASE_ZHUANDIAN |
|---|
| | | if(temp_dist<nearbase_switchdistlist[rec_nearbasepos]&&nearbase_switchdistlist[rec_nearbasepos]!=0&&temp_dist>0) |
|---|
| | | if(temp_dist<nearbase_switchdistlist[rec_nearbasepos]&&nearbase_switchdistlist[rec_nearbasepos]>1&&temp_dist>0) |
|---|
| | | { |
|---|
| | | mainbase_id = rec_nearbaseid; |
|---|
| | | tag_state = GETNEARMSG; |
|---|
| | |
|---|
| | | changemainbase_count = 0; |
|---|
| | | } |
|---|
| | | #endif |
|---|
| | | }else if(mainbase_lost_count>10*tag_frequency) |
|---|
| | | }else if(mainbase_lost_count>5*tag_frequency) |
|---|
| | | { |
|---|
| | | tag_state = STARTPOLL; |
|---|
| | | } |
|---|
