Wii Nunchuck an Arduino

[HaWe]

leider auch nicht, gibt auch nur:
2 joy:255,255 acc:258,258,258 but:1,1
3 joy:255,255 acc:258,258,258 but:1,1
4 joy:255,255 acc:258,258,258 but:1,1
5 joy:255,255 acc:258,258,258 but:1,1
6 joy:255,255 acc:258,258,258 but:1,1
7 joy:255,255 acc:258,258,258 but:1,1
8 joy:255,255 acc:258,258,258 but:1,1
9 joy:255,255 acc:258,258,258 but:1,1
10 joy:255,255 acc:258,258,258 but:1,1
11 joy:255,255 acc:258,258,258 but:1,1
12 joy:255,255 acc:258,258,258 but:1,1
13 joy:255,255 acc:258,258,258 but:1,1
14 joy:255,255 acc:258,258,258 but:1,1
15 joy:255,255 acc:258,258,258 but:1,1

und zwischendurch mal völlig unmotoviert, ohne mein Zutun:

113 joy:255,255 acc:255,255,170 but:0,0
114 joy:0,0 acc:0,0,0 but:0,0
115 joy:0,0 acc:0,1,164 but:0,0
116 joy:0,0 acc:0,0,0 but:0,0
117 joy:0,3 acc:0,0,0 but:0,0
118 joy:0,0 acc:0,0,0 but:0,0
119 joy:0,0 acc:3,258,258 but:1,1
120 joy:255,255 acc:258,258,258 but:1,1

#include <Wire.h>;


void setup(){
   Serial.begin(115200);

   //nunchuck_setpowerpins();
   nunchuck_init();

   Serial.print("Nunchuck ready\n");

}

 

void loop(){
   nunchuck_get_data();
   nunchuck_print_data();
   delay(1000);
}

//=========================================================================//
//Do not modify!!!!!!!!
//=========================================================================//

//
// Nunchuck functions
//


static uint8_t nunchuck_buf[6]; // array to store nunchuck data,

// Uses port C (analog in) pins as power & ground for Nunchuck
static void nunchuck_setpowerpins() {
  /*
   #define pwrpin PC3
   #define gndpin PC2
   DDRC |= _BV(pwrpin) | _BV(gndpin);
   PORTC &=~ _BV(gndpin);
   PORTC |= _BV(pwrpin);
   */
   delay(100); // wait for things to stabilize
}


// initialize the I2C system, join the I2C bus,
// and tell the nunchuck we're talking to it

void nunchuck_init()
{  /*
   Wire.begin(); // join I2C bus as master
   Wire.beginTransmission(0x52); // transmit to device 0x52
   Wire.write(0x40); // sends memory address
   Wire.write(0x00); // sends sent a zero.
   Wire.endTransmission(); // stop transmitting
   */
   
   byte cnt;
   uint8_t ctrlr_type[6];

   Wire.begin();
           
// init controller
delay(1);
Wire.beginTransmission(0x52);      // device address
Wire.write(0xF0);                    // 1st initialisation register
Wire.write(0x55);                    // 1st initialisation value
Wire.endTransmission();
delay(1);
Wire.beginTransmission(0x52);
Wire.write(0xFB);                    // 2nd initialisation register
Wire.write(0x00);                    // 2nd initialisation value
Wire.endTransmission();
delay(1);
           
// read the extension type from the register block        
Wire.beginTransmission(0x52);
Wire.write(0xFA);                    // extension type register
Wire.endTransmission();
Wire.beginTransmission(0x52);
Wire.requestFrom(0x52, 6);               // request data from controller
for (cnt = 0; cnt < 6; cnt++) {
   if (Wire.available()) {
       ctrlr_type[cnt] = Wire.read(); // Should be 0x0000 A420 0101 for Classic Controller, 0x0000 A420 0000 for nunchuck
   }
}
Wire.endTransmission();
delay(1); 
           
// send the crypto key (zeros), in 3 blocks of 6, 6 & 4.
Wire.beginTransmission(0x52);
Wire.write(0xF0);                    // crypto key command register
Wire.write(0xAA);                    // sends crypto enable notice
Wire.endTransmission();
delay(1);
Wire.beginTransmission(0x52);
Wire.write(0x40);                    // crypto key data address
for (cnt = 0; cnt < 6; cnt++) {
   Wire.write(0x00);                    // sends 1st key block (zeros)
}
Wire.endTransmission();
Wire.beginTransmission(0x52);
Wire.write(0x40);                    // sends memory address
for (cnt = 6; cnt < 12; cnt++) {
   Wire.write(0x00);                    // sends 2nd key block (zeros)
}
Wire.endTransmission();
Wire.beginTransmission(0x52);
Wire.write(0x40);                    // sends memory address
for (cnt = 12; cnt < 16; cnt++) {
   Wire.write(0x00);                    // sends 3rd key block (zeros)
}
Wire.endTransmission();
delay(1);
// end device init
}


