|
|
|
@ -753,12 +753,12 @@ static void Custom_ModuleHandler(const Msg_t *pstMsg) |
|
|
|
if (uiFailtCode[0] == 1) |
|
|
|
{ |
|
|
|
g_stIV.Left_Motor_Err = uiFailtCode[1]; |
|
|
|
MsgCenter_SendTo(MODULE_NAME_DAEMON, DAEMON_SET_LEFT_MOTOR, NULL, 0); |
|
|
|
MsgCenter_SendTo(MODULE_NAME_DAEMON, SET_DAEMON_LEFT_MOTOR, NULL, 0); |
|
|
|
} |
|
|
|
else if (uiFailtCode[0] == 2) |
|
|
|
{ |
|
|
|
g_stIV.Right_Motor_Err = uiFailtCode[1]; |
|
|
|
MsgCenter_SendTo(MODULE_NAME_DAEMON, DAEMON_SET_RIGHT_MOTOR, NULL, 0); |
|
|
|
MsgCenter_SendTo(MODULE_NAME_DAEMON, SET_DAEMON_RIGHT_MOTOR, NULL, 0); |
|
|
|
} |
|
|
|
} |
|
|
|
break; |
|
|
|
@ -772,11 +772,11 @@ static void Custom_ModuleHandler(const Msg_t *pstMsg) |
|
|
|
if (1 == iCurrentSpeed[0]) |
|
|
|
{ |
|
|
|
g_stIV.CurrentSpeed = iCurrentSpeed[1]; |
|
|
|
MsgCenter_SendTo(MODULE_NAME_DAEMON, DAEMON_SET_LEFT_MOTOR, NULL, 0); |
|
|
|
MsgCenter_SendTo(MODULE_NAME_DAEMON, SET_DAEMON_LEFT_MOTOR, NULL, 0); |
|
|
|
} |
|
|
|
else |
|
|
|
{ |
|
|
|
MsgCenter_SendTo(MODULE_NAME_DAEMON, DAEMON_SET_RIGHT_MOTOR, NULL, 0); |
|
|
|
MsgCenter_SendTo(MODULE_NAME_DAEMON, SET_DAEMON_RIGHT_MOTOR, NULL, 0); |
|
|
|
} |
|
|
|
} |
|
|
|
break; |
|
|
|
@ -848,7 +848,7 @@ static void Custom_ModuleHandler(const Msg_t *pstMsg) |
|
|
|
} |
|
|
|
else |
|
|
|
{ |
|
|
|
MsgCenter_SendTo(MODULE_NAME_DAEMON, DAEMON_SET_BUTTON_RESET, NULL, 0); |
|
|
|
MsgCenter_SendTo(MODULE_NAME_DAEMON, SET_DAEMON_BUTTON_RESET, NULL, 0); |
|
|
|
} |
|
|
|
|
|
|
|
if (iMotorOK == 0) // 电机还没初始化完,不执行后边
|
|
|
|
|