Skip to content
Snippets Groups Projects
Commit 4cace1bb authored by bresch's avatar bresch
Browse files

Manual vel smooth - use speed_up and speed_down constraints to limit velocity...

Manual vel smooth - use speed_up and speed_down constraints to limit velocity target of the trajectory generator
parent b7c2464c
No related branches found
No related tags found
No related merge requests found
......@@ -95,11 +95,11 @@ void FlightTaskManualPositionSmoothVel::_updateSetpoints()
if (_velocity_setpoint(2) < 0.f) { // up
_smoothing[2].setMaxAccel(MPC_ACC_UP_MAX.get());
_smoothing[2].setMaxVel(MPC_Z_VEL_MAX_UP.get());
_smoothing[2].setMaxVel(_constraints.speed_up);
} else { // down
_smoothing[2].setMaxAccel(MPC_ACC_DOWN_MAX.get());
_smoothing[2].setMaxVel(MPC_Z_VEL_MAX_DN.get());
_smoothing[2].setMaxVel(_constraints.speed_down);
}
float jerk[3] = {_jerk_max.get(), _jerk_max.get(), _jerk_max.get()};
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment