diff --git a/2.Firmware/Ctrl-Step-Driver-STM32F1-fw/Ctrl/Motor/motion_planner.cpp b/2.Firmware/Ctrl-Step-Driver-STM32F1-fw/Ctrl/Motor/motion_planner.cpp index 0e1dbce..8f3a91a 100644 --- a/2.Firmware/Ctrl-Step-Driver-STM32F1-fw/Ctrl/Motor/motion_planner.cpp +++ b/2.Firmware/Ctrl-Step-Driver-STM32F1-fw/Ctrl/Motor/motion_planner.cpp @@ -243,9 +243,6 @@ void MotionPlanner::PositionTracker::CalcSoftGoal(int32_t _goalPosition) velocityIntegral = 0; trackVelocity = context->config->ratedVelocity; } - } else if (trackVelocity > context->config->ratedVelocity) - { - CalcVelocityIntegral(-velocityDownAcc); } } else { @@ -282,9 +279,6 @@ void MotionPlanner::PositionTracker::CalcSoftGoal(int32_t _goalPosition) velocityIntegral = 0; trackVelocity = -context->config->ratedVelocity; } - } else if (trackVelocity < -context->config->ratedVelocity) - { - CalcVelocityIntegral(velocityDownAcc); } } else {