|
|
|
@ -653,9 +653,10 @@ PX4FMU::set_mode(Mode mode)
@@ -653,9 +653,10 @@ PX4FMU::set_mode(Mode mode)
|
|
|
|
|
up_input_capture_set(2, Rising, 0, NULL, NULL); |
|
|
|
|
up_input_capture_set(3, Rising, 0, NULL, NULL); |
|
|
|
|
DEVICE_DEBUG("MODE_2PWM2CAP"); |
|
|
|
|
// no break
|
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
/* FALLTHROUGH */ |
|
|
|
|
|
|
|
|
|
case MODE_2PWM: // v1 multi-port with flow control lines as PWM
|
|
|
|
|
DEVICE_DEBUG("MODE_2PWM"); |
|
|
|
|
|
|
|
|
@ -674,9 +675,10 @@ PX4FMU::set_mode(Mode mode)
@@ -674,9 +675,10 @@ PX4FMU::set_mode(Mode mode)
|
|
|
|
|
case MODE_3PWM1CAP: // v1 multi-port with flow control lines as PWM
|
|
|
|
|
DEVICE_DEBUG("MODE_3PWM1CAP"); |
|
|
|
|
up_input_capture_set(3, Rising, 0, NULL, NULL); |
|
|
|
|
// no break
|
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
/* FALLTHROUGH */ |
|
|
|
|
|
|
|
|
|
case MODE_3PWM: // v1 multi-port with flow control lines as PWM
|
|
|
|
|
DEVICE_DEBUG("MODE_3PWM"); |
|
|
|
|
|
|
|
|
@ -2179,6 +2181,8 @@ PX4FMU::pwm_ioctl(file *filp, int cmd, unsigned long arg)
@@ -2179,6 +2181,8 @@ PX4FMU::pwm_ioctl(file *filp, int cmd, unsigned long arg)
|
|
|
|
|
#if defined(BOARD_HAS_PWM) && BOARD_HAS_PWM >= 8 |
|
|
|
|
|
|
|
|
|
case PWM_SERVO_SET(7): |
|
|
|
|
|
|
|
|
|
/* FALLTHROUGH */ |
|
|
|
|
case PWM_SERVO_SET(6): |
|
|
|
|
if (_mode < MODE_8PWM) { |
|
|
|
|
ret = -EINVAL; |
|
|
|
@ -2189,7 +2193,10 @@ PX4FMU::pwm_ioctl(file *filp, int cmd, unsigned long arg)
@@ -2189,7 +2193,10 @@ PX4FMU::pwm_ioctl(file *filp, int cmd, unsigned long arg)
|
|
|
|
|
|
|
|
|
|
#if defined(BOARD_HAS_PWM) && BOARD_HAS_PWM >= 6 |
|
|
|
|
|
|
|
|
|
/* FALLTHROUGH */ |
|
|
|
|
case PWM_SERVO_SET(5): |
|
|
|
|
|
|
|
|
|
/* FALLTHROUGH */ |
|
|
|
|
case PWM_SERVO_SET(4): |
|
|
|
|
if (_mode < MODE_6PWM) { |
|
|
|
|
ret = -EINVAL; |
|
|
|
@ -2226,6 +2233,7 @@ PX4FMU::pwm_ioctl(file *filp, int cmd, unsigned long arg)
@@ -2226,6 +2233,7 @@ PX4FMU::pwm_ioctl(file *filp, int cmd, unsigned long arg)
|
|
|
|
|
|
|
|
|
|
#if defined(BOARD_HAS_PWM) && BOARD_HAS_PWM >= 8 |
|
|
|
|
|
|
|
|
|
/* FALLTHROUGH */ |
|
|
|
|
case PWM_SERVO_GET(7): |
|
|
|
|
case PWM_SERVO_GET(6): |
|
|
|
|
if (_mode < MODE_8PWM) { |
|
|
|
@ -2237,6 +2245,7 @@ PX4FMU::pwm_ioctl(file *filp, int cmd, unsigned long arg)
@@ -2237,6 +2245,7 @@ PX4FMU::pwm_ioctl(file *filp, int cmd, unsigned long arg)
|
|
|
|
|
|
|
|
|
|
#if defined(BOARD_HAS_PWM) && BOARD_HAS_PWM >= 6 |
|
|
|
|
|
|
|
|
|
/* FALLTHROUGH */ |
|
|
|
|
case PWM_SERVO_GET(5): |
|
|
|
|
case PWM_SERVO_GET(4): |
|
|
|
|
if (_mode < MODE_6PWM) { |
|
|
|
|