From 381c2b52ac129b97f3eca5fbc94db67e217aea71 Mon Sep 17 00:00:00 2001 From: "dw.xiong" <1308455330@qq.com> Date: Mon, 2 Apr 2018 22:52:32 +0800 Subject: [PATCH] commander: Remove the ekf pre-flight check variables that are not used in commander. (#9226) --- src/modules/commander/commander.cpp | 35 ----------------------------- 1 file changed, 35 deletions(-) diff --git a/src/modules/commander/commander.cpp b/src/modules/commander/commander.cpp index 88fbaca21d..bd2cc8f702 100644 --- a/src/modules/commander/commander.cpp +++ b/src/modules/commander/commander.cpp @@ -187,17 +187,6 @@ static hrt_abstime last_lvel_fail_time_us = 0; // Last time that the local veloc static hrt_abstime gpos_last_update_time_us = 0; // last time a global position update was received (usec) -/* pre-flight EKF checks */ -static float max_ekf_pos_ratio = 0.5f; -static float max_ekf_vel_ratio = 0.5f; -static float max_ekf_hgt_ratio = 0.5f; -static float max_ekf_yaw_ratio = 0.5f; -static float max_ekf_dvel_bias = 2.0e-3f; -static float max_ekf_dang_bias = 3.5e-4f; - -/* pre-flight IMU consistency checks */ -static float max_imu_acc_diff = 0.7f; -static float max_imu_gyr_diff = 0.09f; static float min_stick_change = 0.25f; static struct vehicle_status_s status = {}; @@ -1218,18 +1207,6 @@ Commander::run() param_t _param_fmode_5 = param_find("COM_FLTMODE5"); param_t _param_fmode_6 = param_find("COM_FLTMODE6"); - /* pre-flight EKF checks */ - param_t _param_max_ekf_pos_ratio = param_find("COM_ARM_EKF_POS"); - param_t _param_max_ekf_vel_ratio = param_find("COM_ARM_EKF_VEL"); - param_t _param_max_ekf_hgt_ratio = param_find("COM_ARM_EKF_HGT"); - param_t _param_max_ekf_yaw_ratio = param_find("COM_ARM_EKF_YAW"); - param_t _param_max_ekf_dvel_bias = param_find("COM_ARM_EKF_AB"); - param_t _param_max_ekf_dang_bias = param_find("COM_ARM_EKF_GB"); - - /* pre-flight IMU consistency checks */ - param_t _param_max_imu_acc_diff = param_find("COM_ARM_IMU_ACC"); - param_t _param_max_imu_gyr_diff = param_find("COM_ARM_IMU_GYR"); - /* failsafe response to loss of navigation accuracy */ param_t _param_posctl_nav_loss_act = param_find("COM_POSCTL_NAVL"); @@ -1662,18 +1639,6 @@ Commander::run() param_get(_param_fmode_5, &_flight_mode_slots[4]); param_get(_param_fmode_6, &_flight_mode_slots[5]); - /* pre-flight EKF checks */ - param_get(_param_max_ekf_pos_ratio, &max_ekf_pos_ratio); - param_get(_param_max_ekf_vel_ratio, &max_ekf_vel_ratio); - param_get(_param_max_ekf_hgt_ratio, &max_ekf_hgt_ratio); - param_get(_param_max_ekf_yaw_ratio, &max_ekf_yaw_ratio); - param_get(_param_max_ekf_dvel_bias, &max_ekf_dvel_bias); - param_get(_param_max_ekf_dang_bias, &max_ekf_dang_bias); - - /* pre-flight IMU consistency checks */ - param_get(_param_max_imu_acc_diff, &max_imu_acc_diff); - param_get(_param_max_imu_gyr_diff, &max_imu_gyr_diff); - /* failsafe response to loss of navigation accuracy */ param_get(_param_posctl_nav_loss_act, &posctl_nav_loss_act);