From 0d0b87e1934594e808e1bfd8cd11e493603a3e46 Mon Sep 17 00:00:00 2001 From: Thomas Debrunner Date: Thu, 7 Oct 2021 16:24:03 +0200 Subject: [PATCH] Update src/modules/flight_mode_manager/tasks/Orbit/FlightTaskOrbit.cpp Co-authored-by: Mathieu Bresciani --- src/modules/flight_mode_manager/tasks/Orbit/FlightTaskOrbit.cpp | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/src/modules/flight_mode_manager/tasks/Orbit/FlightTaskOrbit.cpp b/src/modules/flight_mode_manager/tasks/Orbit/FlightTaskOrbit.cpp index 0ba086e92b..9c40964456 100644 --- a/src/modules/flight_mode_manager/tasks/Orbit/FlightTaskOrbit.cpp +++ b/src/modules/flight_mode_manager/tasks/Orbit/FlightTaskOrbit.cpp @@ -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(); } }