implement joystick button
Change-Id: Icfe58675a0a69dd9d13dab7a7dd35881ae638321
diff --git a/demokit/demokit.pde b/demokit/demokit.pde
index f5e0fc5..6f70e4c 100644
--- a/demokit/demokit.pde
+++ b/demokit/demokit.pde
@@ -58,10 +58,12 @@
pinMode( BUTTON1, INPUT );
pinMode( BUTTON2, INPUT );
pinMode( BUTTON3, INPUT );
+ pinMode( JOY_SWITCH, INPUT );
digitalWrite( BUTTON1, HIGH ); // enable the internal pullups
digitalWrite( BUTTON2, HIGH );
digitalWrite( BUTTON3, HIGH );
+ digitalWrite( JOY_SWITCH, HIGH );
}
@@ -101,7 +103,7 @@
void init_joystick( int threshold );
-byte b1, b2, b3, c;
+byte b1, b2, b3, b4, c;
void setup()
{
Serial.begin( 115200 );
@@ -125,6 +127,7 @@
b1 = digitalRead(BUTTON1);
b2 = digitalRead(BUTTON2);
b3 = digitalRead(BUTTON3);
+ b4 = digitalRead(JOY_SWITCH);
c = 0;
acc.powerOn();
@@ -214,6 +217,14 @@
b3 = b;
}
+ b = digitalRead(JOY_SWITCH);
+ if (b != b4) {
+ msg[1] = 4;
+ msg[2] = b ? 0 : 1;
+ acc.write(msg, 3);
+ b4 = b;
+ }
+
switch (count++ % 0x10) {
case 0: