rooty/LibrePilot
1
0
Fork 0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2025-02-18 08:54:15 +01:00
Code Issues Releases Activity

Switch order of some commands to make sure it loads the correct hover throttle

Browse Source
This commit is contained in:
James Cotton 2012-02-08 20:47:10 -06:00
parent ab41bae071
commit 80d602ef7b
1 changed files with 6 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
flight/Modules/AltitudeHold/altitudehold.c
View File

@ -108,6 +108,8 @@ float decay;
float velocity_decay;
bool running = false;
float error;
float switchThrottle;
float smoothed_altitude;
/**
* Module thread, should not return.
@ -191,12 +193,14 @@ static void altitudeHoldTask(void *parameters)
FlightStatusGet(&flightStatus);
if(flightStatus.FlightMode == FLIGHTSTATUS_FLIGHTMODE_ALTITUDEHOLD && !running) {
BaroAltitudeConnectQueue(queue);
// Copy the current throttle as a starting point for integral
StabilizationDesiredThrottleGet(&throttleIntegral);
BaroAltitudeAltitudeGet(&lastAltitude);
switchThrottle = throttleIntegral;
error = 0;
velocity = 0;
running = true;
BaroAltitudeAltitudeGet(&lastAltitude);
BaroAltitudeConnectQueue(queue);
}
} else if (ev.obj == AltitudeHoldDesiredHandle()) {