mirror of https://github.com/ArduPilot/ardupilot
426 lines
14 KiB
C++
426 lines
14 KiB
C++
// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: nil -*-
|
|
|
|
#ifndef PARAMETERS_H
|
|
#define PARAMETERS_H
|
|
|
|
#include <AP_Common.h>
|
|
|
|
// Global parameter class.
|
|
//
|
|
class Parameters {
|
|
public:
|
|
// The version of the layout as described by the parameter enum.
|
|
//
|
|
// When changing the parameter enum in an incompatible fashion, this
|
|
// value should be incremented by one.
|
|
//
|
|
// The increment will prevent old parameters from being used incorrectly
|
|
// by newer code.
|
|
//
|
|
static const uint16_t k_format_version = 13;
|
|
|
|
// The parameter software_type is set up solely for ground station use
|
|
// and identifies the software type (eg ArduPilotMega versus ArduCopterMega)
|
|
// GCS will interpret values 0-9 as ArduPilotMega. Developers may use
|
|
// values within that range to identify different branches.
|
|
//
|
|
static const uint16_t k_software_type = 20; // 0 for APM trunk
|
|
|
|
enum {
|
|
// Layout version number, always key zero.
|
|
//
|
|
k_param_format_version = 0,
|
|
k_param_software_type,
|
|
|
|
// Misc
|
|
//
|
|
k_param_auto_trim,
|
|
k_param_switch_enable,
|
|
k_param_log_bitmask,
|
|
k_param_pitch_trim,
|
|
k_param_mix_mode,
|
|
k_param_reverse_elevons,
|
|
k_param_reverse_ch1_elevon,
|
|
k_param_reverse_ch2_elevon,
|
|
k_param_flap_1_percent,
|
|
k_param_flap_1_speed,
|
|
k_param_flap_2_percent,
|
|
k_param_flap_2_speed,
|
|
k_param_num_resets,
|
|
k_param_log_last_filenumber, // *** Deprecated - remove with next eeprom number change
|
|
k_param_reset_switch_chan,
|
|
k_param_manual_level,
|
|
|
|
|
|
// 110: Telemetry control
|
|
//
|
|
k_param_gcs0 = 110, // stream rates for port0
|
|
k_param_gcs3, // stream rates for port3
|
|
k_param_sysid_this_mav,
|
|
k_param_sysid_my_gcs,
|
|
k_param_serial3_baud,
|
|
|
|
// 120: Fly-by-wire control
|
|
//
|
|
k_param_flybywire_airspeed_min = 120,
|
|
k_param_flybywire_airspeed_max,
|
|
k_param_FBWB_min_altitude, // 0=disabled, minimum value for altitude in cm (for first time try 30 meters = 3000 cm)
|
|
|
|
//
|
|
// 130: Sensor parameters
|
|
//
|
|
k_param_imu = 130, // sensor calibration
|
|
k_param_altitude_mix,
|
|
k_param_airspeed_ratio,
|
|
k_param_ground_temperature,
|
|
k_param_ground_pressure,
|
|
k_param_compass_enabled,
|
|
k_param_compass,
|
|
k_param_battery_monitoring,
|
|
k_param_volt_div_ratio,
|
|
k_param_curr_amp_per_volt,
|
|
k_param_input_voltage,
|
|
k_param_pack_capacity,
|
|
k_param_airspeed_offset,
|
|
#if HIL_MODE != HIL_MODE_ATTITUDE
|
|
#if CONFIG_SONAR == ENABLED
|
|
k_param_sonar_enabled,
|
|
k_param_sonar_type,
|
|
#endif
|
|
#endif
|
|
k_param_airspeed_enabled,
|
|
|
|
//
|
|
// 150: Navigation parameters
|
|
//
|
|
k_param_crosstrack_gain = 150,
|
|
k_param_crosstrack_entry_angle,
|
|
k_param_roll_limit,
|
|
k_param_pitch_limit_max,
|
|
k_param_pitch_limit_min,
|
|
k_param_airspeed_cruise,
|
|
k_param_RTL_altitude,
|
|
k_param_inverted_flight_ch,
|
|
k_param_min_gndspeed,
|
|
k_param_ch7_option,
|
|
//
|
|
// 160: Radio settings
|
|
//
|
|
k_param_channel_roll = 160,
|
|
k_param_channel_pitch,
|
|
k_param_channel_throttle,
|
|
k_param_channel_rudder,
|
|
k_param_rc_5,
|
|
k_param_rc_6,
|
|
k_param_rc_7,
|
|
k_param_rc_8,
|
|
|
|
k_param_throttle_min,
|
|
k_param_throttle_max,
|
|
k_param_throttle_fs_enabled, // 170
|
|
k_param_throttle_fs_value,
|
|
k_param_throttle_cruise,
|
|
|
|
k_param_short_fs_action,
|
|
k_param_long_fs_action,
|
|
k_param_gcs_heartbeat_fs_enabled,
|
|
k_param_throttle_slewrate,
|
|
|
|
// ************************************************************
|
|
// 180: APMrover parameters - JLN update
|
|
|
|
k_param_closed_loop_nav,
|
|
k_param_auto_wp_radius,
|
|
k_param_sonar_trigger,
|
|
k_param_turn_gain,
|
|
k_param_booster,
|
|
|
|
// ************************************************************
|
|
//
|
|
// 200: Feed-forward gains
|
|
//
|
|
k_param_kff_pitch_compensation = 200,
|
|
k_param_kff_rudder_mix,
|
|
k_param_kff_pitch_to_throttle,
|
|
k_param_kff_throttle_to_pitch,
|
|
|
|
//
|
|
// 210: flight modes
|
|
//
|
|
k_param_flight_mode_channel = 210,
|
|
k_param_flight_mode1,
|
|
k_param_flight_mode2,
|
|
k_param_flight_mode3,
|
|
k_param_flight_mode4,
|
|
k_param_flight_mode5,
|
|
k_param_flight_mode6,
|
|
|
|
//
|
|
// 220: Waypoint data
|
|
//
|
|
k_param_waypoint_mode = 220,
|
|
k_param_command_total,
|
|
k_param_command_index,
|
|
k_param_waypoint_radius,
|
|
k_param_loiter_radius,
|
|
k_param_fence_action,
|
|
k_param_fence_total,
|
|
k_param_fence_channel,
|
|
k_param_fence_minalt,
|
|
k_param_fence_maxalt,
|
|
|
|
//
|
|
// 240: PID Controllers
|
|
//
|
|
// Heading-to-roll PID:
|
|
// heading error from command to roll command deviation from trim
|
|
// (bank to turn strategy)
|
|
//
|
|
k_param_pidNavRoll = 240,
|
|
|
|
// Roll-to-servo PID:
|
|
// roll error from command to roll servo deviation from trim
|
|
// (tracks commanded bank angle)
|
|
//
|
|
k_param_pidServoRoll,
|
|
|
|
//
|
|
// Pitch control
|
|
//
|
|
// Pitch-to-servo PID:
|
|
// pitch error from command to pitch servo deviation from trim
|
|
// (front-side strategy)
|
|
//
|
|
k_param_pidServoPitch,
|
|
|
|
// Airspeed-to-pitch PID:
|
|
// airspeed error from command to pitch servo deviation from trim
|
|
// (back-side strategy)
|
|
//
|
|
k_param_pidNavPitchAirspeed,
|
|
|
|
//
|
|
// Yaw control
|
|
//
|
|
// Yaw-to-servo PID:
|
|
// yaw rate error from command to yaw servo deviation from trim
|
|
// (stabilizes dutch roll)
|
|
//
|
|
k_param_pidServoRudder,
|
|
|
|
//
|
|
// Throttle control
|
|
//
|
|
// Energy-to-throttle PID:
|
|
// total energy error from command to throttle servo deviation from trim
|
|
// (throttle back-side strategy alternative)
|
|
//
|
|
k_param_pidTeThrottle,
|
|
|
|
// Altitude-to-pitch PID:
|
|
// altitude error from command to pitch servo deviation from trim
|
|
// (throttle front-side strategy alternative)
|
|
//
|
|
k_param_pidNavPitchAltitude,
|
|
|
|
// 254,255: reserved
|
|
};
|
|
|
|
AP_Int16 format_version;
|
|
AP_Int8 software_type;
|
|
|
|
// Telemetry control
|
|
//
|
|
AP_Int16 sysid_this_mav;
|
|
AP_Int16 sysid_my_gcs;
|
|
AP_Int8 serial3_baud;
|
|
|
|
// Feed-forward gains
|
|
//
|
|
AP_Float kff_pitch_compensation;
|
|
AP_Float kff_rudder_mix;
|
|
AP_Float kff_pitch_to_throttle;
|
|
AP_Float kff_throttle_to_pitch;
|
|
|
|
// Crosstrack navigation
|
|
//
|
|
AP_Float crosstrack_gain;
|
|
AP_Int16 crosstrack_entry_angle;
|
|
|
|
// Estimation
|
|
//
|
|
AP_Float altitude_mix;
|
|
AP_Float airspeed_ratio;
|
|
AP_Int16 airspeed_offset;
|
|
|
|
// Waypoints
|
|
//
|
|
AP_Int8 waypoint_mode;
|
|
AP_Int8 command_total;
|
|
AP_Int8 command_index;
|
|
AP_Int8 waypoint_radius;
|
|
AP_Int8 loiter_radius;
|
|
#if GEOFENCE_ENABLED == ENABLED
|
|
AP_Int8 fence_action;
|
|
AP_Int8 fence_total;
|
|
AP_Int8 fence_channel;
|
|
AP_Int16 fence_minalt; // meters
|
|
AP_Int16 fence_maxalt; // meters
|
|
#endif
|
|
|
|
// Fly-by-wire
|
|
//
|
|
AP_Int8 flybywire_airspeed_min;
|
|
AP_Int8 flybywire_airspeed_max;
|
|
AP_Int16 FBWB_min_altitude;
|
|
|
|
// Throttle
|
|
//
|
|
AP_Int8 throttle_min;
|
|
AP_Int8 throttle_max;
|
|
AP_Int8 throttle_slewrate;
|
|
AP_Int8 throttle_fs_enabled;
|
|
AP_Int16 throttle_fs_value;
|
|
AP_Int8 throttle_cruise;
|
|
|
|
// Failsafe
|
|
AP_Int8 short_fs_action;
|
|
AP_Int8 long_fs_action;
|
|
AP_Int8 gcs_heartbeat_fs_enabled;
|
|
|
|
// Flight modes
|
|
//
|
|
AP_Int8 flight_mode_channel;
|
|
AP_Int8 flight_mode1;
|
|
AP_Int8 flight_mode2;
|
|
AP_Int8 flight_mode3;
|
|
AP_Int8 flight_mode4;
|
|
AP_Int8 flight_mode5;
|
|
AP_Int8 flight_mode6;
|
|
|
|
// Navigational maneuvering limits
|
|
//
|
|
AP_Int16 roll_limit;
|
|
AP_Int16 pitch_limit_max;
|
|
AP_Int16 pitch_limit_min;
|
|
|
|
// Misc
|
|
//
|
|
AP_Int8 auto_trim;
|
|
AP_Int8 switch_enable;
|
|
AP_Int8 mix_mode;
|
|
AP_Int8 reverse_elevons;
|
|
AP_Int8 reverse_ch1_elevon;
|
|
AP_Int8 reverse_ch2_elevon;
|
|
AP_Int16 num_resets;
|
|
AP_Int16 log_bitmask;
|
|
AP_Int16 log_last_filenumber; // *** Deprecated - remove with next eeprom number change
|
|
AP_Int8 reset_switch_chan;
|
|
AP_Int8 manual_level;
|
|
AP_Int16 airspeed_cruise;
|
|
AP_Int16 min_gndspeed;
|
|
AP_Int8 ch7_option;
|
|
|
|
AP_Int16 pitch_trim;
|
|
AP_Int16 RTL_altitude;
|
|
AP_Int16 ground_temperature;
|
|
AP_Int32 ground_pressure;
|
|
AP_Int8 compass_enabled;
|
|
AP_Int16 angle_of_attack;
|
|
AP_Int8 battery_monitoring; // 0=disabled, 3=voltage only, 4=voltage and current
|
|
AP_Float volt_div_ratio;
|
|
AP_Float curr_amp_per_volt;
|
|
AP_Float input_voltage;
|
|
AP_Int16 pack_capacity; // Battery pack capacity less reserve
|
|
AP_Int8 inverted_flight_ch; // 0=disabled, 1-8 is channel for inverted flight trigger
|
|
#if HIL_MODE != HIL_MODE_ATTITUDE
|
|
#if CONFIG_SONAR == ENABLED
|
|
AP_Int8 sonar_enabled;
|
|
AP_Int8 sonar_type; // 0 = XL, 1 = LV,
|
|
// 2 = XLL (XL with 10m range)
|
|
// 3 = HRLV
|
|
#endif
|
|
#endif
|
|
AP_Int8 airspeed_enabled;
|
|
AP_Int8 flap_1_percent;
|
|
AP_Int8 flap_1_speed;
|
|
AP_Int8 flap_2_percent;
|
|
AP_Int8 flap_2_speed;
|
|
|
|
// ************ ThermoPilot parameters ************************
|
|
// - JLN update
|
|
|
|
AP_Int8 closed_loop_nav;
|
|
AP_Int8 auto_wp_radius;
|
|
AP_Int16 sonar_trigger;
|
|
AP_Int16 turn_gain;
|
|
AP_Int8 booster;
|
|
|
|
// ************************************************************
|
|
|
|
// RC channels
|
|
RC_Channel channel_roll;
|
|
RC_Channel channel_pitch;
|
|
RC_Channel channel_throttle;
|
|
RC_Channel channel_rudder;
|
|
RC_Channel_aux rc_5;
|
|
RC_Channel_aux rc_6;
|
|
RC_Channel_aux rc_7;
|
|
RC_Channel_aux rc_8;
|
|
|
|
// PID controllers
|
|
//
|
|
PID pidNavRoll;
|
|
PID pidServoRoll;
|
|
PID pidServoPitch;
|
|
PID pidNavPitchAirspeed;
|
|
PID pidServoRudder;
|
|
PID pidTeThrottle;
|
|
PID pidNavPitchAltitude;
|
|
|
|
Parameters() :
|
|
// RC channels
|
|
channel_roll(CH_1),
|
|
channel_pitch(CH_2),
|
|
channel_throttle(CH_3),
|
|
channel_rudder(CH_4),
|
|
rc_5(CH_5),
|
|
rc_6(CH_6),
|
|
rc_7(CH_7),
|
|
rc_8(CH_8),
|
|
|
|
// PID controller initial P initial I initial D initial imax
|
|
//-----------------------------------------------------------------------------------
|
|
pidNavRoll (NAV_ROLL_P, NAV_ROLL_I, NAV_ROLL_D, NAV_ROLL_INT_MAX_CENTIDEGREE),
|
|
pidServoRoll (SERVO_ROLL_P, SERVO_ROLL_I, SERVO_ROLL_D, SERVO_ROLL_INT_MAX_CENTIDEGREE),
|
|
pidServoPitch (SERVO_PITCH_P, SERVO_PITCH_I, SERVO_PITCH_D, SERVO_PITCH_INT_MAX_CENTIDEGREE),
|
|
pidNavPitchAirspeed (NAV_PITCH_ASP_P, NAV_PITCH_ASP_I, NAV_PITCH_ASP_D, NAV_PITCH_ASP_INT_MAX_CMSEC),
|
|
pidServoRudder (SERVO_YAW_P, SERVO_YAW_I, SERVO_YAW_D, SERVO_YAW_INT_MAX),
|
|
pidTeThrottle (THROTTLE_TE_P, THROTTLE_TE_I, THROTTLE_TE_D, THROTTLE_TE_INT_MAX),
|
|
pidNavPitchAltitude (NAV_PITCH_ALT_P, NAV_PITCH_ALT_I, NAV_PITCH_ALT_D, NAV_PITCH_ALT_INT_MAX_CM)
|
|
{}
|
|
};
|
|
|
|
extern const AP_Param::Info var_info[];
|
|
|
|
#endif // PARAMETERS_H
|
|
|
|
/* ************ ThermoPilot parameters (old parameters setup ) ************************
|
|
|
|
low_rate_turn (LOW_RATE_TURN, k_param_low_rate_turn, PSTR("TP_LOWR_TURN")),
|
|
medium_rate_turn (MEDIUM_RATE_TURN, k_param_medium_rate_turn, PSTR("TP_MEDR_TURN")),
|
|
high_rate_turn (HIGH_RATE_TURN, k_param_high_rate_turn, PSTR("TP_HIGR_TURN")),
|
|
search_mode_turn (SEARCH_MODE_TURN, k_param_search_mode_turn, PSTR("TP_SRCM_TURN")),
|
|
slope_thermal (SLOPE_THERMAL, k_param_slope_thermal, PSTR("TP_SLOPE_THER")),
|
|
auto_thermal (AUTO_THERMAL, k_param_auto_thermal, PSTR("TP_AUTO_THER")),
|
|
stab_thermal (STAB_THERMAL, k_param_auto_thermal, PSTR("TP_STAB_THER")),
|
|
closed_loop_nav (CLOSED_LOOP_NAV, k_param_closed_loop_nav, PSTR("TP_CL_NAV")),
|
|
auto_wp_radius (AUTO_WP_RADIUS, k_param_closed_loop_nav, PSTR("TP_AWPR_NAV")),
|
|
min_alt (MIN_ALT, k_param_min_alt, PSTR("TP_MIN_ALT")),
|
|
max_alt (MAX_ALT, k_param_max_alt, PSTR("TP_MAX_ALT")),
|
|
max_dist (MAX_DIST, k_param_max_dist, PSTR("TP_MAX_DIST")),
|
|
sarsec_branch (SARSEC_BRANCH, k_param_sarsec_branch, PSTR("TP_SARSEC")),
|
|
|
|
************************************************************/
|
|
|