Update src/modules/flight_mode_manager/tasks/Orbit/FlightTaskOrbit.cpp

Co-authored-by: Mathieu Bresciani <brescianimathieu@gmail.com>
This commit is contained in:
Thomas Debrunner
2021-10-07 16:24:03 +02:00
committed by Matthias Grob
parent 9bd46be124
commit 0d0b87e193
@@ -223,7 +223,7 @@ bool FlightTaskOrbit::update()
_velocity_setpoint(2) = _altitude_velocity_smoothing.getCurrentVelocity();
_acceleration_setpoint(2) = _altitude_velocity_smoothing.getCurrentAcceleration();
// set orbit altitude center to expected new altitude
_center(2) = _position(2) + _deltatime * _velocity_setpoint(2);
_center(2) = _altitude_velocity_smoothing.getCurrentPosition();
}
}