mirror of
https://bitbucket.org/librepilot/librepilot.git
synced 2024-12-02 10:24:11 +01:00
Make sure full initialization routine for INSGPS occurs each time it is
restarted.
This commit is contained in:
parent
372f959c37
commit
319b53a342
@ -464,7 +464,10 @@ static int32_t updateAttitudeINSGPS(bool first_run, bool outdoor_mode)
|
||||
uint16_t sensors = 0;
|
||||
float dT;
|
||||
|
||||
inited = first_run ? false : inited;
|
||||
if (first_run) {
|
||||
inited = false;
|
||||
init_stage = 0;
|
||||
}
|
||||
|
||||
// Wait until the gyro and accel object is updated, if a timeout then go to failsafe
|
||||
if ( (xQueueReceive(gyroQueue, &ev, 10 / portTICK_RATE_MS) != pdTRUE) ||
|
||||
|
Loading…
Reference in New Issue
Block a user