|
|
@ -167,13 +167,22 @@ void MotorTask(void *argument) |
|
|
{ |
|
|
{ |
|
|
// 处理消息
|
|
|
// 处理消息
|
|
|
MsgCenter_ProcessWait(g_uiMotorModuleID, 2); |
|
|
MsgCenter_ProcessWait(g_uiMotorModuleID, 2); |
|
|
|
|
|
Rd_Delay(2); |
|
|
MotorMgr_RequestPosition(g_apstMotors[0]); |
|
|
MotorMgr_RequestPosition(g_apstMotors[0]); |
|
|
|
|
|
Rd_Delay(2); |
|
|
MotorMgr_RequestPosition(g_apstMotors[1]); |
|
|
MotorMgr_RequestPosition(g_apstMotors[1]); |
|
|
|
|
|
Rd_Delay(2); |
|
|
MotorMgr_RequestFault(g_apstMotors[0]); |
|
|
MotorMgr_RequestFault(g_apstMotors[0]); |
|
|
|
|
|
Rd_Delay(2); |
|
|
MotorMgr_RequestFault(g_apstMotors[1]); |
|
|
MotorMgr_RequestFault(g_apstMotors[1]); |
|
|
|
|
|
Rd_Delay(2); |
|
|
MotorMgr_RequestVelocity(g_apstMotors[0]); |
|
|
MotorMgr_RequestVelocity(g_apstMotors[0]); |
|
|
|
|
|
Rd_Delay(2); |
|
|
MotorMgr_RequestVelocity(g_apstMotors[1]); |
|
|
MotorMgr_RequestVelocity(g_apstMotors[1]); |
|
|
|
|
|
Rd_Delay(2); |
|
|
MotorMgr_SetTargetSpeed(g_apstMotors[0], g_aiMotorSpeed[0]); |
|
|
MotorMgr_SetTargetSpeed(g_apstMotors[0], g_aiMotorSpeed[0]); |
|
|
|
|
|
Rd_Delay(2); |
|
|
MotorMgr_SetTargetSpeed(g_apstMotors[1], g_aiMotorSpeed[1]); |
|
|
MotorMgr_SetTargetSpeed(g_apstMotors[1], g_aiMotorSpeed[1]); |
|
|
|
|
|
Rd_Delay(2); |
|
|
} |
|
|
} |
|
|
} |
|
|
} |
|
|
|