mirror of
https://bitbucket.org/librepilot/librepilot.git
synced 2024-11-29 07:24:13 +01:00
CC-7 Reverse order of two lines so that yaw bias converges instead of diverges
:-) git-svn-id: svn://svn.openpilot.org/OpenPilot/trunk@2693 ebee16cc-31ac-478f-84a7-5cbb03baadba
This commit is contained in:
parent
265737427b
commit
986e124202
@ -177,9 +177,9 @@ static void updateSensors()
|
||||
attitudeRaw.gyros_filtered[ATTITUDERAW_GYROS_FILTERED_Y] += gyro_correct_int[1];
|
||||
|
||||
// Because most crafts wont get enough information from gravity to zero yaw gyro
|
||||
gyro_correct_int[2] += - attitudeRaw.gyros_filtered[ATTITUDERAW_GYROS_FILTERED_Z] *
|
||||
settings.AccelKI * UPDATE_RATE / 1000;
|
||||
attitudeRaw.gyros_filtered[ATTITUDERAW_GYROS_FILTERED_Z] += gyro_correct_int[2];
|
||||
gyro_correct_int[2] += - attitudeRaw.gyros_filtered[ATTITUDERAW_GYROS_FILTERED_Z] *
|
||||
settings.AccelKI * UPDATE_RATE / 1000;
|
||||
|
||||
|
||||
// Get the accel data
|
||||
|
Loading…
Reference in New Issue
Block a user