| | |
| | | } |
| | | |
| | | } |
| | | uint8_t uwb_active_flag = 0; |
| | | u8 active_flag=0; |
| | | void Program_Init(void) |
| | | { float temp; |
| | |
| | | hardware_pici= STMFLASH_ReadHalfWord(FLASH_HARDWARE_VERSION_MAP+2); |
| | | hardware_type= STMFLASH_ReadHalfWord(FLASH_HARDWARE_VERSION_MAP+4); |
| | | //deca_sleep(1000); |
| | | g_com_map[VERSION] = (2<<8)|63; |
| | | g_com_map[VERSION] = (2<<8)|65; |
| | | |
| | | // g_com_map[DEV_ID]=0x7; |
| | | #ifdef DEBUG_MODE |
| | |
| | | module_power = g_com_map[POWER]; |
| | | imu_enable=g_com_map[IMU_ENABLE]; |
| | | motor_enable=g_com_map[MOTOR_ENABLE]; |
| | | |
| | | uwb_active_flag = g_com_map[UWB_ACTIVE_FLAG_IDX]; |
| | | group_id=g_com_map[GROUP_ID]; |
| | | dev_id = g_com_map[DEV_ID]; |
| | | //slottime=ceil((double)g_com_map[MAX_REPORT_ANC_NUM]*SLOT_SCALE)+3; |
| | |
| | | MX_TIM2_Init(); |
| | | break; |
| | | } |
| | | } |
| | | |
| | | void DoubleClickProcess(void) |
| | | { char temp[50]; |
| | | uint8_t len; |
| | | if(uwb_active_flag) |
| | | { |
| | | uwb_active_flag = 0; |
| | | HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_3); |
| | | HAL_Delay(3000); |
| | | HAL_TIM_PWM_Stop(&htim2, TIM_CHANNEL_3); |
| | | }else{ |
| | | uwb_active_flag = 1; |
| | | HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_3); |
| | | HAL_Delay(1000); |
| | | HAL_TIM_PWM_Stop(&htim2, TIM_CHANNEL_3); |
| | | } |
| | | g_com_map[UWB_ACTIVE_FLAG_IDX]= uwb_active_flag; |
| | | save_com_map_to_flash(); |
| | | } |
| | | void HAL_UART_ErrorCallback(UART_HandleTypeDef *huart) |
| | | { |
| | |
| | | HAL_PWR_EnterSTOPMode(PWR_LOWPOWERREGULATOR_ON, PWR_STOPENTRY_WFI); |
| | | #endif |
| | | } |
| | | if(g_start_send_flag&&active_flag) |
| | | if(g_start_send_flag&&active_flag&&uwb_active_flag) |
| | | { static uint16_t blink_count=0; |
| | | g_start_send_flag = 0; |
| | | // GetPressAndTemp(); |
| | |
| | | extern u16 tagslotpos; |
| | | extern uint8_t tx_near_msg[80],stationary_flag,gotosleep_flag; |
| | | float key_keeptime; |
| | | extern float motor_ontime; |
| | | extern float motor_ontime,button_delay; |
| | | void HAL_LPTIM_CompareMatchCallback(LPTIM_HandleTypeDef *hlptim) |
| | | { |
| | | static uint8_t i=0; |
| | |
| | | g_start_send_flag=1; |
| | | // current_slotnum++; |
| | | // SetNextPollTime(tagslotpos); |
| | | if(button_delay<1) |
| | | button_delay+=1/(float)tag_frequency; |
| | | nomove_count+=1/(float)tag_frequency; |
| | | if(motor_keeptime>0) |
| | | { |