// Send a request for data to the nunchuck
// was "send_zero()"
void nunchuck_send_request() {
   Wire.beginTransmission(0x52); // transmit to device 0x52
   Wire.write(0x00); // sends one byte
   Wire.endTransmission(); // stop transmitting
}


// Receive data back from the nunchuck,
// returns 1 on successful read. returns 0 on failure
int nunchuck_get_data() {

   int cnt=0;

   Wire.requestFrom (0x52, 6); // request data from nunchuck   
   while (Wire.available ()) {   
   // receive byte as an integer   
   nunchuck_buf[cnt] = nunchuk_decode_byte(Wire.read());   
   cnt++;      
}

nunchuck_send_request(); // send request for next data payload
// If we recieved the 6 bytes, then go print them
   if (cnt >= 5) {
     return 1; // success
   }
   return 0; //failure
}


// Print the input data we have recieved
// accel data is 10 bits long
// so we read 8 bits, then we have to add
// on the last 2 bits. That is why I
// multiply them by 2 * 2

void nunchuck_print_data() {
   static int i=0;
   int joy_x_axis = nunchuck_buf[0];
   int joy_y_axis = nunchuck_buf[1];
   int accel_x_axis = nunchuck_buf[2]; // * 2 * 2;
   int accel_y_axis = nunchuck_buf[3]; // * 2 * 2;
   int accel_z_axis = nunchuck_buf[4]; // * 2 * 2;
   
   int z_button = 0;
   int c_button = 0;
         
   // byte nunchuck_buf[5] contains bits for z and c buttons
   // it also contains the least significant bits for the accelerometer data
   // so we have to check each bit of byte outbuf[5]
   if ((nunchuck_buf[5] >> 0) & 1)
   z_button = 1;
   
   if ((nunchuck_buf[5] >> 1) & 1)
   c_button = 1;
   
   if ((nunchuck_buf[5] >> 2) & 1)
   accel_x_axis += 2;
   
   if ((nunchuck_buf[5] >> 3) & 1)
   accel_x_axis += 1;
   
   if ((nunchuck_buf[5] >> 4) & 1)
   accel_y_axis += 2;
   
   if ((nunchuck_buf[5] >> 5) & 1)
   accel_y_axis += 1;

   if ((nunchuck_buf[5] >> 6) & 1)
   accel_z_axis += 2;

   if ((nunchuck_buf[5] >> 7) & 1)
   accel_z_axis += 1;

   Serial.print(i,DEC);
   Serial.print("\t");
   Serial.print("joy:");
   Serial.print(joy_x_axis,DEC);
   Serial.print(",");
   Serial.print(joy_y_axis, DEC);
   Serial.print(" \t");
   Serial.print("acc:");
   Serial.print(accel_x_axis, DEC);
   Serial.print(",");
   Serial.print(accel_y_axis, DEC);
   Serial.print(",");
   Serial.print(accel_z_axis, DEC);
   Serial.print("\t");
   Serial.print("but:");
   Serial.print(z_button, DEC);
   Serial.print(",");
   Serial.print(c_button, DEC);
   Serial.print("\r\n"); // newline
   i++;

}


// Encode data to format that most wiimote drivers except
// only needed if you use one of the regular wiimote drivers

char nunchuk_decode_byte (char x) {
   x = (x ^ 0x17) + 0x17;
   return x;
}


// returns zbutton state: 1=pressed, 0=notpressed
int nunchuck_zbutton() {
   return ((nunchuck_buf[5] >> 0) & 1) ? 0 : 1; // voodoo
}


// returns zbutton state: 1=pressed, 0=notpressed
int nunchuck_cbutton()  {
   return ((nunchuck_buf[5] >> 1) & 1) ? 0 : 1; // voodoo
}


// returns value of x-axis joystick

int nunchuck_joyx()  {
   return nunchuck_buf[0];
}


// returns value of y-axis joystick
int nunchuck_joyy()  {
   return nunchuck_buf[1];
}


// returns value of x-axis accelerometer
int nunchuck_accelx()  {
   return nunchuck_buf[2]; // FIXME: this leaves out 2-bits of the data
}


// returns value of y-axis accelerometer
int nunchuck_accely()  {
   return nunchuck_buf[3]; // FIXME: this leaves out 2-bits of the data
}


// returns value of z-axis accelerometer
int nunchuck_accelz()  {
   return nunchuck_buf[4]; // FIXME: this leaves out 2-bits of the data
}