From 61e729ff1d7aa555e14deb9113c2babe0bd1fdfd Mon Sep 17 00:00:00 2001
From: ShikyC <zhangxunpx@gmail.com>
Date: Thu, 24 Mar 2016 20:39:50 +0800
Subject: [PATCH] Added files via upload

---
 sanro/sanro.ino | 148 ++++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 148 insertions(+)
 create mode 100644 sanro/sanro.ino

diff --git a/sanro/sanro.ino b/sanro/sanro.ino
new file mode 100644
index 0000000..fad6fea
--- /dev/null
+++ b/sanro/sanro.ino
@@ -0,0 +1,148 @@
+/***************************************************************
+ *                                                             *
+ *                Taiko Sanro - Arduino                        *
+ *   Support Arduino models with ATmega32u4 microprocessors    *
+ *                                                             *
+ *             Copyright © 2016 Shiky Chang                    *
+ *                zhangxunpx@gmail.com                         *
+ *                                                             *
+ ***************************************************************/
+
+#define MODE_JIRO 1
+
+#define CHANNELS 4
+
+// Input delay ~ (SAMPLE_CACHE_LENGTH + POWER_CACHE_LENGTH) / sample frequency
+// _CACHE_LENGTH must be less than 256
+#define SAMPLE_CACHE_LENGTH 150
+#define POWER_CACHE_LENGTH 3
+
+// _THRES must be less than 2^32 = 4294967296 = 4.29e9
+#define LIGHT_THRES 3000000
+#define HEAVY_THRES 10000000
+
+#include <Keyboard.h>
+
+int channelSample [CHANNELS];
+int sampleCache [CHANNELS][SAMPLE_CACHE_LENGTH];
+short int sampleCacheIndex [CHANNELS];
+
+long int power [CHANNELS];
+long int powerCache [CHANNELS][POWER_CACHE_LENGTH];
+short int powerCacheIndex [CHANNELS];
+
+bool triggered [CHANNELS];
+
+void setup() {
+  Serial.begin (9600);
+  Keyboard.begin ();
+  analogReference (DEFAULT);
+  for (short int i = 0; i < CHANNELS; i++) {
+    for (short int j = 0; j < SAMPLE_CACHE_LENGTH; j++) {
+      sampleCache [i][j] = 0;
+    }
+    sampleCacheIndex [i] = SAMPLE_CACHE_LENGTH - 1; 
+    for (short int j = 0; j < POWER_CACHE_LENGTH; j++) {
+      powerCache [i][j] = 0;
+    }
+    powerCacheIndex [i] = POWER_CACHE_LENGTH - 1; 
+    power [i] = 0;
+    triggered [i] = false;
+  }
+}
+
+void loop() {
+
+// Analog input: 0~5V -> 0~1023
+  channelSample[0] = analogRead (A0);  // L don
+  channelSample[1] = analogRead (A1);  // R don
+  channelSample[2] = analogRead (A2);  // L kat
+  channelSample[3] = analogRead (A3);  // R kat
+
+// Cache Operation
+//
+// Init status:   [ 0 ] [ 1 ] [ 2 ] ... [n-3] [n-2] [n-1]
+//                                                    |
+//                                                 Pointer
+//---------------------------------------------------------------
+//      Loop 0:   [NEW] [ 1 ] [ 2 ] ... [n-3] [NEW] [n-1]
+//                  |                           |
+//               Pointer                    Newest Diff
+//---------------------------------------------------------------
+//      Loop 1:   [ 0 ] [NEW] [ 2 ] ... [n-3] [n-2] [NEW]
+//                  |     |                           |
+//         Last sample  Pointer                  Newest Diff
+//---------------------------------------------------------------
+// 
+// ...
+// Pointer + 1: oldest differentiated sample
+// Pointer    : newest sample (original value from the analog port)    <----
+// Pointer - 1: last sample (original value from the analog port)
+// Pointer - 2: newest differentiated sample
+// Pointer - 3: last differentiated sample
+// ...
+
+  for (short int i = 0; i < CHANNELS; i++) {
+
+    sampleCacheIndex [i] = (sampleCacheIndex [i] + 1) % SAMPLE_CACHE_LENGTH;
+
+    sampleCache [i][sampleCacheIndex [i]] = channelSample [i];
+    sampleCache [i][(sampleCacheIndex [i] - 2) % SAMPLE_CACHE_LENGTH] = channelSample [i] - sampleCache [i][(sampleCacheIndex [i] - 1) % SAMPLE_CACHE_LENGTH];
+    
+    long int tempInt;
+    tempInt = sampleCache [i][(sampleCacheIndex [i] + 1) % SAMPLE_CACHE_LENGTH];
+    power [i] -= tempInt * tempInt;
+    tempInt = sampleCache [i][(sampleCacheIndex [i] - 2) % SAMPLE_CACHE_LENGTH];
+    power [i] += tempInt * tempInt;
+        
+    if (power [i] < LIGHT_THRES) {
+      power [i] = 0;
+    }
+    
+    powerCacheIndex [i] = (powerCacheIndex [i] + 1 ) % POWER_CACHE_LENGTH;
+    powerCache [i][powerCacheIndex [i]] = power [i];
+
+    for (short int j = 0; j < POWER_CACHE_LENGTH - 1; j++){
+      if (!triggered) {
+        if (powerCache [i][(powerCacheIndex [i] + j) % POWER_CACHE_LENGTH] > powerCache [i][(powerCacheIndex [i] + j - 1) % POWER_CACHE_LENGTH] || j != POWER_CACHE_LENGTH - 2) {
+          break;
+        } else {
+#if MODE_JIRO
+          if (power [i] >= LIGHT_THRES) {
+            triggered [i] = true;
+            switch (i) {
+              case 0: Keyboard.print ('g'); break;
+              case 1: Keyboard.print ('h'); break;
+              case 2: Keyboard.print ('f'); break;
+              case 3: Keyboard.print ('j'); break;
+            }
+          }
+#else
+          if (power [i] >= HEAVY_THRES) {
+            triggered [i] = true;
+            switch (i) {
+              case 0: Keyboard.print ('t'); break;
+              case 1: Keyboard.print ('y'); break;
+              case 2: Keyboard.print ('r'); break;
+              case 3: Keyboard.print ('u'); break;
+            }
+          } else if (power [i] >= LIGHT_THRES) {
+            triggered [i] = true;
+            switch (i) {
+              case 0: Keyboard.print ('g'); break;
+              case 1: Keyboard.print ('h'); break;
+              case 2: Keyboard.print ('f'); break;
+              case 3: Keyboard.print ('j'); break;
+            }
+          }
+#endif
+        }
+      }
+    }
+
+// This is the end of each channel
+  }
+  
+  delay (1);
+}
+