| | |
| | | uint32_t g_UWB_com_interval = 0; |
| | | float dis_after_filter; //当前距离值 |
| | | LPFilter_Frac* p_Dis_Filter; //测距用的低通滤波器 |
| | | |
| | | |
| | | int16_t intheight; |
| | | extern float Altitude; |
| | | |
| | | static uint64_t get_tx_timestamp_u64(void) |
| | | { |
| | |
| | | if(distance>-10&&distance<1000) |
| | | nearbase_distlist[i] = distance*100+anc_distoffset[i]; |
| | | }else{ |
| | | // nearbase_distlist[i] = 0x1ffff; |
| | | nearbase_distlist[i] = 0x1ffff; |
| | | } |
| | | |
| | | } |
| | |
| | | } |
| | | tx_near_msg[GROUP_ID_IDX] = group_id; |
| | | tx_near_msg[BATTARY_IDX] = bat_percent; |
| | | tx_near_msg[BUTTON_IDX] = !GET_USERKEY|stationary_flag<<1; |
| | | // tx_near_msg[BUTTON_IDX] = !GET_USERKEY|stationary_flag<<1; |
| | | memcpy(&tx_near_msg[PRESSNUM_IDX],&intheight,2); |
| | | tx_near_msg[SEQUENCE_IDX] = frame_seq_nb++; |
| | | tx_near_msg[NEARBASENUM_INDEX] = nearbase_num; |
| | | memcpy(&tx_near_msg[NEARBASEID_INDEX],&nearbaseid_list,nearbase_num*2); |
| | |
| | | dwt_writetxfctrl(13+4*nearbase_num, 0);//设置超宽带发送数据长度 |
| | | dwt_starttx(DWT_START_TX_IMMEDIATE | DWT_RESPONSE_EXPECTED);//开启发送,发送完成后等待一段时间开启接收,等待时间在dwt_setrxaftertxdelay中设置 |
| | | |
| | | tx_near_msg[TAGCONFIGSUCCESS_INDEX] =0; |
| | | // tx_near_msg[TAGCONFIGSUCCESS_INDEX] =0; |
| | | para_update = 0; |
| | | get_newbase = 0; |
| | | flag_finalsend=0; |
| | |
| | | } |
| | | } |
| | | } |
| | | extern float Height; |
| | | u8 regpoll_count; |
| | | u32 id; |
| | | void Tag_App(void)//发送模式(TAG标签) |
| | |
| | | Registor_Poll(); |
| | | } |
| | | } |
| | | GetPressAndHeight(); |
| | | intheight = Height*100; |
| | | NearPoll(); |
| | | dwt_entersleep(); |
| | | bat_percent=Get_VDDVlotage(); |