| | |
| | | #define YUNDONG_UWB_TIME 1 |
| | | #define YUNDONG_GPS4G_TIME 100 |
| | | extern UART_HandleTypeDef huart2; |
| | | uint8_t GPS_data[100]; |
| | | uint8_t GPS_data[200]; |
| | | uint8_t GPS_successful_flag; |
| | | uint8_t fangchai_flag; |
| | | uint8_t fangchai_state; |
| | |
| | | extern uint8_t air780_state; |
| | | extern uint16_t sleep_time; |
| | | uint8_t zuihoufasong_falg; |
| | | uint8_t UDPClient_UploadGPS_flag; |
| | | extern uint16_t chongdianmeiyouuwb_time; |
| | | void PowerLedTask(void) |
| | | { |
| | | static u8 powerled_state=0; |
| | |
| | | } |
| | | while(HAL_GPIO_ReadPin(INPUT_5V_GPIO_Port,INPUT_5V_Pin)&&DBG_GetMode() == DBG_MODE_CHARGE) |
| | | { |
| | | nomove_count = 0; |
| | | HAL_IWDG_Refresh(&hiwdg); |
| | | DBG_Poll(); |
| | | IdleTask(); |
| | |
| | | { |
| | | powerled = RED; |
| | | } |
| | | if(chongdianmeiyouuwb_time>30) |
| | | { |
| | | HAL_NVIC_SystemReset(); |
| | | } |
| | | if(taglist_num>0) |
| | | { |
| | | if(air780_state>=2) |
| | |
| | | chongdian_yundong_time=0; |
| | | Uwb_Zubao_Poll(); |
| | | UDPClient_UploadGPS((char*)GPS_data); |
| | | // UDPClient_UploadGPS_flag=1; |
| | | HexToAsciiSendUDP(uwb_send,19+5*taglist_num); |
| | | taglist_num=0; |
| | | chongdianmeiyouuwb_time=0; |
| | | } |
| | | } |
| | | else |
| | |
| | | if(GPS_successful_flag) |
| | | { |
| | | UDPClient_UploadGPS((char*)GPS_data); |
| | | // UDPClient_UploadGPS_flag=1; |
| | | } |
| | | else |
| | | { |
| | |
| | | //deca_sleep(1000); |
| | | |
| | | g_com_map[GROUP_ID]=3; |
| | | g_com_map[VERSION] = (2<<8)|5; |
| | | g_com_map[VERSION] = (2<<8)|11; |
| | | |
| | | if (g_com_map[COM_INTERVAL] <50) |
| | | { |
| | |
| | | { |
| | | {g_com_map[CHAICHUGPS_HZ]=600;} |
| | | } |
| | | g_com_map[CHAICHUGPS_HZ]=1800; |
| | | if(g_com_map[NOMOVESLEEP_TIME]>120) |
| | | { |
| | | g_com_map[NOMOVESLEEP_TIME]=120; |
| | |
| | | uint16_t state_flag; |
| | | u16 uwbchecksum; |
| | | state_flag=fangchai_flag<<4; |
| | | if(taglist_num>8) |
| | | if(taglist_num>8) |
| | | {taglist_num=8;} |
| | | uwb_send[2] = 0x12;//正常模式 |
| | | uwb_send[3] = 15+5*(taglist_num);//数据段长度 |
| | |
| | | uwb_send[14] = 0; |
| | | uwb_send[15] = 0; |
| | | uwb_send[16] = taglist_num; |
| | | if(taglist_num>7) |
| | | {taglist_num=7;} |
| | | |
| | | memcpy(&uwb_send[17],&tagid_list,2*taglist_num); |
| | | memcpy(&uwb_send[17+taglist_num*2],&tagdist_list,2*taglist_num); |
| | | memcpy(&uwb_send[17+taglist_num*4],&tagbat_list,taglist_num); |
| | |
| | | if(GPS_successful_flag) |
| | | { |
| | | UDPClient_UploadGPS((char*)GPS_data); |
| | | // UDPClient_UploadGPS_flag=1; |
| | | } |
| | | else |
| | | { |
| | |
| | | { |
| | | Stop_Mode_Poll(); |
| | | HAL_PWR_EnterSTOPMode(PWR_LOWPOWERREGULATOR_ON, PWR_STOPENTRY_WFI); |
| | | if(sleep_time>600) |
| | | if(sleep_time>1800) |
| | | {HAL_NVIC_SystemReset();} |
| | | } |
| | | else |
| | |
| | | yundong_time=0; |
| | | Uwb_Zubao_Poll(); |
| | | UDPClient_UploadGPS((char*)GPS_data); |
| | | // UDPClient_UploadGPS_flag=1; |
| | | HexToAsciiSendUDP(uwb_send,19+5*taglist_num); |
| | | taglist_num=0; |
| | | } |
| | |
| | | if(GPS_successful_flag) |
| | | { |
| | | UDPClient_UploadGPS((char*)GPS_data); |
| | | // UDPClient_UploadGPS_flag=1; |
| | | } |
| | | else |
| | | { |