FWModeManager: use always bearing to Takeoff waypoint (if defined)

Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
This commit is contained in:
Silvan Fuhrer
2025-07-14 14:29:59 +02:00
parent 782e510105
commit b326714d7c
2 changed files with 7 additions and 5 deletions
+1 -1
View File
@@ -640,7 +640,7 @@ void Navigator::run()
rep->next.valid = false;
// after the straight climbout the vehicle will establish on a loiter at this position
// Fixed-wing: vehicle will takeoff towards these coordinates and establish on a loiter there
_takeoff.setLoiterPosition(matrix::Vector2d(cmd.param5, cmd.param6));
_takeoff.setLoiterAltitudeAmsl(cmd.param7);