| | |
|---|
| | | |
|---|
| | | exsistbase_list[i]--; |
|---|
| | | clockOffsetRatio = anc_clockoffset[i] * (FREQ_OFFSET_MULTIPLIER * HERTZ_TO_PPM_MULTIPLIER_CHAN_2 / 1.0e6) ; |
|---|
| | | rtd_init = tag_resprx[i] - poll_tx_ts; |
|---|
| | | rtd_init = tag_resprx[i] - poll_tx_ts&0xffffffff; |
|---|
| | | rtd_resp = anc_resptx[i] - anc_pollrx[i]; |
|---|
| | | tof = ((rtd_init - rtd_resp * (1 - clockOffsetRatio)) / 2.0) * DWT_TIME_UNITS; |
|---|
| | | distance = tof * SPEED_OF_LIGHT; |
|---|
| | |
|---|
| | | // SCB->AIRCR = 0X05FA0000|(unsigned int)0x04; //软复位回到bootloader |
|---|
| | | // } |
|---|
| | | // } |
|---|
| | | Dw1000_Init(); |
|---|
| | | dwt_forcetrxoff(); |
|---|
| | | // Dw1000_Init(); |
|---|
| | | error_times = 0; |
|---|
| | | switch(tag_state) |
|---|
| | | { |
|---|
