|
|
@ -70,7 +70,7 @@ static void RBcore_ModuleHandler(const Msg_t *pstMsg) |
|
|
{ |
|
|
{ |
|
|
aiMotorSpeed[0] = iSpeed; |
|
|
aiMotorSpeed[0] = iSpeed; |
|
|
aiMotorSpeed[1] = iSpeed; |
|
|
aiMotorSpeed[1] = iSpeed; |
|
|
MsgCenter_SendTo(MODULE_NAME_MOTOR, MOTOR_CMD_SET_SPEED, aiMotorSpeed, sizeof(aiMotorSpeed)); |
|
|
MsgCenter_SendTo(MODULE_NAME_MOTOR, MOTOR_SET_SPEED, aiMotorSpeed, sizeof(aiMotorSpeed)); |
|
|
} |
|
|
} |
|
|
break; |
|
|
break; |
|
|
} |
|
|
} |
|
|
@ -80,7 +80,7 @@ static void RBcore_ModuleHandler(const Msg_t *pstMsg) |
|
|
{ |
|
|
{ |
|
|
aiMotorSpeed[0] = -iSpeed; |
|
|
aiMotorSpeed[0] = -iSpeed; |
|
|
aiMotorSpeed[1] = -iSpeed; |
|
|
aiMotorSpeed[1] = -iSpeed; |
|
|
MsgCenter_SendTo(MODULE_NAME_MOTOR, MOTOR_CMD_SET_SPEED, aiMotorSpeed, sizeof(aiMotorSpeed)); |
|
|
MsgCenter_SendTo(MODULE_NAME_MOTOR, MOTOR_SET_SPEED, aiMotorSpeed, sizeof(aiMotorSpeed)); |
|
|
} |
|
|
} |
|
|
break; |
|
|
break; |
|
|
} |
|
|
} |
|
|
@ -90,7 +90,7 @@ static void RBcore_ModuleHandler(const Msg_t *pstMsg) |
|
|
{ |
|
|
{ |
|
|
aiMotorSpeed[0] = -g_stCV.LeftTurnSpeed; |
|
|
aiMotorSpeed[0] = -g_stCV.LeftTurnSpeed; |
|
|
aiMotorSpeed[1] = g_stCV.RightTurnSpeed; |
|
|
aiMotorSpeed[1] = g_stCV.RightTurnSpeed; |
|
|
MsgCenter_SendTo(MODULE_NAME_MOTOR, MOTOR_CMD_SET_SPEED, aiMotorSpeed, sizeof(aiMotorSpeed)); |
|
|
MsgCenter_SendTo(MODULE_NAME_MOTOR, MOTOR_SET_SPEED, aiMotorSpeed, sizeof(aiMotorSpeed)); |
|
|
} |
|
|
} |
|
|
break; |
|
|
break; |
|
|
} |
|
|
} |
|
|
@ -100,7 +100,7 @@ static void RBcore_ModuleHandler(const Msg_t *pstMsg) |
|
|
{ |
|
|
{ |
|
|
aiMotorSpeed[0] = g_stCV.LeftTurnSpeed; |
|
|
aiMotorSpeed[0] = g_stCV.LeftTurnSpeed; |
|
|
aiMotorSpeed[1] = -g_stCV.RightTurnSpeed; |
|
|
aiMotorSpeed[1] = -g_stCV.RightTurnSpeed; |
|
|
MsgCenter_SendTo(MODULE_NAME_MOTOR, MOTOR_CMD_SET_SPEED, aiMotorSpeed, sizeof(aiMotorSpeed)); |
|
|
MsgCenter_SendTo(MODULE_NAME_MOTOR, MOTOR_SET_SPEED, aiMotorSpeed, sizeof(aiMotorSpeed)); |
|
|
} |
|
|
} |
|
|
break; |
|
|
break; |
|
|
} |
|
|
} |
|
|
|