Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-02 14:08:45 -04:00
Code Issues Packages Projects Releases Wiki Activity

Compass: fixed the order of rotations in the compass driver

Browse Source 
this should fix the massive heading issues that people have been
reporting. Please test!
This commit is contained in:
Andrew Tridgell 2012-03-12 17:28:07 +11:00
parent c08fd50542
commit 7daaadf776
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/AP_Compass/AP_Compass_HMC5843.cpp
View File

@ -264,10 +264,10 @@ bool AP_Compass_HMC5843::read()
// rotate to the desired orientation
Vector3f rot_mag = Vector3f(mag_x,mag_y,mag_z);
rot_mag.rotate(_orientation);
if (product_id == AP_COMPASS_TYPE_HMC5883L) {
rot_mag.rotate(ROTATION_YAW_90);
}
rot_mag.rotate(_orientation);
rot_mag += _offset.get();
mag_x = rot_mag.x;