diff --git a/src/lib/FlightTasks/tasks/FlightTaskManualAltitudeSmooth.cpp b/src/lib/FlightTasks/tasks/FlightTaskManualAltitudeSmooth.cpp
index 09d396ad01..a0816e6d39 100644
--- a/src/lib/FlightTasks/tasks/FlightTaskManualAltitudeSmooth.cpp
+++ b/src/lib/FlightTasks/tasks/FlightTaskManualAltitudeSmooth.cpp
@@ -61,6 +61,7 @@ void FlightTaskManualAltitudeSmooth::_updateSetpoints()
 	/* Smooth velocity setpoint */
 	float vel_sp[2] = {_vel_sp_z, _vel_sp_prev_z};
 	_smoothing.smoothVelFromSticks(vel_sp, _deltatime);
+	_vel_sp_z = vel_sp[0];
 
 	/* Check for altitude lock*/
 	_updateAltitudeLock();