FlightTaskManualAltitudeSmooth: update vel sp z

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();