Add proximity

puzzle_box.ino

@@ -1,17 +1,21 @@
-#include <SPI.h>
 #include <Adafruit_GFX.h>
 #include <Adafruit_PCD8544.h>
-#include <Fonts/FreeSerif9pt7b.h>
 #include <FastLED.h>
+#include <Fonts/FreeSerif9pt7b.h>
+#include <SPI.h>
 #include "morse.h"
+#include "musicplayer.h"
+#include "paj7620.h"
 #include "pulse.h"
 #include "riddler.h"
-#include "musicplayer.h"
+
+#define NUM_PUZZLES 6
 
 // WS2812 LEDs
 #define LEDS_PIN 1
-#define NUM_LEDS 2
+#define NUM_LEDS NUM_PUZZLES
 CRGB leds[NUM_LEDS];
+CHSV ColorSolved = CHSV(32, 200, 40);
 
 // Laser
 #define LASER_PIN 0
@@ -37,6 +41,7 @@ Adafruit_PCD8544 display = Adafruit_PCD8544(DISPLAY_DC, DISPLAY_SCE, DISPLAY_RST
 
 void setup() {
   FastLED.addLeds<WS2812, LEDS_PIN, GRB>(leds, NUM_LEDS);
+  FastLED.setBrightness(96);
 
   // Turn on backlight
   pinMode(DISPLAY_LED, OUTPUT);
@@ -45,21 +50,30 @@ void setup() {
   // Turn on display
   display.begin();
   display.setContrast(50);
+
+  // Gesture sensor
+  while (paj7620Init()) {
     display.clearDisplay();
-  display.drawBitmap(
+    display.print("PAJ7260?");
-    (DISPLAY_WIDTH - riddler_width)/2, 
-    (DISPLAY_HEIGHT - riddler_height)/2, 
-    riddler_bits, 
-    riddler_width, 
-    riddler_height, 
-    0xffff
-  );
     display.display();
+  }
 
   pinMode(LASER_PIN, OUTPUT);
   pinMode(PHOTO_PIN, INPUT);
 
-  mp.Play(120*4, TUNE_BOO);
+  // Riddler symbol
+  display.clearDisplay();
+  display.drawBitmap(
+      (DISPLAY_WIDTH - riddler_width) / 2,
+      (DISPLAY_HEIGHT - riddler_height) / 2,
+      riddler_bits,
+      riddler_width,
+      riddler_height,
+      0xffff);
+  display.display();
+
+  // Hello!
+  mp.Play(120 * 4, TUNE_YAY);
 }
 
 CHSV loop_morse(bool fg) {
@@ -72,15 +86,15 @@ CHSV loop_morse(bool fg) {
   CHSV color;
 
   if (solved) {
-    color = CHSV(128, 40, 64);
+    return ColorSolved;
   } else if (error) {
     ++errors;
-    color = CHSV(0, 255, recv>>2);
+    color = CHSV(0, 255, recv >> 2);
   } else {
-    color = CHSV(128, 255, recv>>2);
+    color = CHSV(128, 255, recv >> 2);
   }
 
-  if (! pulse.Tick()) {
+  if (!pulse.Tick()) {
     return color;
   }
 
@@ -103,11 +117,72 @@ CHSV loop_morse(bool fg) {
     enc.Quiet(30);
     errors = 0;
   }
+
+  return color;
+}
+
+CHSV loop_konami(bool fg) {
+  static Pulse pulse = Pulse(100);
+  CHSV color;
+  uint8_t gesture;
+
+  uint8_t prox = 0;
+  if (!paj7620ReadReg(0x6c, 1, &prox)) {
+    display.fillRect(0, 0, 84, 4, 0);
+    display.fillRect(0, 0, min(prox / 3, 84), 4, 1);
+  }
+
+  color = CHSV(0, 255, prox);
+
+  if (!pulse.Tick()) {
+    return color;
+  }
+
+  if (!paj7620ReadReg(0x43, 1, &gesture)) {
+    char out = 0;
+
+    switch (gesture) {
+      case 0:
+        break;
+      case GES_UP_FLAG:
+        out = 26;  // right
+        break;
+      case GES_DOWN_FLAG:
+        out = 27;  // left
+        break;
+      case GES_RIGHT_FLAG:
+        out = 25;  // down
+        break;
+      case GES_LEFT_FLAG:
+        out = 24;  // up
+        break;
+      case GES_FORWARD_FLAG:
+        out = 15;
+        break;
+      case GES_BACKWARD_FLAG:
+        out = 9;
+        break;
+      default:
+        out = '?';
+        display.fillRect(0, 32, 15, 8, 0);
+        display.setCursor(0, 32);
+        display.print(gesture);
+        break;
+    }
+    if (out) {
+      display.fillRect(0, 40, 5, 8, 0);
+      display.setCursor(0, 40);
+      display.print(out);
+    }
+  }
+  display.display();
+
+  return color;
 }
 
 void beHappy() {
   if (!mp.KeepPlaying()) {
-    mp.Play(80*4, TUNE_JINGLEBELLS);
+    mp.Play(76 * 4, TUNE_JINGLEBELLS);
 
     display.clearDisplay();
     display.setFont(&FreeSerif9pt7b);
@@ -122,9 +197,41 @@ void beHappy() {
 }
 
 void loop() {
-  leds[0] = loop_morse(true);
+  static int current = -1;
+  static bool solved[NUM_PUZZLES] = {0};
+  static CHSV lastColors[NUM_PUZZLES];
+  bool writeLEDs = false;
+  bool allSolved = true;
 
+  mp.KeepPlaying();
+
+  for (int i = 0; i < NUM_PUZZLES; ++i) {
+    CHSV color = CHSV(0, 0, 0);
+    bool fg = (current == i);
+
+    switch (i) {
+      case 0:
+        color = loop_morse(fg);
+        break;
+      case 1:
+        color = loop_konami(fg);
+        break;
+    }
+    if (color != lastColors[i]) {
+      lastColors[i] = color;
+      writeLEDs = true;
+    }
+    if (color != ColorSolved) {
+      allSolved = false;
+    }
+    leds[i] = color;
+  }
+
+  if (allSolved) {
     beHappy();
+  }
 
+  if (writeLEDs) {
     FastLED.show();
+  }
 }