From 31eaaada62eb238d3a551216e8e7bfdb36b65ee0 Mon Sep 17 00:00:00 2001 From: Andrew Tridgell Date: Mon, 4 Nov 2013 13:58:34 +1100 Subject: [PATCH] AP_AHRS: removed vertical G limit on GPS velocity correction this limit could lead to a bias in the accel drift correction, and is frequenctly exceeded --- libraries/AP_AHRS/AP_AHRS_DCM.cpp | 3 --- 1 file changed, 3 deletions(-) diff --git a/libraries/AP_AHRS/AP_AHRS_DCM.cpp b/libraries/AP_AHRS/AP_AHRS_DCM.cpp index 6e619b0363..524ab0b7fa 100644 --- a/libraries/AP_AHRS/AP_AHRS_DCM.cpp +++ b/libraries/AP_AHRS/AP_AHRS_DCM.cpp @@ -551,9 +551,6 @@ AP_AHRS_DCM::drift_correction(float deltat) if (_flags.correct_centrifugal && (_have_gps_lock || _flags.fly_forward)) { float v_scale = gps_gain.get()/(_ra_deltat*GRAVITY_MSS); Vector3f vdelta = (velocity - _last_velocity) * v_scale; - // limit vertical acceleration correction to 0.5 gravities. The - // barometer sometimes gives crazy acceleration changes. - vdelta.z = constrain_float(vdelta.z, -0.5f, 0.5f); GA_e += vdelta; GA_e.normalize(); if (GA_e.is_inf()) {