mirror of
https://bitbucket.org/librepilot/librepilot.git
synced 2025-02-27 16:54:15 +01:00
Changed settings that makes updates smoother
This commit is contained in:
parent
319b53a342
commit
3888d6ff69
@ -121,7 +121,7 @@ void INSGPSInit() //pretty much just a place holder for now
|
||||
R[3] = R[4] = 0.004f; // High freq GPS horizontal velocity noise variance (m/s)^2
|
||||
R[5] = 100.0f; // High freq GPS vertical velocity noise variance (m/s)^2
|
||||
R[6] = R[7] = R[8] = 0.005f; // magnetometer unit vector noise variance
|
||||
R[9] = .005f; // High freq altimeter noise variance (m^2)
|
||||
R[9] = .25f; // High freq altimeter noise variance (m^2)
|
||||
}
|
||||
|
||||
void INSResetP(float PDiag[NUMX])
|
||||
|
@ -650,11 +650,12 @@ static int32_t updateAttitudeINSGPS(bool first_run, bool outdoor_mode)
|
||||
NEDPositionSet(&nedPos);
|
||||
|
||||
} else if (!outdoor_mode) {
|
||||
INSSetPosVelVar(1e-2f, 1e-2f);
|
||||
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;
|
||||
sensors |= POS_SENSORS |VERT_SENSORS;
|
||||
}
|
||||
|
||||
/*
|
||||
|
Loading…
x
Reference in New Issue
Block a user