94 lines
1.5 KiB
Arduino
94 lines
1.5 KiB
Arduino
#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++;
|
|
}
|
|
}
|