| | |
|---|
| | | //deca_sleep(1000); |
|---|
| | | |
|---|
| | | g_com_map[GROUP_ID]=3; |
|---|
| | | g_com_map[VERSION] = (3<<8)|1; |
|---|
| | | g_com_map[VERSION] = (3<<8)|7; |
|---|
| | | |
|---|
| | | if (g_com_map[COM_INTERVAL] <50) |
|---|
| | | { |
|---|
| | |
|---|
| | | } |
|---|
| | | |
|---|
| | | } |
|---|
| | | |
|---|
| | | extern uint8_t jingzhiflag; |
|---|
| | | extern uint16_t testlorarecve; |
|---|
| | | void Uwb_Zubao_Poll() |
|---|
| | | { |
|---|
| | | |
|---|
| | | for(u16 i=0;i<taglist_num-1;i++) |
|---|
| | | { |
|---|
| | | for(u16 j=0;j<taglist_num-1-i;j++) |
|---|
| | | { |
|---|
| | | if(tagdist_list[j]>tagdist_list[j+1]) |
|---|
| | | { |
|---|
| | | u16 id,dist; |
|---|
| | | u8 bat; |
|---|
| | | id = tagid_list[j]; |
|---|
| | | dist = tagdist_list[j]; |
|---|
| | | bat = tagbat_list[j]; |
|---|
| | | tagid_list[j] = tagid_list[j+1]; |
|---|
| | | tagdist_list[j] = tagdist_list[j+1]; |
|---|
| | | tagbat_list[j] = tagbat_list[j+1]; |
|---|
| | | tagid_list[j+1] = id; |
|---|
| | | tagdist_list[j+1] = dist; |
|---|
| | | tagbat_list[j+1] = bat; |
|---|
| | | } |
|---|
| | | } |
|---|
| | | |
|---|
| | | } |
|---|
| | | |
|---|
| | | uint16_t state_flag; |
|---|
| | | u16 uwbchecksum; |
|---|
| | | state_flag=fangchai_flag<<4; |
|---|
| | | state_flag=fangchai_flag<<4|jingzhiflag<<1; |
|---|
| | | if(taglist_num>8) |
|---|
| | | {taglist_num=8;} |
|---|
| | | uwb_send[2] = 0x12;//正常模式 |
|---|
| | |
|---|
| | | u16 uwbchecksum; |
|---|
| | | IdleTask(); |
|---|
| | | HAL_IWDG_Refresh(&hiwdg); |
|---|
| | | if(bat_percent<=5) |
|---|
| | | { |
|---|
| | | HAL_GPIO_WritePin(GPIOA, GPIO_PIN_8, GPIO_PIN_RESET); |
|---|
| | | } |
|---|
| | | if(HAL_GPIO_ReadPin(INPUT_5V_GPIO_Port,INPUT_5V_Pin))//5V输入检测 |
|---|
| | | { |
|---|
| | | PowerLedTask(); |
|---|
