mirror of
https://bitbucket.org/librepilot/librepilot.git
synced 2024-12-02 10:24:11 +01:00
Revert "Disable baro updates into INSGPS for now. Seems to cause issues."
This reverts commit 04591309770679e7b01c53a6cb54cac1c043f8b6.
This commit is contained in:
parent
fcb9193d25
commit
414e62f14e
@ -673,18 +673,13 @@ static int32_t updateAttitudeINSGPS(bool first_run, bool outdoor_mode)
|
||||
nedPos.Down = NED[2];
|
||||
NEDPositionSet(&nedPos);
|
||||
|
||||
// Mask out baro sensor for outdoor mode. Causing issues right now.
|
||||
sensors &= ~BARO_SENSOR;
|
||||
} else if (!outdoor_mode) {
|
||||
INSSetPosVelVar(1e2f, 1e2f);
|
||||
vel[0] = vel[1] = vel[2] = 0;
|
||||
NED[0] = NED[1] = 0;
|
||||
NED[2] = baroData.Altitude;
|
||||
sensors |= HORIZ_SENSORS | HORIZ_POS_SENSORS;
|
||||
|
||||
// Mask out baro sensor for indoor mode. Causing issues right now.
|
||||
sensors &= ~BARO_SENSOR;
|
||||
NED[2] = -baroData.Altitude;
|
||||
sensors |= VER_POS_SENSORS;
|
||||
sensors |= POS_SENSORS |VERT_SENSORS;
|
||||
}
|
||||
|
||||
/*
|
||||
|
Loading…
Reference in New Issue
Block a user