esp-fc

#if defined(ESP32) || defined(ESP8266)

#include "Device/Input/InputEspNow.hpp"
#include "Hal/FastCode.hpp"

namespace Espfc::Device::Input {

int InputEspNow::begin(void)
{
  for (size_t i = 0; i < CHANNELS; i++)
  {
    _channels[i] = i == 2 ? 1000 : 1500;
  }
  return _rx.begin();
}

InputStatus FAST_CODE_ATTR InputEspNow::update()
{
  _rx.update();
  if (_rx.available())
  {
    for (size_t i = 0; i < CHANNELS; i++)
    {
      _channels[i] = _rx.getChannel(i);
    }
    return INPUT_RECEIVED;
  }
  return INPUT_IDLE;
}

uint16_t FAST_CODE_ATTR InputEspNow::get(uint8_t i) const
{
  return _channels[i];
}

void FAST_CODE_ATTR InputEspNow::get(uint16_t* data, size_t len) const
{
  const uint16_t* src = _channels;
  while (len--)
  {
    *data++ = *src++;
  }
}

size_t InputEspNow::getChannelCount() const
{
  return CHANNELS;
}

bool InputEspNow::needAverage() const
{
  return false;
}

} // namespace Espfc::Device::Input

#endif