leds.cpp

Go to the documentation of this file.

 
#include "teensy/leds.h"
 
FLASHMEM platform::TeensyLEDs::TeensyLEDs()
    : led_register(bus::address_from_tuple(bus::BACKPLANE_BADDR, LED_REGISTER_IDX), true),
      led_register_store(bus::address_from_tuple(bus::BACKPLANE_BADDR, LED_REGISTER_STORE_IDX)),
      led_register_reset(bus::address_from_tuple(bus::BACKPLANE_BADDR, LED_REGISTER_RESET_IDX)) {}
 
FLASHMEM bool platform::TeensyLEDs::set(const uint8_t led, bool on) {
  if (led > 7)
    return false;
 
  if (on)
    led_states |= (1 << led);
  else
    led_states &= ~(1 << led);
 
  return true;
}
 
FLASHMEM void platform::TeensyLEDs::set_all(const uint8_t states) { led_states = states; }
 
FLASHMEM void platform::TeensyLEDs::reset() {
  led_states = 0;
  led_register_reset.trigger();
}
 
FLASHMEM uint8_t platform::TeensyLEDs::get_all() const { return led_states; }
 
FLASHMEM utils::status platform::TeensyLEDs::write_to_hardware() const {
  bool ret = led_register.transfer8(led_states);
  led_register_store.trigger();
  return utils::status(ret);
}