diff --git a/ArduPlane/GCS_Mavlink.pde b/ArduPlane/GCS_Mavlink.pde index b7bc3b4a03..6c06852d6f 100644 --- a/ArduPlane/GCS_Mavlink.pde +++ b/ArduPlane/GCS_Mavlink.pde @@ -1136,7 +1136,7 @@ void GCS_MAVLINK::handleMessage(mavlink_message_t* msg) case MAV_CMD_PREFLIGHT_CALIBRATION: if (packet.param1 == 1 || packet.param2 == 1) { - startup_INS_ground(true); + startup_INS_ground(); } else if (packet.param3 == 1) { init_barometer(); if (airspeed.enabled()) { diff --git a/ArduPlane/Parameters.h b/ArduPlane/Parameters.h index 64624324b1..a20e7103e1 100644 --- a/ArduPlane/Parameters.h +++ b/ArduPlane/Parameters.h @@ -66,7 +66,7 @@ public: k_param_flap_2_percent, k_param_flap_2_speed, k_param_reset_switch_chan, - k_param_manual_level, + k_param_manual_level, // unused k_param_land_pitch_cd, k_param_ins_old, // *** Deprecated, remove with next eeprom number change k_param_stick_mixing, @@ -338,7 +338,6 @@ public: AP_Int16 log_bitmask; AP_Int8 reset_switch_chan; AP_Int8 reset_mission_chan; - AP_Int8 manual_level; AP_Int32 airspeed_cruise_cm; AP_Int32 RTL_altitude_cm; AP_Int16 land_pitch_cd; diff --git a/ArduPlane/Parameters.pde b/ArduPlane/Parameters.pde index 245e4596e4..b51cce0efa 100644 --- a/ArduPlane/Parameters.pde +++ b/ArduPlane/Parameters.pde @@ -74,13 +74,6 @@ const AP_Param::Info var_info[] PROGMEM = { // @User: Advanced GSCALAR(kff_throttle_to_pitch, "KFF_THR2PTCH", T_TO_P), - // @Param: MANUAL_LEVEL - // @DisplayName: Manual Level - // @Description: Setting this to Disabled(0) will enable autolevel on every boot. Setting it to Enabled(1) will do a calibration only when you tell it to - // @Values: 0:Disabled,1:Enabled - // @User: Advanced - GSCALAR(manual_level, "MANUAL_LEVEL", MANUAL_LEVEL), - // @Param: STICK_MIXING // @DisplayName: Stick Mixing // @Description: When enabled, this adds user stick input to the control surfaces in auto modes, allowing the user to have some degree of flight control without changing modes. There are two types of stick mixing available. If you set STICK_MIXING to 1 then it will use "fly by wire" mixing, which controls the roll and pitch in the same way that the FBWA mode does. This is the safest option if you usually fly ArduPlane in FBWA or FBWB mode. If you set STICK_MIXING to 2 then it will enable direct mixing mode, which is what the STABILIZE mode uses. That will allow for much more extreme maneuvers while in AUTO mode. @@ -528,7 +521,7 @@ const AP_Param::Info var_info[] PROGMEM = { // @Param: TRIM_PITCH_CD // @DisplayName: Pitch angle offset - // @Description: offset to add to pitch - used for trimming tail draggers + // @Description: offset to add to pitch - used for in-flight pitch trimming. It is recommended that instead of using this parameter you level your plane correctly on the ground for good flight attitude. // @Units: centi-Degrees // @User: Advanced GSCALAR(pitch_trim_cd, "TRIM_PITCH_CD", 0), diff --git a/ArduPlane/config.h b/ArduPlane/config.h index d6e44b0c10..2b2b5502fc 100644 --- a/ArduPlane/config.h +++ b/ArduPlane/config.h @@ -407,13 +407,6 @@ ////////////////////////////////////////////////////////////////////////////// -////////////////////////////////////////////////////////////////////////////// -// Level with each startup = 0, level with MP/CLI only = 1 -// -#ifndef MANUAL_LEVEL - # define MANUAL_LEVEL 0 -#endif - ////////////////////////////////////////////////////////////////////////////// // GROUND_START_DELAY // diff --git a/ArduPlane/setup.pde b/ArduPlane/setup.pde index ac9a7c3493..17fa8badc5 100644 --- a/ArduPlane/setup.pde +++ b/ArduPlane/setup.pde @@ -376,7 +376,7 @@ setup_erase(uint8_t argc, const Menu::arg *argv) static int8_t setup_level(uint8_t argc, const Menu::arg *argv) { - startup_INS_ground(true); + startup_INS_ground(); return 0; } @@ -402,10 +402,6 @@ setup_accel_scale(uint8_t argc, const Menu::arg *argv) if (success) { // reset ahrs's trim to suggested values from calibration routine ahrs.set_trim(Vector3f(trim_roll, trim_pitch, 0)); - if (g.manual_level == 0) { - cliSerial->println_P(PSTR("Setting MANUAL_LEVEL to 1")); - g.manual_level.set_and_save(1); - } } report_ins(); return(0); diff --git a/ArduPlane/system.pde b/ArduPlane/system.pde index 154e631c46..ab4f2b3896 100644 --- a/ArduPlane/system.pde +++ b/ArduPlane/system.pde @@ -282,7 +282,7 @@ static void startup_ground(void) //INS ground start //------------------------ // - startup_INS_ground(false); + startup_INS_ground(); // read the radio to set trims // --------------------------- @@ -428,7 +428,7 @@ static void check_short_failsafe() } -static void startup_INS_ground(bool force_accel_level) +static void startup_INS_ground(void) { #if HIL_MODE != HIL_MODE_DISABLED while (!barometer.healthy) { @@ -454,15 +454,6 @@ static void startup_INS_ground(bool force_accel_level) ins.init(AP_InertialSensor::COLD_START, ins_sample_rate, flash_leds); -#if HIL_MODE == HIL_MODE_DISABLED - if (force_accel_level || g.manual_level == 0) { - // when MANUAL_LEVEL is set to 1 we don't do accelerometer - // levelling on each boot, and instead rely on the user to do - // it once via the ground station - ins.init_accel(flash_leds); - ahrs.set_trim(Vector3f(0, 0, 0)); - } -#endif ahrs.reset(); // read Baro pressure at ground