2019-05-26 22:46:41 -03:00
|
|
|
#include "AP_Periph.h"
|
|
|
|
|
|
|
|
extern const AP_HAL::HAL &hal;
|
|
|
|
|
2019-10-18 21:28:09 -03:00
|
|
|
#ifndef AP_PERIPH_LED_BRIGHT_DEFAULT
|
|
|
|
#define AP_PERIPH_LED_BRIGHT_DEFAULT 100
|
|
|
|
#endif
|
|
|
|
|
2019-05-26 22:46:41 -03:00
|
|
|
/*
|
|
|
|
* AP_Periph parameter definitions
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
|
|
|
#define GSCALAR(v, name, def) { periph.g.v.vtype, name, Parameters::k_param_ ## v, &periph.g.v, {def_value : def} }
|
|
|
|
#define ASCALAR(v, name, def) { periph.aparm.v.vtype, name, Parameters::k_param_ ## v, (const void *)&periph.aparm.v, {def_value : def} }
|
|
|
|
#define GGROUP(v, name, class) { AP_PARAM_GROUP, name, Parameters::k_param_ ## v, &periph.g.v, {group_info : class::var_info} }
|
|
|
|
#define GOBJECT(v, name, class) { AP_PARAM_GROUP, name, Parameters::k_param_ ## v, (const void *)&periph.v, {group_info : class::var_info} }
|
|
|
|
#define GOBJECTN(v, pname, name, class) { AP_PARAM_GROUP, name, Parameters::k_param_ ## pname, (const void *)&periph.v, {group_info : class::var_info} }
|
|
|
|
|
|
|
|
const AP_Param::Info AP_Periph_FW::var_info[] = {
|
|
|
|
// @Param: FORMAT_VERSION
|
|
|
|
// @DisplayName: Eeprom format version number
|
|
|
|
// @Description: This value is incremented when changes are made to the eeprom format
|
|
|
|
// @User: Advanced
|
|
|
|
GSCALAR(format_version, "FORMAT_VERSION", 0),
|
|
|
|
|
|
|
|
// can node number, 0 for dynamic node allocation
|
|
|
|
GSCALAR(can_node, "CAN_NODE", HAL_CAN_DEFAULT_NODE_ID),
|
|
|
|
|
|
|
|
// can node baudrate
|
|
|
|
GSCALAR(can_baudrate, "CAN_BAUDRATE", 1000000),
|
|
|
|
|
2019-08-31 04:20:53 -03:00
|
|
|
#ifdef HAL_PERIPH_ENABLE_BUZZER
|
|
|
|
GSCALAR(buzz_volume, "BUZZER_VOLUME", 100),
|
|
|
|
#endif
|
|
|
|
|
2019-05-26 22:46:41 -03:00
|
|
|
#ifdef HAL_PERIPH_ENABLE_GPS
|
|
|
|
// GPS driver
|
|
|
|
// @Group: GPS_
|
2019-10-19 01:36:14 -03:00
|
|
|
// @Path: ../../libraries/AP_GPS/AP_GPS.cpp
|
2019-05-26 22:46:41 -03:00
|
|
|
GOBJECT(gps, "GPS_", AP_GPS),
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#ifdef HAL_PERIPH_ENABLE_MAG
|
|
|
|
// @Group: COMPASS_
|
2019-10-19 01:36:14 -03:00
|
|
|
// @Path: ../../libraries/AP_Compass/AP_Compass.cpp
|
2019-05-26 22:46:41 -03:00
|
|
|
GOBJECT(compass, "COMPASS_", Compass),
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#ifdef HAL_PERIPH_ENABLE_BARO
|
|
|
|
// Baro driver
|
|
|
|
// @Group: BARO_
|
2019-10-19 01:36:14 -03:00
|
|
|
// @Path: ../../libraries/AP_Baro/AP_Baro.cpp
|
2019-05-26 22:46:41 -03:00
|
|
|
GOBJECT(baro, "BARO_", AP_Baro),
|
|
|
|
#endif
|
2019-08-31 04:20:53 -03:00
|
|
|
|
2019-10-18 21:28:09 -03:00
|
|
|
#ifdef AP_PERIPH_HAVE_LED
|
|
|
|
GSCALAR(led_brightness, "LED_BRIGHTNESS", AP_PERIPH_LED_BRIGHT_DEFAULT),
|
2019-10-10 00:18:59 -03:00
|
|
|
#endif
|
|
|
|
|
2019-10-03 08:02:56 -03:00
|
|
|
#ifdef HAL_PERIPH_ENABLE_AIRSPEED
|
|
|
|
// Airspeed driver
|
|
|
|
// @Group: ARSP
|
2019-10-19 01:36:14 -03:00
|
|
|
// @Path: ../../libraries/AP_Airspeed/AP_Airspeed.cpp
|
2019-10-03 08:02:56 -03:00
|
|
|
GOBJECT(airspeed, "ARSP", AP_Airspeed),
|
|
|
|
#endif
|
2019-10-19 01:36:14 -03:00
|
|
|
|
|
|
|
#ifdef HAL_PERIPH_ENABLE_RANGEFINDER
|
|
|
|
// Rangefinder driver
|
|
|
|
// @Group: RNGFND
|
|
|
|
// @Path: ../../libraries/AP_RangeFinder/Rangefinder.cpp
|
|
|
|
GOBJECT(rangefinder, "RNGFND", RangeFinder),
|
|
|
|
#endif
|
2019-10-03 08:02:56 -03:00
|
|
|
|
2019-05-26 22:46:41 -03:00
|
|
|
AP_VAREND
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
void AP_Periph_FW::load_parameters(void)
|
|
|
|
{
|
|
|
|
AP_Param::setup_sketch_defaults();
|
|
|
|
|
|
|
|
if (!AP_Param::check_var_info()) {
|
|
|
|
hal.console->printf("Bad parameter table\n");
|
|
|
|
AP_HAL::panic("Bad parameter table");
|
|
|
|
}
|
|
|
|
if (!g.format_version.load() ||
|
|
|
|
g.format_version != Parameters::k_format_version) {
|
|
|
|
// erase all parameters
|
|
|
|
StorageManager::erase();
|
|
|
|
AP_Param::erase_all();
|
|
|
|
|
|
|
|
// save the current format version
|
|
|
|
g.format_version.set_and_save(Parameters::k_format_version);
|
|
|
|
}
|
|
|
|
|
|
|
|
// Load all auto-loaded EEPROM variables
|
|
|
|
AP_Param::load_all();
|
|
|
|
}
|