123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733 |
- #include "Sub.h"
- #define GSCALAR(v, name, def) { sub.g.v.vtype, name, Parameters::k_param_ ## v, &sub.g.v, {def_value : def} }
- #define ASCALAR(v, name, def) { sub.aparm.v.vtype, name, Parameters::k_param_ ## v, (const void *)&sub.aparm.v, {def_value : def} }
- #define GGROUP(v, name, class) { AP_PARAM_GROUP, name, Parameters::k_param_ ## v, &sub.g.v, {group_info : class::var_info} }
- #define GOBJECT(v, name, class) { AP_PARAM_GROUP, name, Parameters::k_param_ ## v, (const void *)&sub.v, {group_info : class::var_info} }
- #define GOBJECTN(v, pname, name, class) { AP_PARAM_GROUP, name, Parameters::k_param_ ## pname, (const void *)&sub.v, {group_info : class::var_info} }
- const AP_Param::Info Sub::var_info[] = {
-
-
-
-
-
-
- GSCALAR(surface_depth, "SURFACE_DEPTH", SURFACE_DEPTH_DEFAULT),
-
-
-
-
-
- GSCALAR(format_version, "SYSID_SW_MREV", 0),
-
-
-
-
-
- GSCALAR(sysid_this_mav, "SYSID_THISMAV", MAV_SYSTEM_ID),
-
-
-
-
- GSCALAR(sysid_my_gcs, "SYSID_MYGCS", 255),
-
-
-
-
-
-
-
- GSCALAR(throttle_filt, "PILOT_THR_FILT", 0),
-
-
- GOBJECT(serial_manager, "SERIAL", AP_SerialManager),
-
-
-
-
-
-
- GSCALAR(gcs_pid_mask, "GCS_PID_MASK", 0),
- #if RANGEFINDER_ENABLED == ENABLED
-
-
-
-
-
-
- GSCALAR(rangefinder_gain, "RNGFND_GAIN", RANGEFINDER_GAIN_DEFAULT),
- #endif
-
-
-
-
-
- GSCALAR(failsafe_gcs, "FS_GCS_ENABLE", FS_GCS_DISARM),
-
-
-
-
-
- GSCALAR(failsafe_leak, "FS_LEAK_ENABLE", FS_LEAK_WARN_ONLY),
-
-
-
-
-
- GSCALAR(failsafe_pressure, "FS_PRESS_ENABLE", FS_PRESS_DISABLED),
-
-
-
-
-
- GSCALAR(failsafe_temperature, "FS_TEMP_ENABLE", FS_TEMP_DISABLED),
-
-
-
-
-
- GSCALAR(failsafe_pressure_max, "FS_PRESS_MAX", FS_PRESS_MAX_DEFAULT),
-
-
-
-
-
- GSCALAR(failsafe_temperature_max, "FS_TEMP_MAX", FS_TEMP_MAX_DEFAULT),
-
-
-
-
-
- GSCALAR(failsafe_terrain, "FS_TERRAIN_ENAB", FS_TERRAIN_DISARM),
-
-
-
-
-
- GSCALAR(failsafe_pilot_input, "FS_PILOT_INPUT", FS_PILOT_INPUT_DISARM),
-
-
-
-
-
-
- GSCALAR(failsafe_pilot_input_timeout, "FS_PILOT_TIMEOUT", 3.0f),
-
-
-
-
-
- GSCALAR(xtrack_angle_limit,"XTRACK_ANG_LIM", 45),
-
-
-
-
-
- GSCALAR(wp_yaw_behavior, "WP_YAW_BEHAVIOR", WP_YAW_BEHAVIOR_DEFAULT),
-
-
-
-
-
-
-
- GSCALAR(pilot_speed_up, "PILOT_SPEED_UP", PILOT_VELZ_MAX),
-
-
-
-
-
-
-
- GSCALAR(pilot_speed_dn, "PILOT_SPEED_DN", 0),
-
-
-
-
-
-
-
- GSCALAR(pilot_accel_z, "PILOT_ACCEL_Z", PILOT_ACCEL_Z_DEFAULT),
-
-
-
-
-
-
-
- GSCALAR(throttle_deadzone, "THR_DZ", THR_DZ_DEFAULT),
-
-
-
-
-
-
- GSCALAR(log_bitmask, "LOG_BITMASK", DEFAULT_LOG_BITMASK),
-
-
-
-
-
-
- ASCALAR(angle_max, "ANGLE_MAX", DEFAULT_ANGLE_MAX),
-
-
-
-
-
- GSCALAR(fs_ekf_action, "FS_EKF_ACTION", FS_EKF_ACTION_DEFAULT),
-
-
-
-
-
- GSCALAR(fs_ekf_thresh, "FS_EKF_THRESH", FS_EKF_THRESHOLD_DEFAULT),
-
-
-
-
-
- GSCALAR(fs_crash_check, "FS_CRASH_CHECK", FS_CRASH_DISABLED),
-
-
-
-
-
- GSCALAR(gain_default, "JS_GAIN_DEFAULT", 0.5),
-
-
-
-
-
- GSCALAR(maxGain, "JS_GAIN_MAX", 1.0),
-
-
-
-
-
- GSCALAR(minGain, "JS_GAIN_MIN", 0.25),
-
-
-
-
-
- GSCALAR(numGainSettings, "JS_GAIN_STEPS", 4),
-
-
-
-
-
-
- GSCALAR(lights_steps, "JS_LIGHTS_STEPS", 8),
-
-
-
-
-
- GSCALAR(throttle_gain, "JS_THR_GAIN", 1.0f),
-
-
-
-
-
-
- GSCALAR(frame_configuration, "FRAME_CONFIG", AP_Motors6DOF::SUB_FRAME_VECTORED),
-
-
- GGROUP(jbtn_0, "BTN0_", JSButton),
-
-
- GGROUP(jbtn_1, "BTN1_", JSButton),
-
-
- GGROUP(jbtn_2, "BTN2_", JSButton),
-
-
- GGROUP(jbtn_3, "BTN3_", JSButton),
-
-
- GGROUP(jbtn_4, "BTN4_", JSButton),
-
-
- GGROUP(jbtn_5, "BTN5_", JSButton),
-
-
- GGROUP(jbtn_6, "BTN6_", JSButton),
-
-
- GGROUP(jbtn_7, "BTN7_", JSButton),
-
-
- GGROUP(jbtn_8, "BTN8_", JSButton),
-
-
- GGROUP(jbtn_9, "BTN9_", JSButton),
-
-
- GGROUP(jbtn_10, "BTN10_", JSButton),
-
-
- GGROUP(jbtn_11, "BTN11_", JSButton),
-
-
- GGROUP(jbtn_12, "BTN12_", JSButton),
-
-
- GGROUP(jbtn_13, "BTN13_", JSButton),
-
-
- GGROUP(jbtn_14, "BTN14_", JSButton),
-
-
- GGROUP(jbtn_15, "BTN15_", JSButton),
-
-
-
-
-
-
-
- GSCALAR(rc_speed, "RC_SPEED", RC_SPEED_DEFAULT),
-
-
-
-
-
- GSCALAR(acro_rp_p, "ACRO_RP_P", ACRO_RP_P),
-
-
-
-
-
- GSCALAR(acro_yaw_p, "ACRO_YAW_P", ACRO_YAW_P),
-
-
-
-
-
-
- GSCALAR(acro_balance_roll, "ACRO_BAL_ROLL", ACRO_BALANCE_ROLL),
-
-
-
-
-
-
- GSCALAR(acro_balance_pitch, "ACRO_BAL_PITCH", ACRO_BALANCE_PITCH),
-
-
-
-
-
- GSCALAR(acro_trainer, "ACRO_TRAINER", ACRO_TRAINER_LIMITED),
-
-
-
-
-
- GSCALAR(acro_expo, "ACRO_EXPO", ACRO_EXPO_DEFAULT),
-
- #if CAMERA == ENABLED
-
-
- GOBJECT(camera, "CAM_", AP_Camera),
- #endif
-
-
- GOBJECT(relay, "RELAY_", AP_Relay),
-
-
- GOBJECT(compass, "COMPASS_", Compass),
-
-
- GOBJECT(ins, "INS_", AP_InertialSensor),
-
-
- GOBJECT(wp_nav, "WPNAV_", AC_WPNav),
-
-
- GOBJECT(loiter_nav, "LOIT_", AC_Loiter),
- #if CIRCLE_NAV_ENABLED == ENABLED
-
-
- GOBJECT(circle_nav, "CIRCLE_", AC_Circle),
- #endif
-
-
- GOBJECT(attitude_control, "ATC_", AC_AttitudeControl_Sub),
-
-
- GOBJECT(pos_control, "PSC", AC_PosControl),
-
-
- GOBJECTN(_gcs.chan_parameters[0], gcs0, "SR0_", GCS_MAVLINK_Parameters),
-
-
- GOBJECTN(_gcs.chan_parameters[1], gcs1, "SR1_", GCS_MAVLINK_Parameters),
-
-
- GOBJECTN(_gcs.chan_parameters[2], gcs2, "SR2_", GCS_MAVLINK_Parameters),
-
-
- GOBJECTN(_gcs.chan_parameters[3], gcs3, "SR3_", GCS_MAVLINK_Parameters),
-
-
- GOBJECT(ahrs, "AHRS_", AP_AHRS),
- #if MOUNT == ENABLED
-
-
- GOBJECT(camera_mount, "MNT", AP_Mount),
- #endif
-
-
- GOBJECT(logger, "LOG", AP_Logger),
-
-
- GOBJECT(battery, "BATT", AP_BattMonitor),
-
-
- GOBJECT(arming, "ARMING_", AP_Arming_Sub),
-
-
- GOBJECT(BoardConfig, "BRD_", AP_BoardConfig),
- #if HAL_WITH_UAVCAN
-
-
- GOBJECT(BoardConfig_CAN, "CAN_", AP_BoardConfig_CAN),
- #endif
- #if CONFIG_HAL_BOARD == HAL_BOARD_SITL
- GOBJECT(sitl, "SIM_", SITL::SITL),
- #endif
-
-
- GOBJECT(barometer, "GND_", AP_Baro),
-
-
-
- GOBJECT(gps, "GPS_", AP_GPS),
-
-
-
- GOBJECT(leak_detector, "LEAK", AP_LeakDetector),
-
-
- GOBJECT(scheduler, "SCHED_", AP_Scheduler),
- #if AC_FENCE == ENABLED
-
-
- GOBJECT(fence, "FENCE_", AC_Fence),
- #endif
- #if AVOIDANCE_ENABLED == ENABLED
-
-
- GOBJECT(avoid, "AVOID_", AC_Avoid),
- #endif
- #if AC_RALLY == ENABLED
-
-
- GOBJECT(rally, "RALLY_", AP_Rally),
- #endif
-
-
- GOBJECT(motors, "MOT_", AP_Motors6DOF),
- #if RCMAP_ENABLED == ENABLED
-
-
- GOBJECT(rcmap, "RCMAP_", RCMapper),
- #endif
-
-
- GOBJECTN(EKF2, NavEKF2, "EK2_", NavEKF2),
-
-
- GOBJECTN(EKF3, NavEKF3, "EK3_", NavEKF3),
-
-
- GOBJECT(mission, "MIS_", AP_Mission),
- #if RANGEFINDER_ENABLED == ENABLED
-
-
- GOBJECT(rangefinder, "RNGFND", RangeFinder),
- #endif
- #if AP_TERRAIN_AVAILABLE && AC_TERRAIN
-
-
- GOBJECT(terrain, "TERRAIN_", AP_Terrain),
- #endif
- #if OPTFLOW == ENABLED
-
-
- GOBJECT(optflow, "FLOW", OpticalFlow),
- #endif
- #if RPM_ENABLED == ENABLED
-
-
- GOBJECT(rpm_sensor, "RPM", AP_RPM),
- #endif
-
-
- GOBJECT(notify, "NTF_", AP_Notify),
- #if AP_TERRAIN_AVAILABLE && AC_TERRAIN
-
-
-
-
-
- GSCALAR(terrain_follow, "TERRAIN_FOLLOW", 0),
- #endif
-
-
- GOBJECT(g2, "", ParametersG2),
- AP_VAREND
- };
- const AP_Param::GroupInfo ParametersG2::var_info[] = {
- #if PROXIMITY_ENABLED == ENABLED
-
-
- AP_SUBGROUPINFO(proximity, "PRX", 2, ParametersG2, AP_Proximity),
- #endif
- #if GRIPPER_ENABLED == ENABLED
-
-
- AP_SUBGROUPINFO(gripper, "GRIP_", 3, ParametersG2, AP_Gripper),
- #endif
-
-
- AP_SUBGROUPINFO(servo_channels, "SERVO", 16, ParametersG2, SRV_Channels),
-
-
- AP_SUBGROUPINFO(rc_channels, "RC", 17, ParametersG2, RC_Channels),
- #ifdef ENABLE_SCRIPTING
-
-
- AP_SUBGROUPINFO(scripting, "SCR_", 18, ParametersG2, AP_Scripting),
- #endif
- AP_GROUPEND
- };
- ParametersG2::ParametersG2()
- #if PROXIMITY_ENABLED == ENABLED
- : proximity(sub.serial_manager)
- #endif
- {
- AP_Param::setup_object_defaults(this, var_info);
- }
- const AP_Param::ConversionInfo conversion_table[] = {
- { Parameters::k_param_fs_batt_voltage, 0, AP_PARAM_FLOAT, "BATT_LOW_VOLT" },
- { Parameters::k_param_fs_batt_mah, 0, AP_PARAM_FLOAT, "BATT_LOW_MAH" },
- { Parameters::k_param_failsafe_battery_enabled, 0, AP_PARAM_INT8, "BATT_FS_LOW_ACT" },
- { Parameters::k_param_compass_enabled_deprecated, 0, AP_PARAM_INT8, "COMPASS_ENABLE" },
- { Parameters::k_param_arming, 2, AP_PARAM_INT16, "ARMING_CHECK" },
- };
- void Sub::load_parameters()
- {
- if (!AP_Param::check_var_info()) {
- hal.console->printf("Bad var table\n");
- AP_HAL::panic("Bad var table");
- }
-
- ahrs.set_correct_centrifugal(false);
- hal.util->set_soft_armed(false);
- if (!g.format_version.load() ||
- g.format_version != Parameters::k_format_version) {
-
- hal.console->printf("Firmware change: erasing EEPROM...\n");
- StorageManager::erase();
- AP_Param::erase_all();
-
- g.format_version.set_and_save(Parameters::k_format_version);
- hal.console->println("done.");
- }
- uint32_t before = AP_HAL::micros();
-
- AP_Param::load_all();
- hal.console->printf("load_all took %uus\n", (unsigned)(AP_HAL::micros() - before));
- AP_Param::convert_old_parameters(&conversion_table[0], ARRAY_SIZE(conversion_table));
- AP_Param::set_frame_type_flags(AP_PARAM_FRAME_SUB);
- convert_old_parameters();
- AP_Param::set_default_by_name("BRD_SAFETYENABLE", 0);
- AP_Param::set_default_by_name("ARMING_CHECK",
- AP_Arming::ARMING_CHECK_RC |
- AP_Arming::ARMING_CHECK_VOLTAGE |
- AP_Arming::ARMING_CHECK_BATTERY);
- AP_Param::set_default_by_name("CIRCLE_RATE", 2.0f);
- AP_Param::set_default_by_name("ATC_ACCEL_Y_MAX", 110000.0f);
- AP_Param::set_default_by_name("RC3_TRIM", 1100);
- AP_Param::set_default_by_name("COMPASS_OFFS_MAX", 1000);
- AP_Param::set_default_by_name("INS_GYR_CAL", 0);
- AP_Param::set_default_by_name("MNT_DEFLT_MODE", MAV_MOUNT_MODE_RC_TARGETING);
- AP_Param::set_default_by_name("MNT_JSTICK_SPD", 100);
- AP_Param::set_by_name("MNT_RC_IN_PAN", 7);
- AP_Param::set_by_name("MNT_RC_IN_TILT", 8);
- }
- void Sub::convert_old_parameters()
- {
-
- const AP_Param::ConversionInfo filt_conversion_info[] = {
-
- { Parameters::k_param_attitude_control, 385, AP_PARAM_FLOAT, "ATC_RAT_RLL_FLTE" },
- { Parameters::k_param_attitude_control, 386, AP_PARAM_FLOAT, "ATC_RAT_PIT_FLTE" },
- { Parameters::k_param_attitude_control, 387, AP_PARAM_FLOAT, "ATC_RAT_YAW_FLTE" },
- };
- uint8_t filt_table_size = ARRAY_SIZE(filt_conversion_info);
- for (uint8_t i=0; i<filt_table_size; i++) {
- AP_Param::convert_old_parameters(&filt_conversion_info[i], 1.0f);
- }
- const uint8_t old_rc_keys[14] = { Parameters::k_param_rc_1_old, Parameters::k_param_rc_2_old,
- Parameters::k_param_rc_3_old, Parameters::k_param_rc_4_old,
- Parameters::k_param_rc_5_old, Parameters::k_param_rc_6_old,
- Parameters::k_param_rc_7_old, Parameters::k_param_rc_8_old,
- Parameters::k_param_rc_9_old, Parameters::k_param_rc_10_old,
- Parameters::k_param_rc_11_old, Parameters::k_param_rc_12_old,
- Parameters::k_param_rc_13_old, Parameters::k_param_rc_14_old
- };
- const uint16_t old_aux_chan_mask = 0x3FF0;
-
- SRV_Channels::upgrade_parameters(old_rc_keys, old_aux_chan_mask, nullptr);
- }
|