8
edits
Changes
Wiimote/Extension Controllers/Nunchuck (view source)
Revision as of 23:03, 20 November 2011
, 23:03, 20 November 2011→Snakebyte Wireless Motion XS
Line 117:
Line 117:
−Snakebyte Wireless Motion X code Added By Ein
−----------------------------------------------------
−I made a code based on MikeT and adapted code by Michael Dreherfor (thanks guys!) for wireless Nunchuk controller from Snakebyte. Working fine.
−The problem was in initialization handshake sequence addresses that is a little different for this device.
− Wire.beginTransmission (WII_NUNCHUCK_TWI_ADR); // transmit to device 0x52+ Wire.send (0xF0); // sends memory address Snakebyte Wireless Motion XS controller+ Wire.send (0x55); // sends data.+ Serial.println("Handshake 1/2....");+ if(Wire.endTransmission() == 0) { // stop transmitting
− Wire.beginTransmission (WII_NUNCHUCK_TWI_ADR); // transmit to device 0x52
− Wire.send (0xA5); // sends memory address for Snakebyte Wireless Motion XS controller
− Wire.send (0x00); // sends sent a zero.
− }
−
−
−Below code to copy and pastle to two files: Nunchuk.pde and NunchukFunctions.h
−
−File: Nunchuk.pde
−// Wireless Nunchuck soft for third party wireless nunchucks)
−// Created by Ein(bartosz.zydron@gmail.com), based on code by MikeT and adapted code by Michael Dreher
−// Dedicated version for Snakebyte Wireless Motion XS controller
−
−//Arduino Duemilanove (ATMEGA 328) data wireing
−//S1 - SCK
−//S2 - SDA
−
−//Arduino Duemilanove (ATMEGA 328) power wireing
−//3.3V
−//Ground
−
−//1900 Ohm resistor between 3.3V and S1(SCK)
−//1900 Ohm resistor between 3.3V and S2(SDA)
−
−
−#include <Wire.h>
−#include "NunchukFunctions.h"
−
−void setup()
−{
− Serial.begin(38400);
− nunchuck_pre_init();
− Serial.println("Finished setup");
−}
−
−void loop()
−{
− delay(20); // Change for speed/accuracy of results
−
− nunchuck_get_data();
− nunchuck_save_data();
−
− Serial.print (nunchuck_joy_x, DEC);
− Serial.print ("\t");
− Serial.print (nunchuck_joy_y, DEC);
− Serial.print ("\t");
− Serial.print (nunchuck_c_button, DEC);
− Serial.print ("\t");
− Serial.print (nunchuck_z_button, DEC);
− Serial.print ("\t");
− Serial.print (nunchuck_accel_x, DEC);
− Serial.print ("\t");
− Serial.print (nunchuck_accel_y, DEC);
− Serial.print ("\t");
− Serial.print (nunchuck_accel_z, DEC);
− Serial.print ("\t");
− Serial.print ("\r\n");
−
− delay(1);
−}
−
−File: NunchukFunctions.h
−// Wireless Nunchuck soft for third party wireless nunchucks)
−// Created by Ein(bartosz.zydron@gmail.com), based on code by MikeT and adapted code by Michael Dreher
−// Dedicated version for Snakebyte Wireless Motion XS controller
−
−//Arduino Duemilanove (ATMEGA 328) data wireing
−//S1 - SCK
−//S2 - SDA
−
−//Arduino Duemilanove (ATMEGA 328) power wireing
−//3.3V
−//Ground
−
−//1900 Ohm resistor between 3.3V and S1(SCK)
−//1900 Ohm resistor between 3.3V and S2(SDA)
−
−#define USE_NEW_WAY_INIT 1 // use "The New Way" of initialization <http://wiibrew.org/wiki/Wiimote#The_New_Way>
−#define WII_IDENT_LEN ((byte)6)
−#define WII_TELEGRAM_LEN ((byte)6)
−#define WII_NUNCHUCK_TWI_ADR ((byte)0x52)
−
−#include <Wire.h>
−#include <string.h>
−#include </usr/share/arduino/libraries/Wire/utility/twi.h>
−#undef int
−#include <stdio.h>
−#include <WProgram.h>
−
−static uint8_t outbuf[WII_TELEGRAM_LEN]; // array to store arduino output
−static int cnt = 0;
−static int ledPin = 13;
−static int nunchuck_joy_x, nunchuck_joy_y, nunchuck_c_button, nunchuck_z_button, nunchuck_accel_x, nunchuck_accel_y, nunchuck_accel_z;
−static int nunchuck_calibrate_joy_x = 128, nunchuck_calibrate_joy_y = 130; //subtract these values from nunchuck_joy values to get 0 as centered value
−
−static byte readControllerIdent(byte* pIdent)
−{
− static byte rc = 1;
− // read identification+ Wire.beginTransmission (WII_NUNCHUCK_TWI_ADR); // transmit to device 0x52+ Wire.send (0xFA); // sends memory address of ident in controller+ if(Wire.endTransmission () == 0) // stop transmitting
− {
− static byte i;
− Wire.requestFrom (WII_NUNCHUCK_TWI_ADR, WII_TELEGRAM_LEN); // request data from nunchuck
− for (i = 0; (i < WII_TELEGRAM_LEN) && Wire.available (); i++)
− {
− pIdent[i] = Wire.receive(); // receive byte as an integer
− }
− if(i == WII_TELEGRAM_LEN)
− {
− rc = 0;
− }
− }
− return rc;
−}
−
−
−// params:
−// timeout: abort when timeout (in ms) expires, 0 for unlimited timeout
−// return: 0 == ok, 1 == timeout
−static byte nunchuck_init (unsigned short timeout)
−{
− static byte rc = 1;
− unsigned long time = millis();
− do
− {
− Wire.beginTransmission (WII_NUNCHUCK_TWI_ADR); // transmit to device 0x52
− Serial.println("Handshake 2/2....");+ if(Wire.endTransmission () == 0){
− rc = 0;
− }
− }
− while (rc != 0 && (!timeout || ((millis() - time) < timeout)));
− Serial.println("OK.");
− delay(3000);
− return rc;
−}
−
−
−static void nunchuck_pre_init()
−{
− Wire.begin(); // initialize i2c
− // we need to switch the TWI speed, because the nunchuck uses Fast-TWI
− // normally set in hardware\libraries\Wire\utility\twi.c twi_init()
− // this is the way of doing it without modifying the original files
− #define TWI_FREQ_NUNCHUCK 400000L
− TWBR = ((CPU_FREQ / TWI_FREQ_NUNCHUCK) - 16) / 2;
−
− nunchuck_init(0); // send the initialization handshake
−
− static byte i;
− if(readControllerIdent(outbuf) == 0)
− {
− Serial.print("Ident=");
− for (i = 0; i < WII_TELEGRAM_LEN; i++)
− {
− Serial.print(outbuf[i], HEX);
− Serial.print(' ');
− }
− Serial.println();
− }
−}
−
−
−static void clearTwiInputBuffer(void)
−{
− // clear the receive buffer from any partial data
− while( Wire.available ())
− Wire.receive ();
−}
−
−
−static void send_zero ()
−{
− // I don't know why, but it only works correct when doing this exactly 3 times
− // otherwise only each 3rd call reads data from the controller (cnt will be 0 the other times)
− for(byte i = 0; i < 3; i++)
− {
− Wire.beginTransmission (WII_NUNCHUCK_TWI_ADR); // transmit to device 0x52
− Wire.send (0x00); // sends one byte
− Wire.endTransmission (); // stop transmitting
− delay(5);
− }
−}
−
−
−// 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
−static void nunchuck_save ()
−{
− nunchuck_joy_x = outbuf[0] - nunchuck_calibrate_joy_x;
− nunchuck_joy_y = outbuf[1] - nunchuck_calibrate_joy_y;
− nunchuck_accel_x = outbuf[2] * 2 * 2;
− nunchuck_accel_y = outbuf[3] * 2 * 2;
− nunchuck_accel_z = outbuf[4] * 2 * 2;
−
− nunchuck_z_button = 0;
− nunchuck_c_button = 0;
−
− // byte outbuf[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 ((outbuf[5] >> 0) & 1)
− {
− nunchuck_z_button = 1;
− }
− if ((outbuf[5] >> 1) & 1)
− {
− nunchuck_c_button = 1;
− }
−
− if ((outbuf[5] >> 2) & 1)
− {
− nunchuck_accel_x += 2;
− }
− if ((outbuf[5] >> 3) & 1)
− {
− nunchuck_accel_x += 1;
− }
−
− if ((outbuf[5] >> 4) & 1)
− {
− nunchuck_accel_y += 2;
− }
− if ((outbuf[5] >> 5) & 1)
− {
− nunchuck_accel_y += 1;
− }
−
− if ((outbuf[5] >> 6) & 1)
− {
− nunchuck_accel_z += 2;
− }
− if ((outbuf[5] >> 7) & 1)
− {
− nunchuck_accel_z += 1;
− }
−
−}
−
−
−static void nunchuck_save_data()
−{
− clearTwiInputBuffer();
−
− // If we recieved the 6 bytes, then go print them
− if (cnt >= WII_TELEGRAM_LEN)
− {
− nunchuck_save ();
− }
−}
−
−
−// Decode data format that original Nunchuck uses with old init sequence. This never worked with
−// other controllers (e.g. wireless Nunchuck from other vendors)
−static char nunchuk_decode_byte (char x)
−{
− x = (x ^ 0x17) + 0x17;
− return x;
−}
−
−
−static void nunchuck_get_data()
−{
− send_zero (); // send the request for next bytes
− Wire.requestFrom (WII_NUNCHUCK_TWI_ADR, WII_TELEGRAM_LEN); // request data from nunchuck
− for (cnt = 0; (cnt < WII_TELEGRAM_LEN) && Wire.available (); cnt++)+ {+ outbuf[cnt] = nunchuk_decode_byte (Wire.receive ()); // receive byte as an integer
− digitalWrite (ledPin, HIGH); // sets the LED on
− }
−}
−--- END ---
Arduino code for Snakebyte Wireless Motion X added by Ein
−---------------------------------------------------------------
−:I made a code based on MikeT and adapted code by Michael Dreherfor (thanks guys!) for wireless Nunchuk controller from Snakebyte. Working fine.
−:The problem was in initialization handshake sequence addresses that is a little different for this device.
−--- START ---
−--- END ----
−--- START ---
− <nowiki>Wire.beginTransmission (WII_NUNCHUCK_TWI_ADR)
− Wire.send (0xF0);
− Wire.send (0x55);
− Wire.send (0xF0); // sends memory address Snakebyte Wireless Motion XS controller
− Wire.send (0x55); // sends data.
Serial.println("Handshake 1/2....");
Serial.println("Handshake 1/2....");
− if(Wire.endTransmission() == 0) { // stop transmitting
+ if(Wire.endTransmission() == 0) {
− Wire.beginTransmission (WII_NUNCHUCK_TWI_ADR); // transmit to device 0x52
+ Wire.beginTransmission (WII_NUNCHUCK_TWI_ADR);
− Wire.send (0xA5); // sends memory address for Snakebyte Wireless Motion XS controller
+ Wire.send (0xA5);
− Wire.send (0x00); // sends sent a zero.
+ Wire.send (0x00);
− }</nowiki>
− }
−:File: Nunchuk.pde [[Media:Nunchuk.pde]]
−:File: NunchukFunctions.h [[Media:NunchukFuncktions.h]]
−=== Datel Blade-FX ===
=== Datel Blade-FX ===