2014-01-19 21:57:39 -04:00
/// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: nil -*-
/*
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
*/
# include <AP_HAL.h>
# include <AP_Common.h>
# include <AP_BoardConfig.h>
# if CONFIG_HAL_BOARD == HAL_BOARD_PX4
# include <sys/types.h>
# include <sys/stat.h>
# include <fcntl.h>
# include <unistd.h>
# include <drivers/drv_pwm_output.h>
# ifdef CONFIG_ARCH_BOARD_PX4FMU_V1
# define BOARD_PWM_COUNT_DEFAULT 2
2014-02-10 21:10:55 -04:00
# define BOARD_SER1_RTSCTS_DEFAULT 0 // no flow control on UART5 on FMUv1
2014-01-19 21:57:39 -04:00
# else
# define BOARD_PWM_COUNT_DEFAULT 4
2014-02-10 21:10:55 -04:00
# define BOARD_SER1_RTSCTS_DEFAULT 2
2014-01-19 21:57:39 -04:00
# endif
2014-03-31 14:53:16 -03:00
# elif CONFIG_HAL_BOARD == HAL_BOARD_VRBRAIN
# include <sys/types.h>
# include <sys/stat.h>
# include <fcntl.h>
# include <unistd.h>
# include <drivers/drv_pwm_output.h>
# define BOARD_PWM_COUNT_DEFAULT 8
2014-01-19 21:57:39 -04:00
# endif
extern const AP_HAL : : HAL & hal ;
// table of user settable parameters
const AP_Param : : GroupInfo AP_BoardConfig : : var_info [ ] PROGMEM = {
# if CONFIG_HAL_BOARD == HAL_BOARD_PX4
// @Param: PWM_COUNT
// @DisplayName: PWM Count
// @Description: Number of auxillary PWMs to enable. On PX4v1 only 0 or 2 is valid. On Pixhawk 0, 2, 4 or 6 is valid.
// @Values: 0:No PWMs,2:Two PWMs,4:Four PWMs,6:Six PWMs
AP_GROUPINFO ( " PWM_COUNT " , 0 , AP_BoardConfig , _pwm_count , BOARD_PWM_COUNT_DEFAULT ) ,
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
2014-02-10 21:10:55 -04:00
AP_GROUPINFO ( " SER1_RTSCTS " , 1 , AP_BoardConfig , _ser1_rtscts , BOARD_SER1_RTSCTS_DEFAULT ) ,
2014-02-09 21:57:19 -04:00
// @Param: SER2_RTSCTS
// @DisplayName: Serial 2 flow control
2014-02-10 21:10:55 -04:00
// @Description: Enable flow control on serial 2 (telemetry 2) on Pixhawk and PX4. 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
AP_GROUPINFO ( " SER2_RTSCTS " , 2 , AP_BoardConfig , _ser2_rtscts , 2 ) ,
2014-02-11 00:58:02 -04:00
// @Param: SAFETYENABLE
// @DisplayName: Enable use of safety arming switch
// @Description: Disabling this option will disable the use of the safety switch on PX4 for arming. Use of the safety switch is highly recommended, so you should leave this option set to 1 except in unusual circumstances.
// @Values: 0:Disabled,1:Enabled
AP_GROUPINFO ( " SAFETYENABLE " , 3 , AP_BoardConfig , _safety_enable , 1 ) ,
2014-03-31 14:53:16 -03:00
# elif CONFIG_HAL_BOARD == HAL_BOARD_VRBRAIN
// @Param: PWM_COUNT
// @DisplayName: PWM Count
// @Description: Number of auxillary PWMs to enable
// @Values: 0:No PWMs,2:Two PWMs,4:Four PWMs,6:Six PWMs,8:Six PWMs
AP_GROUPINFO ( " PWM_COUNT " , 0 , AP_BoardConfig , _pwm_count , BOARD_PWM_COUNT_DEFAULT ) ,
2014-01-19 21:57:39 -04:00
# endif
AP_GROUPEND
} ;
void AP_BoardConfig : : init ( )
{
# if CONFIG_HAL_BOARD == HAL_BOARD_PX4
/* configurre the FMU driver for the right number of PWMs */
// ensure only valid values are set, rounding up
if ( _pwm_count > 6 ) _pwm_count . set ( 6 ) ;
if ( _pwm_count < 0 ) _pwm_count . set ( 0 ) ;
if ( _pwm_count = = 1 ) _pwm_count . set ( 2 ) ;
if ( _pwm_count = = 3 ) _pwm_count . set ( 4 ) ;
if ( _pwm_count = = 5 ) _pwm_count . set ( 6 ) ;
int fd = open ( " /dev/px4fmu " , 0 ) ;
if ( fd = = - 1 ) {
hal . scheduler - > panic ( " Unable to open /dev/px4fmu " ) ;
}
if ( ioctl ( fd , PWM_SERVO_SET_COUNT , _pwm_count . get ( ) ) ! = 0 ) {
hal . console - > printf ( " RCOutput: Unable to setup alt PWM to %u channels \n " , _pwm_count . get ( ) ) ;
}
close ( fd ) ;
2014-02-09 21:57:19 -04:00
2014-02-10 20:22:27 -04:00
hal . uartC - > set_flow_control ( ( AP_HAL : : UARTDriver : : flow_control ) _ser1_rtscts . get ( ) ) ;
2014-02-09 21:57:19 -04:00
if ( hal . uartD ! = NULL ) {
2014-02-10 20:22:27 -04:00
hal . uartD - > set_flow_control ( ( AP_HAL : : UARTDriver : : flow_control ) _ser2_rtscts . get ( ) ) ;
2014-02-09 21:57:19 -04:00
}
2014-02-11 00:58:02 -04:00
if ( _safety_enable . get ( ) = = 0 ) {
hal . rcout - > force_safety_off ( ) ;
}
2014-03-31 14:53:16 -03:00
# elif CONFIG_HAL_BOARD == HAL_BOARD_VRBRAIN
/* configure the VRBRAIN driver for the right number of PWMs */
// ensure only valid values are set, rounding up
if ( _pwm_count > 8 ) _pwm_count . set ( 8 ) ;
if ( _pwm_count < 0 ) _pwm_count . set ( 0 ) ;
2014-04-08 08:05:31 -03:00
int fd = open ( " /dev/vroutput " , 0 ) ;
2014-03-31 14:53:16 -03:00
if ( fd = = - 1 ) {
2014-04-08 08:05:31 -03:00
hal . scheduler - > panic ( " Unable to open /dev/vroutput " ) ;
2014-03-31 14:53:16 -03:00
}
if ( ioctl ( fd , PWM_SERVO_SET_COUNT , _pwm_count . get ( ) ) ! = 0 ) {
hal . console - > printf ( " RCOutput: Unable to setup alt PWM to %u channels \n " , _pwm_count . get ( ) ) ;
}
close ( fd ) ;
2014-01-19 21:57:39 -04:00
# endif
}