From 9ba2539e60250c8d9332011c4305473935be9b69 Mon Sep 17 00:00:00 2001 From: Matthias Grob Date: Wed, 8 Jul 2020 18:49:46 +0200 Subject: [PATCH] FlightTaskOrbit: reset approach if radius gets changed --- src/lib/flight_tasks/tasks/Orbit/FlightTaskOrbit.cpp | 4 ++++ 1 file changed, 4 insertions(+) diff --git a/src/lib/flight_tasks/tasks/Orbit/FlightTaskOrbit.cpp b/src/lib/flight_tasks/tasks/Orbit/FlightTaskOrbit.cpp index fff035a3dd..b9c3a099fc 100644 --- a/src/lib/flight_tasks/tasks/Orbit/FlightTaskOrbit.cpp +++ b/src/lib/flight_tasks/tasks/Orbit/FlightTaskOrbit.cpp @@ -130,6 +130,10 @@ bool FlightTaskOrbit::setRadius(float r) _v = sign(_v) * sqrtf(_acceleration_max * r); } + if (fabs(_r - r) > FLT_EPSILON) { + _circle_approach_line.reset(); + } + _r = r; return true; }