estimated IMU bias preflight checks

- commander preflightcheck use estimator_sensor_bias message instead of EKF state index magic number
 - ekf2 publish estimated bias limits in estimator_sensor_bias
 - preflightcheck only error if bias estimate exceeds half of configured limit (delete COM_ARM_EKF_AB and COM_ARM_EKF_GB parameters)
This commit is contained in:
Daniel Agar
2021-01-12 09:09:42 +01:00
committed by Lorenz Meier
parent 7c95e99156
commit 48f125f150
10 changed files with 51 additions and 70 deletions
-25
View File
@@ -556,31 +556,6 @@ PARAM_DEFINE_FLOAT(COM_ARM_EKF_HGT, 1.0f);
*/
PARAM_DEFINE_FLOAT(COM_ARM_EKF_YAW, 0.5f);
/**
* Maximum value of EKF accelerometer delta velocity bias estimate that will allow arming.
* Note: ekf2 will limit the delta velocity bias estimate magnitude to be less than EKF2_ABL_LIM * FILTER_UPDATE_PERIOD_MS * 0.001 so this parameter must be less than that to be useful.
*
* @group Commander
* @unit m/s
* @min 0.001
* @max 0.01
* @decimal 4
* @increment 0.0001
*/
PARAM_DEFINE_FLOAT(COM_ARM_EKF_AB, 0.0022f);
/**
* Maximum value of EKF gyro delta angle bias estimate that will allow arming
*
* @group Commander
* @unit rad
* @min 0.0001
* @max 0.0017
* @decimal 4
* @increment 0.0001
*/
PARAM_DEFINE_FLOAT(COM_ARM_EKF_GB, 0.0011f);
/**
* Maximum accelerometer inconsistency between IMU units that will allow arming
*