#include "LedDriver.h"
#include "../util/RuntimeError.h"



enum {ALL_LEDS_ON = ~0x0000, ALL_LEDS_OFF = ~ALL_LEDS_ON};
enum {FIRST_LED = 1, LAST_LED = 16};

static uint16_t *ledsAddress = NULL;  // LEDs memory register location
static uint16_t ledsImage;            // internal variable to store LEDs state


static uint16_t convertLedNumberToBit(int ledNumber) {
  return 1 << (ledNumber - 1);
}


static bool IsLedOutOfBound(int ledNumber) {
  return (ledNumber < 1) || (ledNumber > 16);
}


static void SetLedImageBit(int ledNumber) {
  ledsImage |= convertLedNumberToBit(ledNumber);
}


static void ClearLedImageBit(int ledNumber) {
  ledsImage &= ~(convertLedNumberToBit(ledNumber));
}


static void updateHardware(void) {
  if(ledsAddress == NULL) {
    RUNTIME_ERROR("LED Driver: NULL pointer access", -1);
    return;
  }
  *ledsAddress = ledsImage;
}


void LedDriver_Create(uint16_t *address) {
  if(address == NULL) {
    RUNTIME_ERROR("LED Driver: NULL pointer access", -1);
    return;
  }
  ledsAddress = address;
  ledsImage = ALL_LEDS_OFF;
  updateHardware();
}


void LedDriver_Destroy(void) {
}


void LedDriver_TurnOn(int ledNumber) {
  if (IsLedOutOfBound(ledNumber)) {
    RUNTIME_ERROR("LED Driver: out-of-bounds LED", -1);
    return;
  }

  SetLedImageBit(ledNumber);
  updateHardware();
}


void LedDriver_TurnAllOn(void) {
  ledsImage = ALL_LEDS_ON;
  updateHardware();
}


void LedDriver_TurnOff(int ledNumber) {
  if (IsLedOutOfBound(ledNumber)) {
    RUNTIME_ERROR("LED Driver: out-of-bounds LED", -1);
    return;
  }

  ClearLedImageBit(ledNumber);
  updateHardware();
}


void LedDriver_TurnAllOff(void) {
  ledsImage = ALL_LEDS_OFF;
  updateHardware();
}


bool LedDriver_IsOn(int ledNumber) {
  if(IsLedOutOfBound(ledNumber)) {
    return false;
  }
  return ledsImage & 1 << (ledNumber - 1);
}


bool LedDriver_IsOff(int ledNumber) {
  return !(LedDriver_IsOn(ledNumber));
}