| | |
|---|
| | | // LED_TR_OFF; |
|---|
| | | current_time=GetLPTime(); |
|---|
| | | //motor_state=2; |
|---|
| | | if(g_com_map[MOTOR_ONTIME]>0) |
|---|
| | | { |
|---|
| | | g_com_map[MOTOR_ONTIME]--; |
|---|
| | | motor_state = 1; |
|---|
| | | } |
|---|
| | | // if(g_com_map[MOTOR_ONTIME]>0) |
|---|
| | | // { |
|---|
| | | // g_com_map[MOTOR_ONTIME]--; |
|---|
| | | // motor_state = 1; |
|---|
| | | // } |
|---|
| | | |
|---|
| | | switch(motor_state) |
|---|
| | | {case 0: |
|---|
| | | MOTOR_OFF; |
|---|
| | | break; |
|---|
| | | case 1: |
|---|
| | | if(current_time<MOTOR_ONTIME) |
|---|
| | | if(current_time<WARNING_MOTORONTIME) |
|---|
| | | { |
|---|
| | | MOTOR_ON; |
|---|
| | | }else{ |
|---|
| | |
|---|
| | | Usart1ParseDataCallback = UsartParseDataHandler; |
|---|
| | | parameter_init(); |
|---|
| | | //deca_sleep(1000); |
|---|
| | | g_com_map[VERSION] = 0x0110; |
|---|
| | | g_com_map[VERSION] = 0x0113; |
|---|
| | | #ifdef DEBUG_MODE |
|---|
| | | // g_com_map[DEV_ROLE]=1; |
|---|
| | | // g_com_map[DEV_ID]=1; |
|---|
| | |
|---|
| | | // g_com_map[MAX_REPORT_ANC_NUM]=1; |
|---|
| | | g_com_map[NOMOVESLEEP_TIME]=10; |
|---|
| | | #endif |
|---|
| | | |
|---|
| | | if(g_com_map[COM_INTERVAL]==0) |
|---|
| | | { |
|---|
| | | g_com_map[COM_INTERVAL]=100; |
|---|
| | |
|---|
| | | { |
|---|
| | | waitusart_timer--; |
|---|
| | | } |
|---|
| | | if(m_bEUARTTxEn==0&&waitusart_timer==0) |
|---|
| | | if(m_bEUARTTxEn==0&&waitusart_timer==0&&(motor_state==0||motor_state==3)) |
|---|
| | | { |
|---|
| | | #ifndef DEBUG_MODE |
|---|
| | | #ifndef DEBUG_MODE |
|---|
| | | if(!HAL_GPIO_ReadPin(INPUT_5V_GPIO_Port,INPUT_5V_Pin)) |
|---|
| | | HAL_PWR_EnterSTOPMode(PWR_LOWPOWERREGULATOR_ON, PWR_STOPENTRY_WFI); |
|---|
| | | #endif |
|---|
| | | } |
|---|
