| | |
|---|
| | | #include "mk_misc.h" |
|---|
| | | #include "mk_uart.h" |
|---|
| | | #include "mk_trace.h" |
|---|
| | | #include "global_param.h" |
|---|
| | | static float clockOffsetRatio; |
|---|
| | | static double rtd_init, rtd_resp; |
|---|
| | | double tof,distance; |
|---|
| | |
|---|
| | | } |
|---|
| | | void CalculateDists(int64_t poll_tx_ts) |
|---|
| | | { |
|---|
| | | for(int i=0;i<MAX_NEARBASE_NUM;i++) |
|---|
| | | for(int i=0;i<MAX_NEARBASE_NUM+10;i++) |
|---|
| | | { |
|---|
| | | |
|---|
| | | if(exsistbase_list[i]==KEEP_TIMES) |
|---|
| | | if(taglist_keeptime[i+taglist_current_index]==KEEP_TIMES) |
|---|
| | | { |
|---|
| | | |
|---|
| | | //temp_freq_offset=freq_offset_filter;//测试 |
|---|
| | |
|---|
| | | |
|---|
| | | if(distance>-1000&&distance<100000) |
|---|
| | | { |
|---|
| | | nearbase_distlist[i] = distance+anc_distoffset[i];//offset未加 |
|---|
| | | } |
|---|
| | | taglist_dist[i+taglist_current_index] = distance+(int16_t)g_com_map[DIST_OFFSET];//offset未加 |
|---|
| | | }else{ |
|---|
| | | taglist_dist[i] = 0x2ffff; |
|---|
| | | } |
|---|
| | | }else{ |
|---|
| | | nearbase_distlist[i] = 0x1ffff; |
|---|
| | | //nearbase_distlist[i] = 0x7fff; |
|---|
| | | } |
|---|
| | | |
|---|
| | | } |
|---|
