Line data    Source code

       1             : 
       2             : #include "RCOutput.h"
       3             : #include <AP_Math/AP_Math.h>
       4             : 
       5             : using namespace Empty;
       6             : 
       7           0 : void RCOutput::init() {}
       8             : 
       9           0 : void RCOutput::set_freq(uint32_t chmask, uint16_t freq_hz) {}
      10             : 
      11           0 : uint16_t RCOutput::get_freq(uint8_t chan) {
      12           0 :     return 50;
      13             : }
      14             : 
      15           0 : void RCOutput::enable_ch(uint8_t chan)
      16           0 : {}
      17             : 
      18           0 : void RCOutput::disable_ch(uint8_t chan)
      19           0 : {}
      20             : 
      21           0 : void RCOutput::write(uint8_t chan, uint16_t period_us)
      22             : {
      23           0 :     if (chan < ARRAY_SIZE(value)) {
      24           0 :         value[chan] = period_us;
      25             :     }
      26           0 : }
      27             : 
      28           0 : uint16_t RCOutput::read(uint8_t chan)
      29             : {
      30           0 :     if (chan < ARRAY_SIZE(value)) {
      31           0 :         return value[chan];
      32             :     }
      33           0 :     return 900;
      34             : }
      35             : 
      36           0 : void RCOutput::read(uint16_t* period_us, uint8_t len)
      37             : {
      38           0 :     len = MIN(len, ARRAY_SIZE(value));
      39           0 :     memcpy(period_us, value, len*sizeof(value[0]));
      40           0 : }
      41             :