1
0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2024-11-29 07:24:13 +01:00

Merge branch 'D-Lite/fix_CC3D_yawBias_correction' into next

This commit is contained in:
Werner Backes 2012-09-06 13:47:03 +02:00
commit 2a4e135c81

View File

@ -420,6 +420,10 @@ static int32_t updateSensorsCC3D(AccelsData * accelsData, GyrosData * gyrosData)
gyrosData->z += gyro_correct_int[2];
}
// Because most crafts wont get enough information from gravity to zero yaw gyro, we try
// and make it average zero (weakly)
gyro_correct_int[2] += - gyrosData->z * yawBiasRate;
GyrosSet(gyrosData);
AccelsSet(accelsData);