From c2c6f3c9584bd585dc6f8d855ed22cc0bffa9de2 Mon Sep 17 00:00:00 2001 From: Lorenz Meier Date: Wed, 25 Nov 2015 10:15:59 +0100 Subject: [PATCH] FMU driver: Add S.BUS and DSM FDs, not active yet --- src/drivers/px4fmu/fmu.cpp | 12 ++++++++++++ 1 file changed, 12 insertions(+) diff --git a/src/drivers/px4fmu/fmu.cpp b/src/drivers/px4fmu/fmu.cpp index 4c8b03b44c..9e1ea99861 100644 --- a/src/drivers/px4fmu/fmu.cpp +++ b/src/drivers/px4fmu/fmu.cpp @@ -141,6 +141,8 @@ private: orb_advert_t _outputs_pub; unsigned _num_outputs; int _class_instance; + int _sbus_fd; + int _dsm_fd; volatile bool _initialized; bool _servo_armed; @@ -285,6 +287,8 @@ PX4FMU::PX4FMU() : _outputs_pub(nullptr), _num_outputs(0), _class_instance(0), + _sbus_fd(-1), + _dsm_fd(-1), _initialized(false), _servo_armed(false), _pwm_on(false), @@ -318,6 +322,14 @@ PX4FMU::PX4FMU() : _rc_in.input_source = input_rc_s::RC_INPUT_SOURCE_PX4FMU_PPM; #endif +#ifdef SBUS_SERIAL_PORT + _sbus_fd = sbus_init(SBUS_SERIAL_PORT, true); +#endif + +#ifdef DSM_SERIAL_PORT + _dsm_fd = dsm_init(DSM_SERIAL_PORT); +#endif + /* only enable this during development */ _debug_enabled = false; }