Browse Source

AP_Compass: Skip rotating the mag data when the board orientation is none

c415-sdk
Michael du Breuil 5 years ago committed by Andrew Tridgell
parent
commit
9b404669c8
  1. 2
      libraries/AP_Compass/AP_Compass_Backend.cpp

2
libraries/AP_Compass/AP_Compass_Backend.cpp

@ -15,7 +15,9 @@ AP_Compass_Backend::AP_Compass_Backend()
void AP_Compass_Backend::rotate_field(Vector3f &mag, uint8_t instance) void AP_Compass_Backend::rotate_field(Vector3f &mag, uint8_t instance)
{ {
Compass::mag_state &state = _compass._state[Compass::StateIndex(instance)]; Compass::mag_state &state = _compass._state[Compass::StateIndex(instance)];
if (MAG_BOARD_ORIENTATION != ROTATION_NONE) {
mag.rotate(MAG_BOARD_ORIENTATION); mag.rotate(MAG_BOARD_ORIENTATION);
}
mag.rotate(state.rotation); mag.rotate(state.rotation);
if (!state.external) { if (!state.external) {

Loading…
Cancel
Save