Browse Source

git-svn-id: https://arducopter.googlecode.com/svn/trunk@1002 f9c3cf11-9bcb-44bc-f272-b75c42450872

mission-4.1.18
jasonshort 14 years ago
parent
commit
b62c287f5e
  1. 2
      libraries/AP_DCM/AP_DCM.cpp

2
libraries/AP_DCM/AP_DCM.cpp

@ -262,7 +262,7 @@ AP_DCM::drift_correction(void) @@ -262,7 +262,7 @@ AP_DCM::drift_correction(void)
if (_compass) {
// We make the gyro YAW drift correction based on compass magnetic heading
error_course= (_dcm_matrix.a.x * _compass->headingY) - (_dcm_matrix.b.x * _compass->headingX); // Equation 23, Calculating YAW error
error_course= (_dcm_matrix.a.x * _compass->heading_y) - (_dcm_matrix.b.x * _compass->heading_x); // Equation 23, Calculating YAW error
} else {
// Use GPS Ground course to correct yaw gyro drift
if (_gps->ground_speed >= SPEEDFILT) {

Loading…
Cancel
Save