/* * This file 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 file 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 . * * Code by Andrew Tridgell and Siddharth Bharat Purohit */ #pragma once #include "AP_RCProtocol.h" class AP_RCProtocol_DSM : public AP_RCProtocol_Backend { public: AP_RCProtocol_DSM(AP_RCProtocol &_frontend) : AP_RCProtocol_Backend(_frontend) {} void process_pulse(uint32_t width_s0, uint32_t width_s1) override; void process_byte(uint8_t byte) override; void start_bind(void) override; void update(void) override; private: void dsm_decode(); bool dsm_decode_channel(uint16_t raw, unsigned shift, unsigned *channel, unsigned *value); void dsm_guess_format(bool reset, const uint8_t dsm_frame[16]); bool dsm_decode(uint64_t frame_time, const uint8_t dsm_frame[16], uint16_t *values, uint16_t *num_values, uint16_t max_values); uint64_t dsm_last_frame_time; /**< Timestamp for start of last dsm frame */ unsigned dsm_channel_shift; /**< Channel resolution, 0=unknown, 10=10 bit, 11=11 bit */ // state of DSM decoder struct { uint16_t bytes[16]; // including start bit and stop bit uint16_t bit_ofs; } dsm_state; // bind state machine enum { BIND_STATE_NONE, BIND_STATE1, BIND_STATE2, BIND_STATE3, BIND_STATE4, } bind_state; uint32_t bind_last_ms; struct { uint8_t buf[16]; uint8_t ofs; uint32_t last_byte_ms; } byte_input; };