Merge "implement joystick button" into gingerbread
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: