Added tail light animation for police mode.

QuadLightsV3.ino

@@ -7,7 +7,10 @@ constexpr int KEEPALIVE_TIMEOUT = 5000; // ms
 constexpr int LEDS_TAIL_PIN = PA6;
 constexpr int LEDS_TAIL_LENGTH = 10;
 constexpr int LEDS_TAIL_BRIGHTNESS = 255;
-constexpr int LEDS_TAIL_SIDE_LENGTH = 3;
+constexpr int LEDS_TAIL_SIDE_LENGTH = 2;
+constexpr int LEDS_TAIL_SIDE_MARGIN = 2;
+constexpr int LEDS_TAIL_RIGHT_RANGE[] = {0, LEDS_TAIL_SIDE_LENGTH};
+constexpr int LEDS_TAIL_LEFT_RANGE[] = {LEDS_TAIL_LENGTH - LEDS_TAIL_SIDE_LENGTH, LEDS_TAIL_SIDE_LENGTH};
 
 constexpr int LEDS_LEFT_PIN = PA5;
 constexpr int LEDS_RIGHT_PIN = PA7;
@@ -64,27 +67,35 @@ Adafruit_NeoPixel ledsHeadLeft(LEDS_HEAD_LENGTH, LEDS_LEFT_PIN, NEO_GRBW + NEO_K
 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_OFF = ledsTail.Color(0, 0, 0, 0);
-const uint32_t COLOR_WHITE = ledsTail.Color(0, 0, 0, 255);
-const uint32_t COLOR_WHITE_FULL = ledsTail.Color(255, 255, 255, 255);
-const uint32_t COLOR_WHITE_DIM = ledsTail.Color(0, 0, 0, 100);
-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);
-
 enum Direction { LEFT, RIGHT };
 
 enum Mode {
   MODE_HEAD,
-  MODE_POLICE,
   MODE_HAZARD,
+  MODE_POLICE,
   MODE_RAINBOW,
   MODE_COUNT,
 };
 
 // Mode activeMode = MODE_HEAD;
-Mode activeMode = MODE_HAZARD;
+Mode activeMode = MODE_RAINBOW;
+
+uint32_t colorHSV(float hue, float sat = 1.0, float val = 1.0) {
+  return Adafruit_NeoPixel::ColorHSV(
+    (uint16_t)(hue / 360.0 * 65535),
+    (uint8_t)(sat * 255),
+    (uint8_t)(val * 255)
+  );
+}
+
+const uint32_t COLOR_OFF = ledsTail.Color(0, 0, 0, 0);
+const uint32_t COLOR_WHITE = ledsTail.Color(0, 0, 0, 255);
+const uint32_t COLOR_WHITE_FULL = ledsTail.Color(255, 255, 255, 255);
+const uint32_t COLOR_WHITE_DIM = ledsTail.Color(0, 0, 0, 100);
+const uint32_t COLOR_RED = ledsTail.Color(255, 0, 0, 0);
+const uint32_t COLOR_AMBER = colorHSV(10); // easier value fade
+const uint32_t COLOR_POLICE_BLUE = ledsTail.Color(0, 0, 255, 0);
+const uint32_t COLOR_POLICE_RED = ledsTail.Color(255, 0, 0, 0);
 
 unsigned long animationFrame = 0;
 unsigned long lastFrame = 0;
@@ -153,6 +164,16 @@ void animateTailLight() {
   ledsTail.fill(COLOR_RED);
 }
 
+void animateRightTailSide(uint32_t color) {
+  ledsTail.fill(color, 0, LEDS_TAIL_SIDE_LENGTH);
+  ledsTail.fill(COLOR_OFF, LEDS_TAIL_SIDE_LENGTH, LEDS_TAIL_SIDE_MARGIN);
+}
+
+void animateLeftTailSide(uint32_t color) {
+  ledsTail.fill(color, LEDS_TAIL_LENGTH - LEDS_TAIL_SIDE_LENGTH, LEDS_TAIL_SIDE_LENGTH);
+  ledsTail.fill(COLOR_OFF, LEDS_TAIL_LENGTH - LEDS_TAIL_SIDE_LENGTH -  LEDS_TAIL_SIDE_MARGIN, LEDS_TAIL_SIDE_MARGIN);
+}
+
 void animateDash() {
   ledsDash.clear();
 }
@@ -161,28 +182,16 @@ void animateReverse() {
   ledsTail.fill(COLOR_WHITE);
 }
 
-uint32_t colorHSV(float hue, float sat = 1.0, float val = 1.0) {
-  return Adafruit_NeoPixel::ColorHSV(
-    (uint16_t)(hue / 360.0 * 65535),
-    (uint8_t)(sat * 255),
-    (uint8_t)(val * 255)
-  );
-}
-
 constexpr int INDICATOR_DURATION = 3200; // total ms
 constexpr int INDICATOR_HOLD_FRAMES = 15;
 constexpr int INDICATOR_OFF_FRAMES = 20;
 constexpr float INDICATOR_SPEED = 2;
 
 void animateIndicator(Direction direction) {
-  Adafruit_NeoPixel& ledsTarget = direction == LEFT   // reference, not pointer
+  Adafruit_NeoPixel& ledsTarget = direction == LEFT
     ? ledsHeadLeft
     : ledsHeadRight;
 
-  int dashTargetIndex = direction == LEFT
-    ? 1
-    : 0;
-
   const long indicatorFrame = lround(animationFrame * INDICATOR_SPEED) % (LEDS_EDGE_LENGTH + INDICATOR_HOLD_FRAMES + INDICATOR_OFF_FRAMES);
 
   const long sweepEnd = LEDS_TOP_LENGTH;
@@ -210,6 +219,31 @@ void animateIndicator(Direction direction) {
       ledsTarget.fill(COLOR_OFF, 0, LEDS_EDGE_LENGTH);
     }
   }
+
+  const int* tailRange = direction == LEFT
+    ? LEDS_TAIL_LEFT_RANGE
+    : LEDS_TAIL_RIGHT_RANGE;
+
+  void (*animateTailSide)(uint32_t) = direction == LEFT
+    ? animateLeftTailSide
+    : animateRightTailSide;
+
+  const int dashIndex = direction == LEFT
+    ? 1
+    : 0;
+
+  if (indicatorFrame < sweepEnd) {
+    const int colorAmberFaded = colorHSV(10, 1, (float)indicatorFrame / sweepEnd);
+
+    animateTailSide(colorAmberFaded);
+    ledsDash.setPixelColor(dashIndex, colorAmberFaded);
+  } else if (indicatorFrame < holdEnd) {
+    animateTailSide(COLOR_AMBER);
+    ledsDash.setPixelColor(dashIndex, COLOR_AMBER);
+  } else {
+    animateTailSide(COLOR_OFF);
+    ledsDash.setPixelColor(dashIndex, COLOR_OFF);
+  }
 }
 
 constexpr float POLICE_SPEED = 0.75;
@@ -238,18 +272,28 @@ void animatePolice() {
     ledsHeadLeft.fill(COLOR_POLICE_BLUE, 0, LEDS_EDGE_LENGTH);
     ledsHeadRight.fill(COLOR_OFF, 0, LEDS_EDGE_LENGTH);
 
+    // deliberately inverted from edge lights for a more alternating effect
+    animateLeftTailSide(COLOR_OFF);
+    animateRightTailSide(COLOR_POLICE_BLUE);
+
     ledsDash.setPixelColor(1, COLOR_POLICE_BLUE);
     ledsDash.setPixelColor(0, COLOR_OFF);
   } else if (policeBeaconFrames[policeFrame] == POLICE_RIGHT) {
     ledsHeadLeft.fill(COLOR_OFF, 0, LEDS_EDGE_LENGTH);
     ledsHeadRight.fill(COLOR_POLICE_BLUE, 0, LEDS_EDGE_LENGTH);
 
+    animateLeftTailSide(COLOR_POLICE_BLUE);
+    animateRightTailSide(COLOR_OFF);
+
     ledsDash.setPixelColor(1, COLOR_OFF);
     ledsDash.setPixelColor(0, COLOR_POLICE_BLUE);
   } else {
     ledsHeadLeft.fill(COLOR_OFF, 0, LEDS_EDGE_LENGTH);
     ledsHeadRight.fill(COLOR_OFF, 0, LEDS_EDGE_LENGTH);
 
+    animateLeftTailSide(COLOR_OFF);
+    animateRightTailSide(COLOR_OFF);
+
     ledsDash.setPixelColor(1, COLOR_OFF);
     ledsDash.setPixelColor(0, COLOR_OFF);
   }
@@ -286,7 +330,7 @@ void animateRainbow() {
   }
   */
 
-  ledsTail.fill(ledsTail.ColorHSV(animationFrame * 1000 * RAINBOW_SPEED));
+  ledsTail.fill(colorHSV(animationFrame * RAINBOW_SPEED));
 
   ledsDash.setPixelColor(1, colorHSV(animationFrame * RAINBOW_SPEED));
   ledsDash.setPixelColor(0, colorHSV(animationFrame * RAINBOW_SPEED + 90));