You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
41 lines
729 B
41 lines
729 B
|
|
#include "RCOutput.h" |
|
#include <AP_Math/AP_Math.h> |
|
|
|
using namespace Empty; |
|
|
|
void RCOutput::init() {} |
|
|
|
void RCOutput::set_freq(uint32_t chmask, uint16_t freq_hz) {} |
|
|
|
uint16_t RCOutput::get_freq(uint8_t chan) { |
|
return 50; |
|
} |
|
|
|
void RCOutput::enable_ch(uint8_t chan) |
|
{} |
|
|
|
void RCOutput::disable_ch(uint8_t chan) |
|
{} |
|
|
|
void RCOutput::write(uint8_t chan, uint16_t period_us) |
|
{ |
|
if (chan < ARRAY_SIZE(value)) { |
|
value[chan] = period_us; |
|
} |
|
} |
|
|
|
uint16_t RCOutput::read(uint8_t chan) |
|
{ |
|
if (chan < ARRAY_SIZE(value)) { |
|
return value[chan]; |
|
} |
|
return 900; |
|
} |
|
|
|
void RCOutput::read(uint16_t* period_us, uint8_t len) |
|
{ |
|
len = MIN(len, ARRAY_SIZE(value)); |
|
memcpy(period_us, value, len*sizeof(value[0])); |
|
} |
|
|
|
|