[136] | 1 | #include <Arduino.h>
|
---|
| 2 | #include <Wire.h>
|
---|
| 3 |
|
---|
| 4 | uint8_t accx,accy,zbut,cbut ;
|
---|
| 5 |
|
---|
| 6 | void setup()
|
---|
| 7 | {
|
---|
| 8 | Serial5.begin( 115200 ) ;
|
---|
| 9 | Serial5.println("nunchuk init");
|
---|
| 10 |
|
---|
| 11 | Wire.begin(); // join i2c bus as master
|
---|
| 12 | Wire.beginTransmission(0x52);// transmit to device 0x52
|
---|
| 13 | Wire.write((uint8_t)0xF0);// sends sent a zero.
|
---|
| 14 | Wire.write((uint8_t)0x55);// sends sent a zero.
|
---|
| 15 | Wire.write((uint8_t)0xFB);// sends sent a zero.
|
---|
| 16 | Wire.write((uint8_t)0x00);// sends sent a zero.
|
---|
| 17 | Wire.endTransmission();// stop transmitting
|
---|
| 18 |
|
---|
| 19 | Serial5.println( "WiiChukDemo ready" ) ;
|
---|
| 20 | delay(100);
|
---|
| 21 | }
|
---|
| 22 |
|
---|
| 23 | void loop()
|
---|
| 24 | {
|
---|
| 25 | Wire.requestFrom(0x52, 6);
|
---|
| 26 |
|
---|
| 27 | uint8_t jX = Wire.read();
|
---|
| 28 | uint8_t jY = Wire.read();
|
---|
| 29 | uint8_t accX = Wire.read();
|
---|
| 30 | uint8_t accY = Wire.read();
|
---|
| 31 | uint8_t accZ = Wire.read();
|
---|
| 32 | uint8_t misc = Wire.read();
|
---|
| 33 |
|
---|
| 34 | Serial5.print("Joy : ");
|
---|
| 35 | Serial5.print(jX);
|
---|
| 36 | Serial5.print(", ");
|
---|
| 37 | Serial5.print(jY);
|
---|
| 38 |
|
---|
| 39 | Serial5.print("\tAcc : ");
|
---|
| 40 | Serial5.print(accX);
|
---|
| 41 | Serial5.print(", ");
|
---|
| 42 | Serial5.print(accY);
|
---|
| 43 | Serial5.print(", ");
|
---|
| 44 | Serial5.print(accZ);
|
---|
| 45 |
|
---|
| 46 | Serial5.print("\tBtn : ");
|
---|
| 47 | Serial5.print(" [");
|
---|
| 48 | Serial5.print(misc);
|
---|
| 49 | Serial5.print("] ");
|
---|
| 50 |
|
---|
| 51 | switch(misc & 0x3ul)
|
---|
| 52 | {
|
---|
| 53 | case 0x0ul:
|
---|
| 54 | Serial5.println("Z");
|
---|
| 55 | break;
|
---|
| 56 |
|
---|
| 57 | case 0x1ul:
|
---|
| 58 | Serial5.println("C");
|
---|
| 59 | break;
|
---|
| 60 |
|
---|
| 61 | case 0x2ul:
|
---|
| 62 | Serial5.println("C + Z");
|
---|
| 63 | break;
|
---|
| 64 |
|
---|
| 65 | case 0x3ul:
|
---|
| 66 | Serial5.println("No key");
|
---|
| 67 | break;
|
---|
| 68 |
|
---|
| 69 | default:
|
---|
| 70 | break;
|
---|
| 71 | }
|
---|
| 72 |
|
---|
| 73 | Wire.beginTransmission(0x52);// transmit to device 0x52
|
---|
| 74 | Wire.write((uint8_t)0x00);// sends sent a zero.
|
---|
| 75 | Wire.endTransmission();// stop transmitting
|
---|
| 76 |
|
---|
| 77 | delay(100);
|
---|
| 78 |
|
---|
| 79 | }
|
---|