Browse Source

AP_AHRS: use rotateXY for speed

Saves 0.1ms at 100hz
mission-4.1.18
Randy Mackay 12 years ago
parent
commit
0325ad5d0d
  1. 2
      libraries/AP_AHRS/AP_AHRS_DCM.cpp

2
libraries/AP_AHRS/AP_AHRS_DCM.cpp

@ -440,7 +440,7 @@ AP_AHRS_DCM::drift_correction(float deltat) @@ -440,7 +440,7 @@ AP_AHRS_DCM::drift_correction(float deltat)
drift_correction_yaw();
// apply trim
temp_dcm.rotate(_trim);
temp_dcm.rotateXY(_trim);
// rotate accelerometer values into the earth frame
_accel_ef = temp_dcm * _accel_vector;

Loading…
Cancel
Save