2014-01-19 21:57:39 -04:00
/*
This program is free software : you can redistribute it and / or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation , either version 3 of the License , or
( at your option ) any later version .
This program is distributed in the hope that it will be useful ,
but WITHOUT ANY WARRANTY ; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE . See the
GNU General Public License for more details .
You should have received a copy of the GNU General Public License
along with this program . If not , see < http : //www.gnu.org/licenses/>.
*/
/*
* AP_BoardConfig - board specific configuration
*/
2015-08-11 03:28:42 -03:00
# include "AP_BoardConfig.h"
2019-08-07 01:26:11 -03:00
# include <AP_Common/AP_Common.h>
# include <AP_HAL/AP_HAL.h>
2018-04-17 00:53:47 -03:00
# include <AP_RTC/AP_RTC.h>
2019-12-29 19:52:23 -04:00
# include <AP_Vehicle/AP_Vehicle.h>
2019-08-07 01:26:11 -03:00
# include <GCS_MAVLink/GCS.h>
2014-01-19 21:57:39 -04:00
2019-08-07 01:26:11 -03:00
# include <stdio.h>
2018-07-11 22:26:58 -03:00
# ifndef BOARD_TYPE_DEFAULT
2016-08-10 10:48:50 -03:00
# define BOARD_TYPE_DEFAULT PX4_BOARD_AUTO
2018-07-11 22:26:58 -03:00
# endif
2018-01-05 03:00:09 -04:00
2019-02-25 01:13:46 -04:00
# if CONFIG_HAL_BOARD == HAL_BOARD_CHIBIOS
2018-01-05 03:00:09 -04:00
# define BOARD_SAFETY_ENABLE_DEFAULT 1
2018-04-06 22:31:15 -03:00
# ifndef BOARD_PWM_COUNT_DEFAULT
2018-01-05 03:00:09 -04:00
# define BOARD_PWM_COUNT_DEFAULT 6
2018-04-06 22:31:15 -03:00
# endif
# ifndef BOARD_SER1_RTSCTS_DEFAULT
2018-01-05 03:00:09 -04:00
# define BOARD_SER1_RTSCTS_DEFAULT 2
2018-04-06 22:31:15 -03:00
# endif
2018-07-11 22:26:58 -03:00
# ifndef BOARD_TYPE_DEFAULT
2018-01-05 03:00:09 -04:00
# define BOARD_TYPE_DEFAULT PX4_BOARD_AUTO
# endif
2018-07-11 22:26:58 -03:00
# endif
2018-01-05 03:00:09 -04:00
# ifndef HAL_IMU_TEMP_DEFAULT
# define HAL_IMU_TEMP_DEFAULT -1 // disabled
2014-01-19 21:57:39 -04:00
# endif
2019-09-02 23:24:18 -03:00
# ifndef BOARD_SAFETY_OPTION_DEFAULT
# define BOARD_SAFETY_OPTION_DEFAULT (BOARD_SAFETY_OPTION_BUTTON_ACTIVE_SAFETY_OFF|BOARD_SAFETY_OPTION_BUTTON_ACTIVE_SAFETY_ON)
# endif
# ifndef BOARD_SAFETY_ENABLE
# define BOARD_SAFETY_ENABLE 1
2018-04-13 02:56:40 -03:00
# endif
2018-05-25 07:52:41 -03:00
# ifndef BOARD_PWM_COUNT_DEFAULT
# define BOARD_PWM_COUNT_DEFAULT 8
# endif
2018-11-10 17:42:24 -04:00
# ifndef BOARD_CONFIG_BOARD_VOLTAGE_MIN
# define BOARD_CONFIG_BOARD_VOLTAGE_MIN 4.3f
# endif
2019-04-11 05:25:36 -03:00
# ifndef HAL_BRD_OPTIONS_DEFAULT
# if CONFIG_HAL_BOARD == HAL_BOARD_CHIBIOS
# define HAL_BRD_OPTIONS_DEFAULT BOARD_OPTION_WATCHDOG
# else
# define HAL_BRD_OPTIONS_DEFAULT 0
# endif
# endif
2019-07-19 03:55:57 -03:00
# ifndef HAL_DEFAULT_BOOT_DELAY
# define HAL_DEFAULT_BOOT_DELAY 0
# endif
2014-01-19 21:57:39 -04:00
extern const AP_HAL : : HAL & hal ;
2019-02-10 14:32:23 -04:00
AP_BoardConfig * AP_BoardConfig : : _singleton ;
2014-01-19 21:57:39 -04:00
// table of user settable parameters
2015-10-25 14:03:46 -03:00
const AP_Param : : GroupInfo AP_BoardConfig : : var_info [ ] = {
2014-01-19 21:57:39 -04:00
// @Param: PWM_COUNT
2016-05-12 13:56:59 -03:00
// @DisplayName: Auxiliary pin config
2018-10-30 00:09:41 -03:00
// @Description: Controls number of FMU outputs which are setup for PWM. All unassigned pins can be used for GPIO
// @Values: 0:No PWMs,1:One PWMs,2:Two PWMs,3:Three PWMs,4:Four PWMs,5:Five PWMs,6:Six PWMs,7:Seven PWMs,8:Eight PWMs
2016-05-22 20:58:58 -03:00
// @RebootRequired: True
2016-07-26 02:35:15 -03:00
// @User: Advanced
2018-05-25 07:52:41 -03:00
AP_GROUPINFO ( " PWM_COUNT " , 0 , AP_BoardConfig , pwm_count , BOARD_PWM_COUNT_DEFAULT ) ,
2014-02-09 21:57:19 -04:00
2018-01-05 03:00:09 -04:00
# if AP_FEATURE_RTSCTS
2014-02-09 21:57:19 -04:00
// @Param: SER1_RTSCTS
// @DisplayName: Serial 1 flow control
2014-02-10 21:10:55 -04:00
// @Description: Enable flow control on serial 1 (telemetry 1) on Pixhawk. You must have the RTS and CTS pins connected to your radio. The standard DF13 6 pin connector for a 3DR radio does have those pins connected. If this is set to 2 then flow control will be auto-detected by checking for the output buffer filling on startup. Note that the PX4v1 does not have hardware flow control pins on this port, so you should leave this disabled.
2014-02-10 20:22:27 -04:00
// @Values: 0:Disabled,1:Enabled,2:Auto
2016-05-22 20:58:58 -03:00
// @RebootRequired: True
2016-07-26 02:35:15 -03:00
// @User: Advanced
2018-01-05 03:00:09 -04:00
AP_GROUPINFO ( " SER1_RTSCTS " , 1 , AP_BoardConfig , state . ser1_rtscts , BOARD_SER1_RTSCTS_DEFAULT ) ,
2014-02-09 21:57:19 -04:00
// @Param: SER2_RTSCTS
// @DisplayName: Serial 2 flow control
2018-01-05 03:00:09 -04:00
// @Description: Enable flow control on serial 2 (telemetry 2) on Pixhawk and STATE. You must have the RTS and CTS pins connected to your radio. The standard DF13 6 pin connector for a 3DR radio does have those pins connected. If this is set to 2 then flow control will be auto-detected by checking for the output buffer filling on startup.
2014-02-10 20:22:27 -04:00
// @Values: 0:Disabled,1:Enabled,2:Auto
2016-05-22 20:58:58 -03:00
// @RebootRequired: True
2016-07-26 02:35:15 -03:00
// @User: Advanced
2018-01-05 03:00:09 -04:00
AP_GROUPINFO ( " SER2_RTSCTS " , 2 , AP_BoardConfig , state . ser2_rtscts , 2 ) ,
2016-08-07 07:54:02 -03:00
# endif
2017-04-02 11:56:37 -03:00
2018-08-01 20:46:59 -03:00
# if HAL_HAVE_SAFETY_SWITCH
2014-02-11 00:58:02 -04:00
// @Param: SAFETYENABLE
2016-06-27 20:58:55 -03:00
// @DisplayName: Enable use of safety arming switch
// @Description: This controls the default state of the safety switch at startup. When set to 1 the safety switch will start in the safe state (flashing) at boot. When set to zero the safety switch will start in the unsafe state (solid) at startup. Note that if a safety switch is fitted the user can still control the safety state after startup using the switch. The safety state can also be controlled in software using a MAVLink message.
2014-02-11 00:58:02 -04:00
// @Values: 0:Disabled,1:Enabled
2016-05-22 20:58:58 -03:00
// @RebootRequired: True
2016-07-26 02:35:15 -03:00
// @User: Standard
2018-01-05 03:00:09 -04:00
AP_GROUPINFO ( " SAFETYENABLE " , 3 , AP_BoardConfig , state . safety_enable , BOARD_SAFETY_ENABLE_DEFAULT ) ,
2016-08-07 07:54:02 -03:00
# endif
2015-02-11 03:35:34 -04:00
2018-01-05 03:00:09 -04:00
# if AP_FEATURE_SBUS_OUT
2015-02-11 03:35:34 -04:00
// @Param: SBUS_OUT
2016-03-10 00:26:47 -04:00
// @DisplayName: SBUS output rate
// @Description: This sets the SBUS output frame rate in Hz
// @Values: 0:Disabled,1:50Hz,2:75Hz,3:100Hz,4:150Hz,5:200Hz,6:250Hz,7:300Hz
2016-05-22 20:58:58 -03:00
// @RebootRequired: True
2016-07-26 02:35:15 -03:00
// @User: Advanced
2018-01-05 03:00:09 -04:00
AP_GROUPINFO ( " SBUS_OUT " , 4 , AP_BoardConfig , state . sbus_out_rate , 0 ) ,
2014-01-19 21:57:39 -04:00
# endif
2015-04-29 23:02:27 -03:00
// @Param: SERIAL_NUM
// @DisplayName: User-defined serial number
// @Description: User-defined serial number of this vehicle, it can be any arbitrary number you want and has no effect on the autopilot
2017-02-10 20:25:48 -04:00
// @Range: -32768 32767
2015-04-29 23:02:27 -03:00
// @User: Standard
AP_GROUPINFO ( " SERIAL_NUM " , 5 , AP_BoardConfig , vehicleSerialNumber , 0 ) ,
2018-08-01 20:46:59 -03:00
# if HAL_HAVE_SAFETY_SWITCH
2016-05-22 20:58:58 -03:00
// @Param: SAFETY_MASK
2019-11-23 19:53:01 -04:00
// @DisplayName: Outputs which ignore the safety switch state
// @Description: A bitmask which controls what outputs can move while the safety switch has not been pressed
2016-05-22 20:58:58 -03:00
// @Values: 0:Disabled,1:Enabled
2019-11-23 19:53:01 -04:00
// @Bitmask: 0:Output1,1:Output2,2:Output3,3:Output4,4:Output5,5:Output6,6:Output7,7:Output8,8:Output9,9:Output10,10:Output11,11:Output12,12:Output13,13:Output14
2016-05-22 20:58:58 -03:00
// @RebootRequired: True
2016-07-26 02:35:15 -03:00
// @User: Advanced
2018-01-05 03:00:09 -04:00
AP_GROUPINFO ( " SAFETY_MASK " , 7 , AP_BoardConfig , state . ignore_safety_channels , 0 ) ,
2016-05-22 20:58:58 -03:00
# endif
2016-07-02 23:54:27 -03:00
# if HAL_HAVE_IMU_HEATER
// @Param: IMU_TARGTEMP
// @DisplayName: Target IMU temperature
2017-05-16 01:50:36 -03:00
// @Description: This sets the target IMU temperature for boards with controllable IMU heating units. DO NOT SET -1 on The Cube. A value of -1 sets PH1 behaviour
2016-07-02 23:54:27 -03:00
// @Range: -1 80
2017-05-02 10:42:12 -03:00
// @Units: degC
2016-07-26 02:35:15 -03:00
// @User: Advanced
2019-11-01 23:32:12 -03:00
AP_GROUPINFO ( " IMU_TARGTEMP " , 8 , AP_BoardConfig , heater . imu_target_temperature , HAL_IMU_TEMP_DEFAULT ) ,
2016-07-02 23:54:27 -03:00
# endif
2016-08-03 04:56:04 -03:00
2018-01-05 03:00:09 -04:00
# if AP_FEATURE_BOARD_DETECT
2016-08-03 04:56:04 -03:00
// @Param: TYPE
// @DisplayName: Board type
2016-08-10 10:48:50 -03:00
// @Description: This allows selection of a PX4 or VRBRAIN board type. If set to zero then the board type is auto-detected (PX4)
2017-09-08 04:59:00 -03:00
// @Values: 0:AUTO,1:PX4V1,2:Pixhawk,3:Cube/Pixhawk2,4:Pixracer,5:PixhawkMini,6:Pixhawk2Slim,7:VRBrain 5.1,8:VRBrain 5.2,9:VR Micro Brain 5.1,10:VR Micro Brain 5.2,11:VRBrain Core 1.0,12:VRBrain 5.4,13:Intel Aero FC,20:AUAV2.1
2016-08-03 04:56:04 -03:00
// @RebootRequired: True
2016-10-26 07:50:02 -03:00
// @User: Advanced
2018-01-05 03:00:09 -04:00
AP_GROUPINFO ( " TYPE " , 9 , AP_BoardConfig , state . board_type , BOARD_TYPE_DEFAULT ) ,
2016-08-03 04:56:04 -03:00
# endif
2017-03-09 19:43:10 -04:00
2020-01-17 23:05:54 -04:00
# if HAL_WITH_IO_MCU
2017-05-29 22:21:15 -03:00
// @Param: IO_ENABLE
2017-03-09 19:43:10 -04:00
// @DisplayName: Enable IO co-processor
// @Description: This allows for the IO co-processor on FMUv1 and FMUv2 to be disabled
// @Values: 0:Disabled,1:Enabled
// @RebootRequired: True
// @User: Advanced
2018-01-05 03:00:09 -04:00
AP_GROUPINFO ( " IO_ENABLE " , 10 , AP_BoardConfig , state . io_enable , 1 ) ,
2017-04-09 21:02:42 -03:00
# endif
2017-04-02 11:56:37 -03:00
2018-03-11 11:47:28 -03:00
# if HAL_RCINPUT_WITH_AP_RADIO
2018-01-05 04:58:17 -04:00
// @Group: RADIO
// @Path: ../AP_Radio/AP_Radio.cpp
AP_SUBGROUPINFO ( _radio , " RADIO " , 11 , AP_BoardConfig , AP_Radio ) ,
# endif
2018-02-02 16:48:29 -04:00
2018-04-13 02:56:40 -03:00
// @Param: SAFETYOPTION
// @DisplayName: Options for safety button behavior
// @Description: This controls the activation of the safety button. It allows you to control if the safety button can be used for safety enable and/or disable, and whether the button is only active when disarmed
2019-01-07 20:18:46 -04:00
// @Bitmask: 0:ActiveForSafetyEnable,1:ActiveForSafetyDisable,2:ActiveWhenArmed,3:Force safety on when the aircraft disarms
2018-04-13 02:56:40 -03:00
// @User: Standard
AP_GROUPINFO ( " SAFETYOPTION " , 13 , AP_BoardConfig , state . safety_option , BOARD_SAFETY_OPTION_DEFAULT ) ,
2018-06-13 23:15:55 -03:00
// @Group: RTC
// @Path: ../AP_RTC/AP_RTC.cpp
AP_SUBGROUPINFO ( rtc , " RTC " , 14 , AP_BoardConfig , AP_RTC ) ,
2018-11-10 17:42:24 -04:00
# if HAL_HAVE_BOARD_VOLTAGE
// @Param: VBUS_MIN
// @DisplayName: Autopilot board voltage requirement
// @Description: Minimum voltage on the autopilot power rail to allow the aircraft to arm. 0 to disable the check.
// @Units: V
// @Range: 4.0 5.5
2018-12-27 21:05:26 -04:00
// @Increment: 0.1
2018-11-10 17:42:24 -04:00
// @User: Advanced
AP_GROUPINFO ( " VBUS_MIN " , 15 , AP_BoardConfig , _vbus_min , BOARD_CONFIG_BOARD_VOLTAGE_MIN ) ,
# endif
# if HAL_HAVE_SERVO_VOLTAGE
// @Param: VSERVO_MIN
// @DisplayName: Servo voltage requirement
// @Description: Minimum voltage on the servo rail to allow the aircraft to arm. 0 to disable the check.
// @Units: V
// @Range: 3.3 12.0
2018-12-27 21:05:26 -04:00
// @Increment: 0.1
2018-11-10 17:42:24 -04:00
// @User: Advanced
AP_GROUPINFO ( " VSERVO_MIN " , 16 , AP_BoardConfig , _vservo_min , 0 ) ,
# endif
2018-12-27 21:06:12 -04:00
# if CONFIG_HAL_BOARD == HAL_BOARD_CHIBIOS
// @Param: SD_SLOWDOWN
// @DisplayName: microSD slowdown
// @Description: This is a scaling factor to slow down microSD operation. It can be used on flight board and microSD card combinations where full speed is not reliable. For normal full speed operation a value of 0 should be used.
// @Range: 0 32
// @Increment: 1
// @User: Advanced
AP_GROUPINFO ( " SD_SLOWDOWN " , 17 , AP_BoardConfig , _sdcard_slowdown , 0 ) ,
# endif
2019-03-29 09:08:35 -03:00
# ifdef HAL_GPIO_PWM_VOLT_PIN
// @Param: PWM_VOLT_SEL
// @DisplayName: Set PWM Out Voltage
// @Description: This sets the voltage max for PWM output pulses. 0 for 3.3V and 1 for 5V output.
2019-04-01 23:44:38 -03:00
// @Values: 0:3.3V,1:5V
2019-03-29 09:08:35 -03:00
// @User: Advanced
AP_GROUPINFO ( " PWM_VOLT_SEL " , 18 , AP_BoardConfig , _pwm_volt_sel , 0 ) ,
# endif
2019-04-11 05:25:36 -03:00
// @Param: OPTIONS
// @DisplayName: Board options
// @Description: Board specific option flags
// @Bitmask: 0:Enable hardware watchdog
// @User: Advanced
AP_GROUPINFO ( " OPTIONS " , 19 , AP_BoardConfig , _options , HAL_BRD_OPTIONS_DEFAULT ) ,
2019-07-19 03:55:57 -03:00
// @Param: BOOT_DELAY
// @DisplayName: Boot delay
// @Description: This adds a delay in milliseconds to boot to ensure peripherals initialise fully
// @Range: 0 10000
// @Units: ms
// @User: Advanced
AP_GROUPINFO ( " BOOT_DELAY " , 20 , AP_BoardConfig , _boot_delay_ms , HAL_DEFAULT_BOOT_DELAY ) ,
2019-11-01 23:32:12 -03:00
# if HAL_HAVE_IMU_HEATER
// @Param: IMUHEAT_P
// @DisplayName: IMU Heater P gain
// @Description: IMU Heater P gain
// @Range: 1 500
// @Increment: 1
// @User: Advanced
// @Param: IMUHEAT_I
// @DisplayName: IMU Heater I gain
// @Description: IMU Heater integrator gain
// @Range: 0 1
// @Increment: 0.1
// @User: Advanced
// @Param: IMUHEAT_IMAX
// @DisplayName: IMU Heater IMAX
// @Description: IMU Heater integrator maximum
// @Range: 0 100
// @Increment: 1
// @User: Advanced
AP_SUBGROUPINFO ( heater . pi_controller , " IMUHEAT_ " , 21 , AP_BoardConfig , AC_PI ) ,
# endif
2019-12-29 04:09:27 -04:00
// @Param: ALT_CONFIG
// @DisplayName: Alternative HW config
// @Description: Select an alternative hardware configuration. A value of zero selects the default configuration for this board. Other values are board specific. Please see the documentation for your board for details on any alternative configuration values that may be available.
// @Range: 0 10
// @Increment: 1
// @User: Advanced
// @RebootRequired: True
AP_GROUPINFO ( " ALT_CONFIG " , 22 , AP_BoardConfig , _alt_config , 0 ) ,
2019-07-19 03:55:57 -03:00
2014-01-19 21:57:39 -04:00
AP_GROUPEND
} ;
void AP_BoardConfig : : init ( )
{
2018-01-05 03:00:09 -04:00
board_setup ( ) ;
2017-04-02 11:56:37 -03:00
2018-04-17 00:53:47 -03:00
AP : : rtc ( ) . set_utc_usec ( hal . util - > get_hw_rtc ( ) , AP_RTC : : SOURCE_HW ) ;
2018-12-27 21:06:12 -04:00
2019-07-19 03:55:57 -03:00
if ( _boot_delay_ms > 0 ) {
uint16_t delay_ms = uint16_t ( _boot_delay_ms . get ( ) ) ;
if ( hal . util - > was_watchdog_armed ( ) & & delay_ms > 200 ) {
// don't delay a long time on watchdog reset, the pilot
// may be able to save the vehicle
delay_ms = 200 ;
}
hal . scheduler - > delay ( delay_ms ) ;
}
2018-12-27 21:06:12 -04:00
# if CONFIG_HAL_BOARD == HAL_BOARD_CHIBIOS && defined(USE_POSIX)
uint8_t slowdown = constrain_int16 ( _sdcard_slowdown . get ( ) , 0 , 32 ) ;
const uint8_t max_slowdown = 8 ;
do {
if ( hal . util - > fs_init ( ) ) {
break ;
}
slowdown + + ;
hal . scheduler - > delay ( 5 ) ;
} while ( slowdown < max_slowdown ) ;
if ( slowdown < max_slowdown ) {
_sdcard_slowdown . set ( slowdown ) ;
} else {
printf ( " SDCard failed to start \n " ) ;
}
# endif
2014-01-19 21:57:39 -04:00
}
2016-10-20 21:53:34 -03:00
// set default value for BRD_SAFETY_MASK
void AP_BoardConfig : : set_default_safety_ignore_mask ( uint16_t mask )
{
2018-08-01 20:46:59 -03:00
# if HAL_HAVE_SAFETY_SWITCH
2018-01-05 03:00:09 -04:00
state . ignore_safety_channels . set_default ( mask ) ;
# endif
2016-10-20 21:53:34 -03:00
}
2017-04-29 21:47:27 -03:00
void AP_BoardConfig : : init_safety ( )
{
2018-01-05 03:00:09 -04:00
board_init_safety ( ) ;
2017-04-29 21:47:27 -03:00
}
2017-05-01 23:05:47 -03:00
/*
notify user of a fatal startup error related to available sensors .
*/
2017-06-06 04:18:15 -03:00
bool AP_BoardConfig : : _in_sensor_config_error ;
2019-11-04 18:55:39 -04:00
void AP_BoardConfig : : config_error ( const char * fmt , . . . )
2017-05-01 23:05:47 -03:00
{
2017-06-06 04:18:15 -03:00
_in_sensor_config_error = true ;
2017-05-01 23:05:47 -03:00
/*
to give the user the opportunity to connect to USB we keep
repeating the error . The mavlink delay callback is initialised
before this , so the user can change parameters ( and in
particular BRD_TYPE if needed )
*/
2019-01-04 02:57:13 -04:00
uint32_t last_print_ms = 0 ;
2017-05-01 23:05:47 -03:00
while ( true ) {
2019-01-04 02:57:13 -04:00
uint32_t now = AP_HAL : : millis ( ) ;
if ( now - last_print_ms > = 3000 ) {
last_print_ms = now ;
2019-11-04 18:55:39 -04:00
va_list arg_list ;
char printfmt [ MAVLINK_MSG_STATUSTEXT_FIELD_TEXT_LEN + 2 ] ;
hal . util - > snprintf ( printfmt , sizeof ( printfmt ) , " Config error: %s \n " , fmt ) ;
va_start ( arg_list , fmt ) ;
vprintf ( printfmt , arg_list ) ;
va_end ( arg_list ) ;
2019-07-26 03:56:55 -03:00
# if !APM_BUILD_TYPE(APM_BUILD_UNKNOWN) && !defined(HAL_BUILD_AP_PERIPH)
2019-11-04 18:55:39 -04:00
char taggedfmt [ MAVLINK_MSG_STATUSTEXT_FIELD_TEXT_LEN + 1 ] ;
hal . util - > snprintf ( taggedfmt , sizeof ( taggedfmt ) , " Config error: %s " , fmt ) ;
va_start ( arg_list , fmt ) ;
gcs ( ) . send_textv ( MAV_SEVERITY_CRITICAL , taggedfmt , arg_list ) ;
va_end ( arg_list ) ;
2019-01-04 22:22:55 -04:00
# endif
2019-01-04 02:57:13 -04:00
}
2019-07-26 03:56:55 -03:00
# if !APM_BUILD_TYPE(APM_BUILD_UNKNOWN) && !defined(HAL_BUILD_AP_PERIPH)
2019-01-04 22:22:55 -04:00
gcs ( ) . update_receive ( ) ;
gcs ( ) . update_send ( ) ;
# endif
2019-01-04 02:57:13 -04:00
hal . scheduler - > delay ( 5 ) ;
2017-05-01 23:05:47 -03:00
}
}
2019-09-02 23:24:18 -03:00
/*
handle logic for safety state button press . This should be called at
10 Hz when the button is pressed . The button can either be directly
on a pin or on a UAVCAN device
This function returns true if the safety state should be toggled
*/
bool AP_BoardConfig : : safety_button_handle_pressed ( uint8_t press_count )
{
if ( press_count ! = 10 ) {
return false ;
}
// get button options
uint16_t safety_options = get_safety_button_options ( ) ;
if ( ! ( safety_options & BOARD_SAFETY_OPTION_BUTTON_ACTIVE_ARMED ) & &
hal . util - > get_soft_armed ( ) ) {
return false ;
}
AP_HAL : : Util : : safety_state safety_state = hal . util - > safety_switch_state ( ) ;
if ( safety_state = = AP_HAL : : Util : : SAFETY_DISARMED & &
! ( safety_options & BOARD_SAFETY_OPTION_BUTTON_ACTIVE_SAFETY_OFF ) ) {
return false ;
}
if ( safety_state = = AP_HAL : : Util : : SAFETY_ARMED & &
! ( safety_options & BOARD_SAFETY_OPTION_BUTTON_ACTIVE_SAFETY_ON ) ) {
return false ;
}
return true ;
}
2019-11-01 23:32:12 -03:00
namespace AP {
AP_BoardConfig * boardConfig ( void ) {
return AP_BoardConfig : : get_singleton ( ) ;
}
} ;