From 5f30ec894fbf9b48965964d72b0d2795f91e9072 Mon Sep 17 00:00:00 2001
From: Neale Pickett <neale@woozle.org>
Date: Tue, 8 Dec 2020 21:56:47 -0700
Subject: [PATCH] Completed Konami puzzle!

---
 puzzle_box.ino | 59 ++++++++++++++++++++++++++++++++++++++++----------
 1 file changed, 47 insertions(+), 12 deletions(-)

diff --git a/puzzle_box.ino b/puzzle_box.ino
index 9933fa5..e298989 100644
--- a/puzzle_box.ino
+++ b/puzzle_box.ino
@@ -121,11 +121,36 @@ CHSV loop_morse(bool fg) {
   return color;
 }
 
+#define UP 24
+#define DOWN 25
+#define RIGHT 26
+#define LEFT 27
+#define IN 15
+#define OUT 9
+const char KonamiCode[] = {
+    UP,
+    UP,
+    DOWN,
+    DOWN,
+    LEFT,
+    RIGHT,
+    LEFT,
+    RIGHT,
+    IN,
+    OUT,
+    0,
+};
 CHSV loop_konami(bool fg) {
+  static bool solved = false;
+  static int pos = 0;
   static Pulse pulse = Pulse(100);
   CHSV color;
   uint8_t gesture;
 
+  if (solved) {
+    return ColorSolved;
+  }
+
   uint8_t prox = 0;
   if (!paj7620ReadReg(0x6c, 1, &prox)) {
     display.fillRect(0, 0, 84, 4, 0);
@@ -145,36 +170,46 @@ CHSV loop_konami(bool fg) {
       case 0:
         break;
       case GES_UP_FLAG:
-        out = 26;  // right
+        out = RIGHT;
         break;
       case GES_DOWN_FLAG:
-        out = 27;  // left
+        out = LEFT;
         break;
       case GES_RIGHT_FLAG:
-        out = 25;  // down
+        out = DOWN;
         break;
       case GES_LEFT_FLAG:
-        out = 24;  // up
+        out = UP;
         break;
       case GES_FORWARD_FLAG:
-        out = 15;
+        out = IN;
         break;
       case GES_BACKWARD_FLAG:
-        out = 9;
+        out = OUT;
         break;
       default:
-        out = '?';
-        display.fillRect(0, 32, 15, 8, 0);
-        display.setCursor(0, 32);
-        display.print(gesture);
+        // out = '?';
         break;
     }
     if (out) {
-      display.fillRect(0, 40, 5, 8, 0);
-      display.setCursor(0, 40);
+      if (out == KonamiCode[pos]) {
+        display.fillRect(pos*6, 40, 6, 8, 0);
+        display.setCursor(pos * 6, 40);
+        ++pos;
+      } else {
+        display.fillRect(0, 40, 84, 8, 0);
+        display.setCursor(0, 40);
+        pos = 0;
+      }
       display.print(out);
     }
   }
+
+  if (KonamiCode[pos] == 0) {
+    solved = true;
+    mp.Play(120 * 4, TUNE_YAY);
+    color = ColorSolved;
+  }
   display.display();
 
   return color;