Browse Source

AP_NavEKF2: use vector comparison for new mag vector

mission-4.1.18
Andrew Tridgell 9 years ago
parent
commit
ac60901b0c
  1. 2
      libraries/AP_NavEKF2/AP_NavEKF2_Measurements.cpp

2
libraries/AP_NavEKF2/AP_NavEKF2_Measurements.cpp

@ -185,7 +185,7 @@ void NavEKF2_core::readMagData() @@ -185,7 +185,7 @@ void NavEKF2_core::readMagData()
// detect changes to magnetometer offset parameters and reset states
Vector3f nowMagOffsets = _ahrs->get_compass()->get_offsets(magSelectIndex);
bool changeDetected = lastMagOffsetsValid && (!is_equal(nowMagOffsets.x,lastMagOffsets.x) || !is_equal(nowMagOffsets.y,lastMagOffsets.y) || !is_equal(nowMagOffsets.z,lastMagOffsets.z));
bool changeDetected = lastMagOffsetsValid && (nowMagOffsets != lastMagOffsets);
if (changeDetected) {
// zero the learned magnetometer bias states
stateStruct.body_magfield.zero();

Loading…
Cancel
Save