#pragma once #include #include "AP_HAL_Linux.h" #define LINUX_RC_INPUT_NUM_CHANNELS 16 namespace Linux { class RCInput : public AP_HAL::RCInput { public: RCInput(); static RCInput *from(AP_HAL::RCInput *rcinput) { return static_cast(rcinput); } virtual void init() override; bool new_input() override; uint8_t num_channels() override; void set_num_channels(uint8_t num); uint16_t read(uint8_t ch) override; uint8_t read(uint16_t* periods, uint8_t len) override; int16_t get_rssi(void) override { return _rssi; } const char *protocol() const override { return "Unknown"; } // default empty _timer_tick, this is overridden by board // specific implementations virtual void _timer_tick() {} protected: void _process_rc_pulse(uint16_t width_s0, uint16_t width_s1); void _update_periods(uint16_t *periods, uint8_t len); std::atomic rc_input_count; std::atomic last_rc_input_count; uint16_t _pwm_values[LINUX_RC_INPUT_NUM_CHANNELS]; uint8_t _num_channels; void _process_ppmsum_pulse(uint16_t width); void _process_sbus_pulse(uint16_t width_s0, uint16_t width_s1); void _process_dsm_pulse(uint16_t width_s0, uint16_t width_s1); void _process_pwm_pulse(uint16_t channel, uint16_t width_s0, uint16_t width_s1); // state of ppm decoder struct { int8_t _channel_counter; uint16_t _pulse_capt[LINUX_RC_INPUT_NUM_CHANNELS]; } ppm_state; // state of SBUS bit decoder struct { uint16_t bytes[25]; // including start bit, parity and stop bits uint16_t bit_ofs; } sbus_state; // state of DSM decoder struct { uint16_t bytes[16]; // including start bit and stop bit uint16_t bit_ofs; } dsm_state; int16_t _rssi = -1; }; }