| | |
| | | int16_t elevation = 0; |
| | | int16_t azimuth = 0; |
| | | uint8_t fom = 0; |
| | | extern CountState_t current_state; |
| | | int32_t distance; |
| | | uint8_t taglist_num; |
| | | float *sts_rssi=NULL; |
| | |
| | | Anchor_App(); |
| | | if(resp_tx_flag==0) |
| | | { |
| | | |
| | | OpenUWB(); |
| | | |
| | | } |
| | | // #ifdef STS_MODE |
| | | // valid_sts= sts_valid_check(); |
| | |
| | | // } |
| | | // Set4LEDColor(uwbled,rtkled,led4g,powerled); |
| | | |
| | | if(taglist_num>20) //最多上传20个基站数据,距离最近的20个 |
| | | taglist_num = 20; |
| | | if(taglist_num>14) //最多上传20个基站数据,距离最近的20个 |
| | | taglist_num = 14; |
| | | usart_send[0]= 0x55; |
| | | usart_send[1]= 0xaa; |
| | | usart_send[2] = 0x12;//正常模式 |
| | |
| | | // taglist_num = 0; |
| | | // rxnum=0; |
| | | } |
| | | extern uint32_t step_count; |
| | | void UWBIdleTask(void) |
| | | { |
| | | // if(receive_flag) |
| | |
| | | // } |
| | | if(HIDO_TimerGetTick()-uwbtasktimer >=1) |
| | | { |
| | | step_count = mir3da_get_step(); // 获取步数 |
| | | uwbtasktimer = HIDO_TimerGetTick(); |
| | | UWBOneSecondTask(); |
| | | #ifdef UWB_CK |
| | | if(g_com_map[UWBFrequency]==1) |
| | | { |
| | | UWBSendUDPTask(); |
| | | #endif |
| | | } |
| | | } |
| | | } |
| | | int uwb_app_poll(void) |
| | |
| | | uint8_t i; |
| | | uint16_t tempid; |
| | | uwb_offtime_count=0; |
| | | CountState_t current_state = STATE_NORMAL; |
| | | #ifdef CEJU_ZIUMIAN |
| | | current_state = STATE_NORMAL; |
| | | #endif |
| | | if(group_id==rx_buf[GROUP_ID_IDX]&&rx_buf[MESSAGE_TYPE_IDX] == MBX_POLL)//判断是否是和自己是同一组通讯的且为poll包 |
| | | { flag_recsuccess = 1; |
| | | wltag_state=RANGE;//成功后从search切换为range |