85 lines
1.7 KiB
C++
85 lines
1.7 KiB
C++
#include <FastLED.h>
|
|
#include "shiftlights.h"
|
|
|
|
#define SIMDATA_SIZE sizeof(ShiftLightsData)
|
|
|
|
#define LED_PIN 7
|
|
#define NUM_LEDS 6
|
|
#define BRIGHTNESS 40
|
|
#define STARTLED 1
|
|
|
|
#define COLOR1R 0
|
|
#define COLOR1G 255
|
|
#define COLOR1B 0
|
|
#define COLOR2R 255
|
|
#define COLOR2G 255
|
|
#define COLOR2B 0
|
|
#define COLOR3R 255
|
|
#define COLOR3G 0
|
|
#define COLOR3B 0
|
|
|
|
CRGB leds[NUM_LEDS];
|
|
ShiftLightsData sd;
|
|
int maxrpm = 0;
|
|
int rpm = 0;
|
|
int numlights = NUM_LEDS;
|
|
int pin = LED_PIN;
|
|
int lights[NUM_LEDS];
|
|
|
|
|
|
void setup()
|
|
{
|
|
Serial.begin(115200);
|
|
FastLED.addLeds<WS2812, LED_PIN, GRB>(leds, NUM_LEDS);
|
|
FastLED.setMaxPowerInVoltsAndMilliamps(5, 500);
|
|
FastLED.setBrightness(BRIGHTNESS);
|
|
for (int i = 0; i < numlights; i++)
|
|
{
|
|
leds[i] = CRGB ( 0, 0, 0);
|
|
lights[i] = 0;
|
|
}
|
|
FastLED.clear();
|
|
|
|
sd.litleds = 0;
|
|
//sd.rpm = 0;
|
|
//sd.maxrpm = 6500;
|
|
}
|
|
|
|
void loop()
|
|
{
|
|
int l = 0;
|
|
int lit = sd.litleds;
|
|
char buff[SIMDATA_SIZE];
|
|
|
|
if (Serial.available() >= SIMDATA_SIZE)
|
|
{
|
|
Serial.readBytes(buff, SIMDATA_SIZE);
|
|
memcpy(&sd, &buff, SIMDATA_SIZE);
|
|
lit = sd.litleds;
|
|
}
|
|
|
|
l = 0;
|
|
FastLED.clear();
|
|
while (l < lit)
|
|
{
|
|
if (l >= numlights / 2)
|
|
{
|
|
leds[l+STARTLED-1] = CRGB ( COLOR2R, COLOR2G, COLOR2B);
|
|
}
|
|
if (l < numlights / 2)
|
|
{
|
|
leds[l+STARTLED-1] = CRGB ( COLOR1R, COLOR1G, COLOR1B);
|
|
}
|
|
if (l == numlights - 1)
|
|
{
|
|
leds[l+STARTLED-1] = CRGB ( COLOR3R, COLOR3G, COLOR3B);
|
|
}
|
|
//if (lights[l] <= 0)
|
|
//{
|
|
// leds[l] = CRGB ( 0, 0, 0);
|
|
//}
|
|
l++;
|
|
}
|
|
FastLED.show();
|
|
}
|