diff options
-rw-r--r-- | demokit/demokit.pde | 13 |
1 files changed, 12 insertions, 1 deletions
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 @@ void init_buttons() 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_leds() 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 @@ void setup() b1 = digitalRead(BUTTON1); b2 = digitalRead(BUTTON2); b3 = digitalRead(BUTTON3); + b4 = digitalRead(JOY_SWITCH); c = 0; acc.powerOn(); @@ -214,6 +217,14 @@ void loop() 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: |