Mirror/inav
1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-18 22:05:15 +03:00
Code Issues Wiki Activity

Update navigation_fixedwing.c

Browse source
This commit is contained in:
breadoven 2022-12-19 00:28:08 +00:00
parent e7f9f6e135
commit d86ff58c94
1 changed files with 2 additions and 1 deletions
Download patch file Download diff file Expand all files Collapse all files

3
src/main/navigation/navigation_fixedwing.c
View file

@ -394,12 +394,13 @@ static void updatePositionHeadingController_FW(timeUs_t currentTimeUs, timeDelta
static int32_t previousHeadingError; static int32_t previousHeadingError;
static bool errorIsDecreasing; static bool errorIsDecreasing;
static bool forceTurnDirection = false; static bool forceTurnDirection = false;
int32_t virtualTargetBearing;
if (FLIGHT_MODE(NAV_COURSE_HOLD_MODE)) { if (FLIGHT_MODE(NAV_COURSE_HOLD_MODE)) {
virtualTargetBearing = posControl.desiredState.yaw; virtualTargetBearing = posControl.desiredState.yaw;
} else { } else {
// We have virtual position target, calculate heading error // We have virtual position target, calculate heading error
int32_t virtualTargetBearing = calculateBearingToDestination(&virtualDesiredPosition); virtualTargetBearing = calculateBearingToDestination(&virtualDesiredPosition);
} }
/* If waypoint tracking enabled quickly force craft toward waypoint course line and closely track along it */ /* If waypoint tracking enabled quickly force craft toward waypoint course line and closely track along it */