| | |
| | | uint16_t lastpoll_count,interval_count,slot_startcount,tag_frequency,lastpoll_time,current_time; |
| | | extern uint8_t module_power; |
| | | extern float nomove_count; |
| | | uint8_t imu_enable,motor_enable; |
| | | uint8_t imu_enable,motor_enable; |
| | | float cltimeleft; |
| | | u16 GetLPTime(void) |
| | | { |
| | | u16 count=HAL_LPTIM_ReadCounter(&hlptim1); |
| | |
| | | } |
| | | break; |
| | | case 2: |
| | | if(cltimeleft<=0) |
| | | { |
| | | cltimeleft = g_com_map[COOLINGTIME_INDEX]; |
| | | } |
| | | if(cltimeleft>g_com_map[COOLINGTIME_INDEX]-20) |
| | | { |
| | | if(hardware_type==NSH1) |
| | | {MOTOR_ON; |
| | | }else if(hardware_type==GP) |
| | | { |
| | | HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_3); |
| | | } |
| | | }else{ |
| | | MOTOR_OFF; |
| | | } |
| | | break; |
| | | case 3: |
| | | if(hardware_type==NSH1) |
| | |
| | | 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] = (1<<8)|28; |
| | | g_com_map[VERSION] = (1<<8)|30; |
| | | active_flag = g_com_map[ACTIVE_INDEX]; |
| | | module_power = g_com_map[POWER]; |
| | | imu_enable=g_com_map[IMU_ENABLE]; |
| | |
| | | current_slotnum++; |
| | | SetNextPollTime(tyncpoll_time); |
| | | nomove_count+=(float)g_com_map[COM_INTERVAL]/1000; |
| | | if(cltimeleft>0) |
| | | { |
| | | cltimeleft-=(float)g_com_map[COM_INTERVAL]/1000; |
| | | } |
| | | if(motor_keeptime>0) |
| | | { |
| | | motor_keeptime-=(float)g_com_map[COM_INTERVAL]/1000; |