1
0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2025-03-15 07:29:15 +01:00

Merge branch 'corvuscorax/OP-946_refaktor_sensor_and_state' into corvuscorax/OP-947_stateestimator-module

This commit is contained in:
Corvus Corax 2013-05-20 20:53:46 +02:00
commit 3dda543608

View File

@ -476,8 +476,8 @@ static int32_t updateAttitudeComplementary(bool first_run)
// Accumulate integral of error. Scale here so that units are (deg/s) but Ki has units of s
gyro_bias[0] -= accel_err[0] * attitudeSettings.AccelKi;
gyro_bias[0] -= accel_err[1] * attitudeSettings.AccelKi;
gyro_bias[0] -= mag_err[2] * magKi;
gyro_bias[1] -= accel_err[1] * attitudeSettings.AccelKi;
gyro_bias[2] -= mag_err[2] * magKi;
// Correct rates based on integral coefficient
gyroStateData.x -= gyro_bias[0];