| | |
|---|
| | | // g_com_map[MOTOR_ONTIME]--; |
|---|
| | | // motor_state = 1; |
|---|
| | | // } |
|---|
| | | if(g_com_map[MOTOR_ENABLE]) |
|---|
| | | if(0)//g_com_map[MOTOR_ENABLE]) |
|---|
| | | { |
|---|
| | | |
|---|
| | | |
|---|
| | |
|---|
| | | 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)|30; |
|---|
| | | g_com_map[VERSION] = (1<<8)|35; |
|---|
| | | active_flag = g_com_map[ACTIVE_INDEX]; |
|---|
| | | module_power = g_com_map[POWER]; |
|---|
| | | imu_enable=g_com_map[IMU_ENABLE]; |
|---|
| | |
|---|
| | | { |
|---|
| | | waitusart_timer--; |
|---|
| | | } |
|---|
| | | if(m_bEUARTTxEn==0&&waitusart_timer==0&&(motor_state==0||motor_state==3)) |
|---|
| | | if(m_bEUARTTxEn==0&&waitusart_timer==0) |
|---|
| | | { |
|---|
| | | #ifndef DEBUG_MODE |
|---|
| | | if(!HAL_GPIO_ReadPin(INPUT_5V_GPIO_Port,INPUT_5V_Pin)) |
|---|
| | |
|---|
| | | }else{ |
|---|
| | | stationary_flag = 0; |
|---|
| | | } |
|---|
| | | if(nomove_count>=nomovesleeptime-1&&imu_enable) |
|---|
| | | { |
|---|
| | | tx_near_msg[TAGSTATE] = tx_near_msg[TAGSTATE]|GOINGSLEEPBIT; |
|---|
| | | } |
|---|
| | | if(nomove_count>nomovesleeptime&&imu_enable) |
|---|
| | | { |
|---|
| | | mcu_sleep(); |
|---|
| | | } |
|---|
| | | //if(nomove_count>=nomovesleeptime-1&&imu_enable) |
|---|
| | | // { |
|---|
| | | // tx_near_msg[TAGSTATE] = tx_near_msg[TAGSTATE]|GOINGSLEEPBIT; |
|---|
| | | // } |
|---|
| | | // if(nomove_count>nomovesleeptime&&imu_enable) |
|---|
| | | // { |
|---|
| | | // mcu_sleep(); |
|---|
| | | // } |
|---|
| | | } |
|---|
| | | /* USER CODE END 4 */ |
|---|
| | | |
|---|
