131 lines
3.0 KiB
C++
131 lines
3.0 KiB
C++
/***************************************************************
|
|
* *
|
|
* Taiko Sanro - Arduino *
|
|
* Support Arduino models with ATmega32u4 microprocessors *
|
|
* *
|
|
* Shiky Chang *
|
|
* zhangxunpx@gmail.com *
|
|
* *
|
|
***************************************************************/
|
|
|
|
#define MODE_JIRO 1
|
|
#define MODE_DEBUG 1
|
|
|
|
#define CHANNELS 4
|
|
|
|
#define SAMPLE_CACHE_LENGTH 50
|
|
#define POWER_CACHE_LENGTH 3
|
|
|
|
#define LIGHT_THRES 0
|
|
#define HEAVY_THRES 70000
|
|
|
|
#include <Keyboard.h>
|
|
#include "cache.h"
|
|
#include "limits.h"
|
|
|
|
#if MODE_JIRO
|
|
#define HEAVY_THRES LONG_MAX
|
|
#endif
|
|
|
|
int channelSample [CHANNELS];
|
|
int lastChannelSample [CHANNELS];
|
|
Cache <int, SAMPLE_CACHE_LENGTH> sampleCache [CHANNELS];
|
|
|
|
long int power [CHANNELS];
|
|
Cache <long int, POWER_CACHE_LENGTH> powerCache [CHANNELS];
|
|
|
|
bool triggered [CHANNELS];
|
|
|
|
int pins[] = { A0, A1, A2, A3 }; // L don, R don, L kat, R kat
|
|
char lightKeys[] = { 'g', 'h', 'f', 'j' };
|
|
char heavyKeys[] = { 't', 'y', 'r', 'u' };
|
|
|
|
void setup() {
|
|
Serial.begin (9600);
|
|
Keyboard.begin ();
|
|
analogReference (DEFAULT);
|
|
for (short int i = 0; i < CHANNELS; i++) {
|
|
power [i] = 0;
|
|
lastChannelSample [i] = 0;
|
|
triggered [i] = false;
|
|
}
|
|
}
|
|
|
|
void loop() {
|
|
|
|
#if MODE_DEBUG
|
|
long int sampleLastTime = 0;
|
|
long int calcLastTime = 0;
|
|
#endif
|
|
|
|
for (short int i = 0; i < CHANNELS; i++) {
|
|
|
|
#if MODE_DEBUG
|
|
long int lastTime = micros();
|
|
#endif
|
|
|
|
channelSample[i] = analogRead (pins[i]);
|
|
|
|
#if MODE_DEBUG
|
|
sampleLastTime += micros () - lastTime;
|
|
lastTime = micros();
|
|
#endif
|
|
|
|
sampleCache [i].put (channelSample [i] - lastChannelSample [i]);
|
|
|
|
long int tempInt;
|
|
tempInt = sampleCache [i].get (1);
|
|
power [i] -= tempInt * tempInt;
|
|
tempInt = sampleCache [i].get ();
|
|
power [i] += tempInt * tempInt;
|
|
|
|
if (power [i] < LIGHT_THRES) {
|
|
power [i] = 0;
|
|
}
|
|
|
|
powerCache [i].put (power [i]);
|
|
lastChannelSample [i] = channelSample [i];
|
|
|
|
if (powerCache [i].get (1) == 0) {
|
|
triggered [i] = false;
|
|
}
|
|
|
|
bool isDescending = true;
|
|
for (short int j = 0; j < POWER_CACHE_LENGTH - 1; j++){
|
|
if (!triggered [i] && (powerCache [i].get (j - 1) > powerCache [i].get (j))) {
|
|
isDescending = false;
|
|
break;
|
|
}
|
|
}
|
|
if (isDescending) {
|
|
if (power [i] >= HEAVY_THRES) {
|
|
triggered [i] = true;
|
|
Keyboard.print (heavyKeys [i]);
|
|
} else if (power [i] >= LIGHT_THRES) {
|
|
triggered [i] = true;
|
|
Keyboard.print (lightKeys [i]);
|
|
}
|
|
|
|
#if MODE_DEBUG
|
|
calcLastTime += micros () - lastTime;
|
|
#endif
|
|
}
|
|
|
|
#if MODE_DEBUG
|
|
Serial.print (power [i]);
|
|
Serial.print ("\t");
|
|
#endif
|
|
|
|
// End of each channel
|
|
}
|
|
|
|
#if MODE_DEBUG
|
|
Serial.print(sampleLastTime);
|
|
Serial.print('\t');
|
|
Serial.print(calcLastTime);
|
|
Serial.println ("");
|
|
#endif
|
|
|
|
}
|
|
|