Added dash indicator ouputs.

This commit is contained in:
ThePendulum
2026-04-28 06:07:16 +02:00
parent 5c5e9c2dc9
commit f6a6723f06

View File

@@ -1,42 +1,50 @@
#include <Button.h> #include <Button.h>
#include <Adafruit_NeoPixel.h> #include <Adafruit_NeoPixel.h>
const bool KEEPALIVE_ENABLE = false; constexpr bool KEEPALIVE_ENABLE = false;
const int KEEPALIVE_TIMEOUT = 5000; // ms constexpr int KEEPALIVE_TIMEOUT = 5000; // ms
const int LEDS_TAIL_PIN = PA6; constexpr int LEDS_TAIL_PIN = PA6;
const int LEDS_TAIL_LENGTH = 10; constexpr int LEDS_TAIL_LENGTH = 10;
const int LEDS_TAIL_BRIGHTNESS = 255; constexpr int LEDS_TAIL_BRIGHTNESS = 255;
const int LEDS_TOP_LENGTH = 11; constexpr int LEDS_LEFT_PIN = PA5;
const int LEDS_SIDE_LENGTH = 2; constexpr int LEDS_RIGHT_PIN = PA7;
const int LEDS_BOTTOM_LENGTH = 10;
const int LEDS_RING_LENGTH = 16;
const int LEDS_HEAD_LENGTH = LEDS_TOP_LENGTH + LEDS_SIDE_LENGTH + LEDS_BOTTOM_LENGTH + LEDS_RING_LENGTH;
const int LEDS_HEAD_BRIGHTNESS = 100;
const int LEDS_LEFT_PIN = PA5; constexpr int LEDS_TOP_LENGTH = 11;
const int LEDS_RIGHT_PIN = PA7; constexpr int LEDS_SIDE_LENGTH = 2;
constexpr int LEDS_BOTTOM_LENGTH = 10;
constexpr int LEDS_RING_LENGTH = 16;
constexpr int LEDS_EDGE_LENGTH = LEDS_TOP_LENGTH + LEDS_SIDE_LENGTH + LEDS_BOTTOM_LENGTH;
constexpr int LEDS_HEAD_LENGTH = LEDS_TOP_LENGTH + LEDS_SIDE_LENGTH + LEDS_BOTTOM_LENGTH + LEDS_RING_LENGTH;
constexpr int LEDS_HEAD_BRIGHTNESS = 100;
const int PIN_ALIVE = PA2; constexpr int LEDS_DASH_PIN = PB0;
const int PIN_BUCK = PA1; constexpr int LEDS_DASH_LENGTH = 10;
constexpr int LEDS_DASH_BRIGHTNESS = 255;
const int PIN_PEDAL = PA0; constexpr int PIN_ALIVE = PA2;
const int PIN_PEDAL_FORWARD = PA3; constexpr int PIN_BUCK = PA1;
const int PIN_PEDAL_REVERSE = PA4;
const int PIN_BUTTON_MODE = PB8; constexpr int PIN_PEDAL = PA0;
const int PIN_BUTTON_RIGHT = PB7; constexpr int PIN_PEDAL_FORWARD = PA3;
const int PIN_BUTTON_LEFT = PB9; constexpr int PIN_PEDAL_REVERSE = PA4;
const int LED_ON = LOW; constexpr int PIN_BUTTON_MODE = PB8;
const int LED_OFF = HIGH; constexpr int PIN_BUTTON_LEFT = PB7;
constexpr int PIN_BUTTON_RIGHT = PB9;
const int PEDAL_ON = HIGH; constexpr int LED_ON = LOW;
const int PEDAL_OFF = LOW; constexpr int LED_OFF = HIGH;
const int BUCK_ON = HIGH; constexpr int PEDAL_ON = HIGH;
const int BUCK_OFF = LOW; constexpr int PEDAL_OFF = LOW;
constexpr int BUCK_ON = HIGH;
constexpr int BUCK_OFF = LOW;
constexpr int ANIMATION_FPS = 30;
constexpr int ANIMATION_INTERVAL = lround(1000 / ANIMATION_FPS);
Button pedal(PIN_PEDAL); Button pedal(PIN_PEDAL);
Button pedalForward(PIN_PEDAL_FORWARD); Button pedalForward(PIN_PEDAL_FORWARD);
@@ -49,6 +57,13 @@ Button buttonRight(PIN_BUTTON_RIGHT);
Adafruit_NeoPixel ledsTail(LEDS_TAIL_LENGTH, LEDS_TAIL_PIN, NEO_GRBW + NEO_KHZ800); Adafruit_NeoPixel ledsTail(LEDS_TAIL_LENGTH, LEDS_TAIL_PIN, NEO_GRBW + NEO_KHZ800);
Adafruit_NeoPixel ledsHeadLeft(LEDS_HEAD_LENGTH, LEDS_LEFT_PIN, NEO_GRBW + NEO_KHZ800); Adafruit_NeoPixel ledsHeadLeft(LEDS_HEAD_LENGTH, LEDS_LEFT_PIN, NEO_GRBW + NEO_KHZ800);
Adafruit_NeoPixel ledsHeadRight(LEDS_HEAD_LENGTH, LEDS_RIGHT_PIN, NEO_GRBW + NEO_KHZ800); Adafruit_NeoPixel ledsHeadRight(LEDS_HEAD_LENGTH, LEDS_RIGHT_PIN, NEO_GRBW + NEO_KHZ800);
Adafruit_NeoPixel ledsDash(LEDS_DASH_LENGTH, LEDS_DASH_PIN, NEO_GRBW + NEO_KHZ800);
const uint32_t COLOR_WHITE = ledsTail.Color(0, 0, 0, 255);
const uint32_t COLOR_RED = ledsTail.Color(255, 0, 0, 0);
const uint32_t COLOR_AMBER = ledsTail.Color(255, 50, 0, 0);
const uint32_t COLOR_POLICE_BLUE = ledsTail.Color(0, 0, 255, 0);
const uint32_t COLOR_POLICE_RED = ledsTail.Color(255, 0, 0, 0);
void setup() { void setup() {
// initialize digital pin LED_BUILTIN as an output. // initialize digital pin LED_BUILTIN as an output.
@@ -72,10 +87,12 @@ void setup() {
ledsTail.setBrightness(LEDS_TAIL_BRIGHTNESS); ledsTail.setBrightness(LEDS_TAIL_BRIGHTNESS);
ledsHeadLeft.setBrightness(LEDS_HEAD_BRIGHTNESS); ledsHeadLeft.setBrightness(LEDS_HEAD_BRIGHTNESS);
ledsHeadRight.setBrightness(LEDS_HEAD_BRIGHTNESS); ledsHeadRight.setBrightness(LEDS_HEAD_BRIGHTNESS);
ledsDash.setBrightness(LEDS_DASH_BRIGHTNESS);
ledsTail.begin(); ledsTail.begin();
ledsHeadLeft.begin(); ledsHeadLeft.begin();
ledsHeadRight.begin(); ledsHeadRight.begin();
ledsDash.begin();
pedal.begin(); pedal.begin();
pedalForward.begin(); pedalForward.begin();
@@ -86,20 +103,49 @@ void setup() {
buttonRight.begin(); buttonRight.begin();
Serial.begin(9600); Serial.begin(9600);
ledsTail.clear();
ledsHeadLeft.clear();
ledsHeadRight.clear();
ledsDash.clear();
} }
bool isOff = false; enum Mode {
bool isLedOn = false; MODE_HEAD,
bool isBuckOn = false; MODE_POLICE,
MODE_HAZARD,
MODE_RAINBOW,
MODE_COUNT,
};
long lastPedalPress = millis(); Mode activeMode = MODE_HEAD;
// the loop function runs over and over again forever unsigned long animationFrame = 0;
void loop() { unsigned long lastFrame = 0;
const long now = millis();
// ledsTail.clear(); void animateHeadlights() {
ledsHeadLeft.fill(COLOR_WHITE);
ledsHeadRight.fill(COLOR_WHITE);
ledsDash.fill(ledsDash.Color(0, 255, 0, 0));
}
void animateIndicator(Adafruit_NeoPixel& ledsTarget) {
Serial.println("ANIMATING INDICATOR");
for (int ledIndex = LEDS_EDGE_LENGTH; ledIndex < LEDS_EDGE_LENGTH + LEDS_RING_LENGTH; ledIndex += 1) {
ledsTarget.setPixelColor(ledIndex, COLOR_AMBER);
}
}
unsigned long lastPedalPress = millis();
unsigned long lastIndicatingLeft = 0;
unsigned long lastIndicatingRight = 0;
bool isIndicatingLeft = false;
bool isIndicatingRight = false;
void animate(long now) {
if (pedalForward.read() == Button::PRESSED) { if (pedalForward.read() == Button::PRESSED) {
ledsTail.fill(ledsTail.Color(255, 0, 0, 0)); ledsTail.fill(ledsTail.Color(255, 0, 0, 0));
lastPedalPress = now; lastPedalPress = now;
@@ -114,56 +160,58 @@ void loop() {
ledsTail.fill(ledsTail.Color(100, 0, 0, 0)); ledsTail.fill(ledsTail.Color(100, 0, 0, 0));
} }
ledsHeadLeft.fill(ledsHeadLeft.Color(0, 0, 0, 255)); // always animate headlights, let other modes override
ledsHeadRight.fill(ledsHeadRight.Color(0, 0, 0, 255)); animateHeadlights();
// we need the boolean to prevent the indicators from turning on right after boot
if (isIndicatingLeft && animationFrame - lastIndicatingLeft < 100) {
animateIndicator(ledsHeadLeft);
}
if (isIndicatingRight && animationFrame - lastIndicatingRight < 100) {
animateIndicator(ledsHeadRight);
}
}
// the loop function runs over and over again forever
void loop() {
const unsigned long now = millis();
if (buttonMode.pressed()) { if (buttonMode.pressed()) {
ledsTail.fill(ledsTail.Color(0, 0, 255, 0)); ledsTail.fill(ledsTail.Color(0, 0, 255, 0));
Serial.println("BUTTON MODE"); activeMode = (Mode)((activeMode + 1) % MODE_COUNT);
Serial.print("BUTTON MODE ");
Serial.println(activeMode);
} }
if (buttonLeft.pressed()) { if (buttonLeft.pressed()) {
ledsTail.fill(ledsTail.Color(0, 255, 255, 0)); isIndicatingLeft = true;
lastIndicatingLeft = animationFrame;
Serial.println("BUTTON LEFT"); Serial.println("BUTTON LEFT");
} }
if (buttonRight.pressed()) { if (buttonRight.pressed()) {
ledsTail.fill(ledsTail.Color(255, 0, 255, 0)); isIndicatingRight = true;
lastIndicatingRight = animationFrame;
Serial.println("BUTTON RIGHT"); Serial.println("BUTTON RIGHT");
} }
ledsTail.show(); if (now - lastFrame >= ANIMATION_INTERVAL) {
ledsHeadLeft.show(); lastFrame += ANIMATION_INTERVAL;
ledsHeadRight.show(); animationFrame += 1;
delay(100); animate(now);
/* ledsTail.show();
if (pedal.read() == Button::PRESSED) { ledsHeadLeft.show();
digitalWrite(LED_BUILTIN, LED_ON); ledsHeadRight.show();
lastPedalPress = now; ledsDash.show();
} else {
digitalWrite(LED_BUILTIN, LED_OFF);
} }
if ((now - lastPedalPress > 2000) && (now - lastPedalPress <= 4000) && !isBuckOn) {
digitalWrite(PIN_BUCK, BUCK_ON);
Serial.println("BUCK ON");
isBuckOn = true;
}
if ((now - lastPedalPress > 4000) && isBuckOn) {
digitalWrite(PIN_BUCK, BUCK_OFF);
Serial.println("BUCK OFF");
isBuckOn = false;
}
*/
if (KEEPALIVE_ENABLE && now - lastPedalPress > KEEPALIVE_TIMEOUT) { if (KEEPALIVE_ENABLE && now - lastPedalPress > KEEPALIVE_TIMEOUT) {
// digitalWrite(PIN_BUCK, BUCK_OFF); // digitalWrite(PIN_BUCK, BUCK_OFF);
Serial.println("SHUTTING DOWN"); Serial.println("SHUTTING DOWN");