From 7db0244dac4b27df306c7dbe1e1db5e744fc3757 Mon Sep 17 00:00:00 2001 From: Andrew Tridgell Date: Sun, 19 Oct 2014 16:59:31 +1100 Subject: [PATCH] AP_Compass: added some comments --- libraries/AP_Compass/Compass.cpp | 11 +++++++++-- 1 file changed, 9 insertions(+), 2 deletions(-) diff --git a/libraries/AP_Compass/Compass.cpp b/libraries/AP_Compass/Compass.cpp index 72324406c4..818fc418ab 100644 --- a/libraries/AP_Compass/Compass.cpp +++ b/libraries/AP_Compass/Compass.cpp @@ -463,16 +463,23 @@ bool Compass::configured(void) return all_configured; } +/* + apply offset and motor compensation corrections + */ void Compass::apply_corrections(Vector3f &mag, uint8_t i) { const Vector3f &offsets = _offset[i].get(); const Vector3f &mot = _motor_compensation[i].get(); - + + /* + note that _motor_offset[] is kept even if compensation is not + being applied so it can be logged correctly + */ mag += offsets; if(_motor_comp_type != AP_COMPASS_MOT_COMP_DISABLED && _thr_or_curr != 0.0f) { _motor_offset[i] = mot * _thr_or_curr; mag += _motor_offset[i]; - }else{ + } else { _motor_offset[i].zero(); } }