diff --git a/Core/Src/FSM.c b/Core/Src/FSM.c index 88a1f2c..b478f99 100644 --- a/Core/Src/FSM.c +++ b/Core/Src/FSM.c @@ -668,7 +668,7 @@ void GF_Dispatch() //2ms调用一次 给车体速度等赋值 CV.TurnLeftRightSpeed = abs((2 * 186.9 * (P_U7->CH1_LYB_H)) / 1000);//RobotSpeed指向GV的移动车体速度 这是整体车速 不是单个轮的 GV.Robot_AutoSpeed = GV.PV.Robot_AutoSpeedBase * 186.9; - // IV_control(); + IV_control(); action_perfrom(MoveTransitions, sizeof(MoveTransitions) / sizeof(transition_t), CurrentMoveState);//结构体数组/大小/当前状态