mirror of
https://bitbucket.org/librepilot/librepilot.git
synced 2025-03-01 18:29:16 +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;
|
uint16_t sensors = 0;
|
||||||
float dT;
|
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
|
// 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) ||
|
if ( (xQueueReceive(gyroQueue, &ev, 10 / portTICK_RATE_MS) != pdTRUE) ||
|
||||||
|
Loading…
x
Reference in New Issue
Block a user