EKF: Correct for sensor noise and baro offset during alignment

This commit is contained in:
Paul Riseborough
2016-02-10 10:25:27 +11:00
parent a6515543da
commit 40e174b81c
5 changed files with 81 additions and 57 deletions
+1 -1
View File
@@ -78,7 +78,7 @@ void Ekf::resetPosition()
}
baroSample baro_newest = _baro_buffer.get_newest();
_state.pos(2) = -baro_newest.hgt;
_state.pos(2) = _baro_at_alignment - baro_newest.hgt;
}
#if defined(__PX4_POSIX) && !defined(__PX4_QURT)