2016-02-17 21:25:59 -04:00
|
|
|
#pragma once
|
2012-04-30 04:17:14 -03:00
|
|
|
|
2015-08-11 03:28:40 -03:00
|
|
|
#include <AP_Common/AP_Common.h>
|
2012-04-30 04:17:14 -03:00
|
|
|
|
|
|
|
// 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.
|
|
|
|
//
|
2013-02-28 16:47:26 -04:00
|
|
|
static const uint16_t k_format_version = 16;
|
2013-02-08 06:17:54 -04:00
|
|
|
static const uint16_t k_software_type = 20;
|
2012-04-30 04:17:14 -03:00
|
|
|
|
|
|
|
enum {
|
|
|
|
// Layout version number, always key zero.
|
|
|
|
//
|
|
|
|
k_param_format_version = 0,
|
2016-12-20 09:30:32 -04:00
|
|
|
k_param_software_type,
|
2012-04-30 04:17:14 -03:00
|
|
|
|
|
|
|
// Misc
|
|
|
|
//
|
2016-12-20 09:30:32 -04:00
|
|
|
k_param_log_bitmask_old = 10, // unused
|
2012-04-30 04:17:14 -03:00
|
|
|
k_param_num_resets,
|
|
|
|
k_param_reset_switch_chan,
|
2013-05-02 18:59:15 -03:00
|
|
|
k_param_initial_mode,
|
2013-06-03 21:37:05 -03:00
|
|
|
k_param_scheduler,
|
2013-06-24 23:48:58 -03:00
|
|
|
k_param_relay,
|
2014-01-19 21:57:59 -04:00
|
|
|
k_param_BoardConfig,
|
2014-02-16 19:08:59 -04:00
|
|
|
k_param_pivot_turn_angle,
|
2017-01-06 06:31:10 -04:00
|
|
|
k_param_rc_13_old,
|
|
|
|
k_param_rc_14_old,
|
2013-02-08 06:17:54 -04:00
|
|
|
|
|
|
|
// IO pins
|
2016-12-20 09:30:32 -04:00
|
|
|
k_param_rssi_pin = 20, // unused, replaced by rssi_ library parameters
|
2012-12-18 07:44:12 -04:00
|
|
|
k_param_battery_volt_pin,
|
|
|
|
k_param_battery_curr_pin,
|
2012-04-30 04:17:14 -03:00
|
|
|
|
2014-03-30 18:44:19 -03:00
|
|
|
// braking
|
|
|
|
k_param_braking_percent = 30,
|
2014-04-06 19:42:54 -03:00
|
|
|
k_param_braking_speederr,
|
2014-03-30 18:44:19 -03:00
|
|
|
|
2014-03-30 18:49:15 -03:00
|
|
|
// misc2
|
|
|
|
k_param_log_bitmask = 40,
|
2014-03-31 16:18:27 -03:00
|
|
|
k_param_gps,
|
2015-01-28 00:56:36 -04:00
|
|
|
k_param_serial0_baud, // deprecated, can be deleted
|
|
|
|
k_param_serial1_baud, // deprecated, can be deleted
|
|
|
|
k_param_serial2_baud, // deprecated, can be deleted
|
2014-03-30 18:49:15 -03:00
|
|
|
|
2015-08-28 03:00:12 -03:00
|
|
|
// 97: RSSI
|
|
|
|
k_param_rssi = 97,
|
2015-10-30 02:56:41 -03:00
|
|
|
|
|
|
|
// 100: Arming parameters
|
|
|
|
k_param_arming = 100,
|
2016-12-20 09:30:32 -04:00
|
|
|
|
2013-01-17 16:56:32 -04:00
|
|
|
// 110: Telemetry control
|
|
|
|
//
|
2016-12-20 09:30:32 -04:00
|
|
|
k_param_gcs0 = 110, // stream rates for uartA
|
|
|
|
k_param_gcs1, // stream rates for uartC
|
2013-01-17 16:56:32 -04:00
|
|
|
k_param_sysid_this_mav,
|
|
|
|
k_param_sysid_my_gcs,
|
2014-05-20 23:38:53 -03:00
|
|
|
k_param_serial0_baud_old,
|
|
|
|
k_param_serial1_baud_old,
|
2012-08-29 20:36:18 -03:00
|
|
|
k_param_telem_delay,
|
2016-12-20 09:30:32 -04:00
|
|
|
k_param_skip_gyro_cal, // unused
|
|
|
|
k_param_gcs2, // stream rates for uartD
|
2014-05-20 23:38:53 -03:00
|
|
|
k_param_serial2_baud_old,
|
2015-01-28 00:56:36 -04:00
|
|
|
k_param_serial2_protocol, // deprecated, can be deleted
|
|
|
|
k_param_serial_manager, // serial manager library
|
2015-03-09 00:20:37 -03:00
|
|
|
k_param_cli_enabled,
|
2015-05-15 01:24:59 -03:00
|
|
|
k_param_gcs3,
|
2015-06-18 04:37:59 -03:00
|
|
|
k_param_gcs_pid_mask,
|
2012-04-30 04:17:14 -03:00
|
|
|
|
|
|
|
//
|
|
|
|
// 130: Sensor parameters
|
|
|
|
//
|
2013-02-08 06:17:54 -04:00
|
|
|
k_param_compass_enabled = 130,
|
2016-12-20 09:30:32 -04:00
|
|
|
k_param_steering_learn, // unused
|
|
|
|
k_param_NavEKF, // deprecated - remove
|
|
|
|
k_param_mission, // mission library
|
|
|
|
k_param_NavEKF2_old, // deprecated - remove
|
2015-09-21 02:27:49 -03:00
|
|
|
k_param_NavEKF2,
|
2016-12-20 09:30:32 -04:00
|
|
|
k_param_g2, // 2nd block of parameters
|
2016-11-28 05:49:35 -04:00
|
|
|
k_param_NavEKF3,
|
2013-02-08 06:17:54 -04:00
|
|
|
|
|
|
|
// 140: battery controls
|
2013-10-02 03:07:28 -03:00
|
|
|
k_param_battery_monitoring = 140, // deprecated, can be deleted
|
2016-12-20 09:30:32 -04:00
|
|
|
k_param_volt_div_ratio, // deprecated, can be deleted
|
|
|
|
k_param_curr_amp_per_volt, // deprecated, can be deleted
|
|
|
|
k_param_input_voltage, // deprecated, can be deleted
|
|
|
|
k_param_pack_capacity, // deprecated, can be deleted
|
2013-10-02 03:07:28 -03:00
|
|
|
k_param_battery,
|
2013-02-07 18:21:22 -04:00
|
|
|
|
2012-04-30 04:17:14 -03:00
|
|
|
//
|
|
|
|
// 150: Navigation parameters
|
|
|
|
//
|
|
|
|
k_param_crosstrack_gain = 150,
|
|
|
|
k_param_crosstrack_entry_angle,
|
2013-02-07 18:21:22 -04:00
|
|
|
k_param_speed_cruise,
|
2013-02-21 17:38:13 -04:00
|
|
|
k_param_speed_turn_gain,
|
|
|
|
k_param_speed_turn_dist,
|
2012-04-30 04:17:14 -03:00
|
|
|
k_param_ch7_option,
|
2013-03-21 19:38:25 -03:00
|
|
|
k_param_auto_trigger_pin,
|
|
|
|
k_param_auto_kickstart,
|
2016-12-20 09:30:32 -04:00
|
|
|
k_param_turn_circle, // unused
|
2013-06-16 20:50:53 -03:00
|
|
|
k_param_turn_max_g,
|
2013-02-07 18:21:22 -04:00
|
|
|
|
2012-04-30 04:17:14 -03:00
|
|
|
//
|
|
|
|
// 160: Radio settings
|
|
|
|
//
|
2017-01-06 06:31:10 -04:00
|
|
|
k_param_rc_1_old = 160,
|
|
|
|
k_param_rc_2_old,
|
|
|
|
k_param_rc_3_old,
|
|
|
|
k_param_rc_4_old,
|
|
|
|
k_param_rc_5_old,
|
|
|
|
k_param_rc_6_old,
|
|
|
|
k_param_rc_7_old,
|
|
|
|
k_param_rc_8_old,
|
2012-04-30 04:17:14 -03:00
|
|
|
|
2013-02-08 06:17:54 -04:00
|
|
|
// throttle control
|
|
|
|
k_param_throttle_min = 170,
|
2012-04-30 04:17:14 -03:00
|
|
|
k_param_throttle_max,
|
|
|
|
k_param_throttle_cruise,
|
|
|
|
k_param_throttle_slewrate,
|
2013-02-08 06:17:54 -04:00
|
|
|
k_param_throttle_reduction,
|
2013-03-14 21:04:33 -03:00
|
|
|
k_param_skid_steer_in,
|
|
|
|
k_param_skid_steer_out,
|
2012-04-30 04:17:14 -03:00
|
|
|
|
2013-02-08 06:17:54 -04:00
|
|
|
// failsafe control
|
|
|
|
k_param_fs_action = 180,
|
|
|
|
k_param_fs_timeout,
|
|
|
|
k_param_fs_throttle_enabled,
|
|
|
|
k_param_fs_throttle_value,
|
|
|
|
k_param_fs_gcs_enabled,
|
2016-11-21 12:08:24 -04:00
|
|
|
k_param_fs_crash_check,
|
2013-02-08 06:17:54 -04:00
|
|
|
|
|
|
|
// obstacle control
|
2016-12-20 09:30:32 -04:00
|
|
|
k_param_sonar_enabled = 190, // deprecated, can be removed
|
|
|
|
k_param_sonar_old, // unused
|
2013-02-28 16:15:09 -04:00
|
|
|
k_param_sonar_trigger_cm,
|
|
|
|
k_param_sonar_turn_angle,
|
|
|
|
k_param_sonar_turn_time,
|
2016-12-20 09:30:32 -04:00
|
|
|
k_param_sonar2_old, // unused
|
2013-03-28 20:49:08 -03:00
|
|
|
k_param_sonar_debounce,
|
2016-12-20 09:30:32 -04:00
|
|
|
k_param_sonar, // sonar object
|
|
|
|
|
2012-04-30 04:17:14 -03:00
|
|
|
//
|
2013-02-08 06:17:54 -04:00
|
|
|
// 210: driving modes
|
2012-04-30 04:17:14 -03:00
|
|
|
//
|
2013-02-07 18:21:22 -04:00
|
|
|
k_param_mode_channel = 210,
|
|
|
|
k_param_mode1,
|
|
|
|
k_param_mode2,
|
|
|
|
k_param_mode3,
|
|
|
|
k_param_mode4,
|
|
|
|
k_param_mode5,
|
|
|
|
k_param_mode6,
|
2013-06-30 21:10:38 -03:00
|
|
|
k_param_learn_channel,
|
2012-04-30 04:17:14 -03:00
|
|
|
|
|
|
|
//
|
|
|
|
// 220: Waypoint data
|
|
|
|
//
|
2014-03-10 05:42:44 -03:00
|
|
|
k_param_command_total = 220, // unused
|
|
|
|
k_param_command_index, // unused
|
2012-04-30 04:17:14 -03:00
|
|
|
k_param_waypoint_radius,
|
|
|
|
|
2013-07-14 21:25:04 -03:00
|
|
|
//
|
|
|
|
// 230: camera control
|
|
|
|
//
|
|
|
|
k_param_camera,
|
|
|
|
k_param_camera_mount,
|
2015-01-08 16:12:18 -04:00
|
|
|
k_param_camera_mount2, // unused
|
2013-07-14 21:25:04 -03:00
|
|
|
|
2012-04-30 04:17:14 -03:00
|
|
|
//
|
|
|
|
// 240: PID Controllers
|
2013-02-08 06:17:54 -04:00
|
|
|
k_param_pidNavSteer = 230,
|
2016-12-20 09:30:32 -04:00
|
|
|
k_param_pidServoSteer, // unused
|
2013-02-07 18:21:22 -04:00
|
|
|
k_param_pidSpeedThrottle,
|
2012-04-30 04:17:14 -03:00
|
|
|
|
2013-07-14 20:57:00 -03:00
|
|
|
// high RC channels
|
2017-01-06 06:31:10 -04:00
|
|
|
k_param_rc_9_old = 235,
|
|
|
|
k_param_rc_10_old,
|
|
|
|
k_param_rc_11_old,
|
|
|
|
k_param_rc_12_old,
|
2013-07-14 20:57:00 -03:00
|
|
|
|
2013-02-08 06:17:54 -04:00
|
|
|
// other objects
|
|
|
|
k_param_sitl = 240,
|
|
|
|
k_param_ahrs,
|
|
|
|
k_param_ins,
|
|
|
|
k_param_compass,
|
2013-06-03 06:33:59 -03:00
|
|
|
k_param_rcmap,
|
2013-06-16 20:50:53 -03:00
|
|
|
k_param_L1_controller,
|
2013-09-08 21:18:31 -03:00
|
|
|
k_param_steerController,
|
2014-02-23 18:25:50 -04:00
|
|
|
k_param_barometer,
|
2015-12-03 16:48:16 -04:00
|
|
|
k_param_notify,
|
2016-07-21 22:24:35 -03:00
|
|
|
k_param_button,
|
2013-02-08 06:17:54 -04:00
|
|
|
|
2016-12-20 09:30:32 -04:00
|
|
|
k_param_DataFlash = 253, // Logging Group
|
2015-11-09 18:40:10 -04:00
|
|
|
|
2012-04-30 04:17:14 -03:00
|
|
|
// 254,255: reserved
|
|
|
|
};
|
|
|
|
|
2013-01-17 16:56:32 -04:00
|
|
|
AP_Int16 format_version;
|
2016-12-20 09:30:32 -04:00
|
|
|
AP_Int8 software_type;
|
2012-04-30 04:17:14 -03:00
|
|
|
|
2013-02-08 06:17:54 -04:00
|
|
|
// Misc
|
|
|
|
//
|
2014-03-30 18:49:15 -03:00
|
|
|
AP_Int32 log_bitmask;
|
2013-02-08 06:17:54 -04:00
|
|
|
AP_Int16 num_resets;
|
2016-12-20 09:30:32 -04:00
|
|
|
AP_Int8 reset_switch_chan;
|
2013-05-02 18:59:15 -03:00
|
|
|
AP_Int8 initial_mode;
|
2013-02-08 06:17:54 -04:00
|
|
|
|
2014-03-30 18:44:19 -03:00
|
|
|
// braking
|
|
|
|
AP_Int8 braking_percent;
|
2014-04-06 19:42:54 -03:00
|
|
|
AP_Float braking_speederr;
|
2014-03-30 18:44:19 -03:00
|
|
|
|
2016-12-20 09:30:32 -04:00
|
|
|
// Telemetry control
|
|
|
|
//
|
|
|
|
AP_Int16 sysid_this_mav;
|
|
|
|
AP_Int16 sysid_my_gcs;
|
2013-01-17 16:56:32 -04:00
|
|
|
AP_Int8 telem_delay;
|
2015-03-09 00:20:37 -03:00
|
|
|
#if CLI_ENABLED == ENABLED
|
|
|
|
AP_Int8 cli_enabled;
|
|
|
|
#endif
|
2012-04-30 04:17:14 -03:00
|
|
|
|
2013-02-08 06:17:54 -04:00
|
|
|
// sensor parameters
|
2016-12-20 09:30:32 -04:00
|
|
|
AP_Int8 compass_enabled;
|
2013-02-08 06:17:54 -04:00
|
|
|
|
|
|
|
// navigation parameters
|
2013-01-17 16:56:32 -04:00
|
|
|
//
|
2013-02-08 06:17:54 -04:00
|
|
|
AP_Float speed_cruise;
|
2013-02-21 17:38:13 -04:00
|
|
|
AP_Int8 speed_turn_gain;
|
2016-12-20 09:30:32 -04:00
|
|
|
AP_Float speed_turn_dist;
|
|
|
|
AP_Int8 ch7_option;
|
2013-03-21 19:38:25 -03:00
|
|
|
AP_Int8 auto_trigger_pin;
|
|
|
|
AP_Float auto_kickstart;
|
2013-06-16 20:50:53 -03:00
|
|
|
AP_Float turn_max_g;
|
2014-02-16 19:08:59 -04:00
|
|
|
AP_Int16 pivot_turn_angle;
|
2015-06-18 04:37:59 -03:00
|
|
|
AP_Int16 gcs_pid_mask;
|
2013-02-08 06:17:54 -04:00
|
|
|
|
2013-01-17 16:56:32 -04:00
|
|
|
// Throttle
|
|
|
|
//
|
|
|
|
AP_Int8 throttle_min;
|
|
|
|
AP_Int8 throttle_max;
|
|
|
|
AP_Int8 throttle_cruise;
|
2013-02-08 06:17:54 -04:00
|
|
|
AP_Int8 throttle_slewrate;
|
2013-03-14 21:04:33 -03:00
|
|
|
AP_Int8 skid_steer_in;
|
|
|
|
AP_Int8 skid_steer_out;
|
2013-02-08 06:17:54 -04:00
|
|
|
|
|
|
|
// failsafe control
|
|
|
|
AP_Int8 fs_action;
|
|
|
|
AP_Float fs_timeout;
|
|
|
|
AP_Int8 fs_throttle_enabled;
|
|
|
|
AP_Int16 fs_throttle_value;
|
2016-12-20 09:30:32 -04:00
|
|
|
AP_Int8 fs_gcs_enabled;
|
2016-11-21 12:08:24 -04:00
|
|
|
AP_Int8 fs_crash_check;
|
2012-04-30 04:17:14 -03:00
|
|
|
|
2013-02-08 06:17:54 -04:00
|
|
|
// obstacle control
|
2013-02-28 16:15:09 -04:00
|
|
|
AP_Int16 sonar_trigger_cm;
|
|
|
|
AP_Float sonar_turn_angle;
|
|
|
|
AP_Float sonar_turn_time;
|
2013-03-28 20:49:08 -03:00
|
|
|
AP_Int8 sonar_debounce;
|
2016-12-20 09:30:32 -04:00
|
|
|
|
2013-02-08 06:17:54 -04:00
|
|
|
|
|
|
|
// driving modes
|
2013-01-17 16:56:32 -04:00
|
|
|
//
|
2013-02-07 18:21:22 -04:00
|
|
|
AP_Int8 mode_channel;
|
|
|
|
AP_Int8 mode1;
|
|
|
|
AP_Int8 mode2;
|
|
|
|
AP_Int8 mode3;
|
|
|
|
AP_Int8 mode4;
|
|
|
|
AP_Int8 mode5;
|
|
|
|
AP_Int8 mode6;
|
2013-06-30 21:10:38 -03:00
|
|
|
AP_Int8 learn_channel;
|
2016-12-20 09:30:32 -04:00
|
|
|
|
2013-02-08 06:17:54 -04:00
|
|
|
// Waypoints
|
2013-01-17 16:56:32 -04:00
|
|
|
//
|
2013-02-08 06:17:54 -04:00
|
|
|
AP_Float waypoint_radius;
|
2012-04-30 04:17:14 -03:00
|
|
|
|
2013-01-17 16:56:32 -04:00
|
|
|
// PID controllers
|
|
|
|
//
|
2013-02-07 18:21:22 -04:00
|
|
|
PID pidSpeedThrottle;
|
2012-04-30 04:17:14 -03:00
|
|
|
|
|
|
|
Parameters() :
|
|
|
|
// PID controller initial P initial I initial D initial imax
|
|
|
|
//-----------------------------------------------------------------------------------
|
2013-02-08 06:17:54 -04:00
|
|
|
pidSpeedThrottle (0.7, 0.2, 0.2, 4000)
|
2012-04-30 04:17:14 -03:00
|
|
|
{}
|
|
|
|
};
|
|
|
|
|
2016-10-25 22:37:08 -03:00
|
|
|
/*
|
|
|
|
2nd block of parameters, to avoid going past 256 top level keys
|
|
|
|
*/
|
|
|
|
class ParametersG2 {
|
|
|
|
public:
|
2017-01-06 06:31:10 -04:00
|
|
|
ParametersG2(void);
|
2016-10-25 22:37:08 -03:00
|
|
|
|
|
|
|
// var_info for holding Parameter information
|
|
|
|
static const struct AP_Param::GroupInfo var_info[];
|
|
|
|
|
2016-10-25 23:19:28 -03:00
|
|
|
// vehicle statistics
|
|
|
|
AP_Stats stats;
|
|
|
|
|
2016-11-21 11:06:25 -04:00
|
|
|
// whether to enforce acceptance of packets only from sysid_my_gcs
|
|
|
|
AP_Int8 sysid_enforce;
|
2017-01-06 06:31:10 -04:00
|
|
|
|
|
|
|
// RC input channels
|
|
|
|
RC_Channels rc_channels;
|
|
|
|
|
|
|
|
// control over servo output ranges
|
|
|
|
SRV_Channels servo_channels;
|
2017-01-30 10:21:55 -04:00
|
|
|
|
|
|
|
#if ADVANCED_FAILSAFE == ENABLED
|
|
|
|
// advanced failsafe library
|
|
|
|
AP_AdvancedFailsafe_Rover afs;
|
|
|
|
#endif
|
|
|
|
|
2016-10-25 22:37:08 -03:00
|
|
|
};
|
|
|
|
|
2012-08-06 22:24:20 -03:00
|
|
|
extern const AP_Param::Info var_info[];
|