#include <FastLED.h>
#include "../../monocoque/simulatorapi/simdata.h"

#define BYTE_SIZE sizeof(SimData)

#define LED_PIN     7
#define NUM_LEDS    6

CRGB leds[NUM_LEDS];
SimData sd;
int maxrpm = 0;
int rpm = 0;
int numlights = NUM_LEDS;
int pin = LED_PIN;
int lights[6];


void setup() {

  Serial.begin(9600);
  FastLED.addLeds<WS2812, LED_PIN, GRB>(leds, NUM_LEDS);
  FastLED.setMaxPowerInVoltsAndMilliamps(5, 500);
  FastLED.setBrightness(40);
  for (int i = 0; i < numlights; i++)
  {
    leds[i] = CRGB ( 0, 0, 0);
    lights[i] = 0;
  }
  FastLED.clear();

  sd.rpms = 0;
  sd.maxrpm = 6500;
  sd.altitude = 10;
  sd.pulses = 40000;
  sd.velocity = 10;
}

void loop() {

  int l = 0;
  char buff[BYTE_SIZE];

  if (Serial.available() >= BYTE_SIZE) {
    Serial.readBytes(buff, BYTE_SIZE);
    memcpy(&sd, &buff, BYTE_SIZE);
    rpm = sd.rpms;
    maxrpm = sd.maxrpm;

  }


  while (l < numlights)
  {
    lights[l] = 0;
    l++;
  }
  l = -1; 
  int rpmlights = 0;
  while (rpm > rpmlights)
  {
    if (l>=0)
    {
      lights[l] = 1;
    }
    l++;
    rpmlights = rpmlights + (((maxrpm-250)/numlights));
  }

  l = 0;
  FastLED.clear();
  while (l < numlights)
  {

    if (l >= numlights / 2)
    {
      leds[l] = CRGB ( 0, 0, 255);
    }
    if (l < numlights / 2)
    {
      leds[l] = CRGB ( 0, 255, 0);
    }
    if (l == numlights - 1)
    {
      leds[l] = CRGB ( 255, 0, 0);
    }
    if (lights[l] <= 0)
    {
      leds[l] = CRGB ( 0, 0, 0);
    }
    FastLED.show();
    l++;
  }
}