From df33c3650a3dc9103f8d5b8f04f7c50f2ca78fc9 Mon Sep 17 00:00:00 2001 From: =?UTF-8?q?Lars=20Erik=20Storbuk=C3=A5s?= Date: Thu, 4 Feb 2021 00:24:19 +0100 Subject: [PATCH] First release --- README.md | 4 + WiiNunchuk.h | 280 +++++++++++++++++++++++++++++++++++++ examples/simple/simple.ino | 40 ++++++ 3 files changed, 324 insertions(+) create mode 100644 WiiNunchuk.h create mode 100644 examples/simple/simple.ino diff --git a/README.md b/README.md index 260d24a..5dc9762 100644 --- a/README.md +++ b/README.md @@ -1,2 +1,6 @@ # WiiNunchuck Arduino Library for the Wii Nunchuck + +Documentation +--- +The full documentation can be found [here](http://www.xarg.org/2016/12/using-a-wii-nunchuk-with-arduino/). \ No newline at end of file diff --git a/WiiNunchuk.h b/WiiNunchuk.h new file mode 100644 index 0000000..96d476b --- /dev/null +++ b/WiiNunchuk.h @@ -0,0 +1,280 @@ +/* + * Wii Nunchuk Arduino library + * + * created 04 Feb 2021 + * by Lars Erik Storbukås + * + * Source: https://github.com/storbukas/DS3231 + * Original source: https://github.com/infusion/Fritzing/tree/master/Nunchuk + * + * Licensed under the MIT License + * https://opensource.org/licenses/MIT + * + */ + +#ifndef NUNCHUK_H +#define NUNCHUK_H + +#include + +// Calibration accelerometer values, depends on your Nunchuk +#define NUNCHUK_ACCEL_X_ZERO 512 +#define NUNCHUK_ACCEL_Y_ZERO 512 +#define NUNCHUK_ACCEL_Z_ZERO 512 + +// Calibration joystick values +#define NUNCHUK_JOYSTICK_X_ZERO 127 +#define NUNCHUK_JOYSTICK_Y_ZERO 128 + +// Whether to disable encryption. Enabling encryption means that every packet +// must be decrypted, which wastes cpu cycles. Cheap Nunchuk clones have +// problems with the encrypted init sequence, so be sure you know what you're +// doing +#define NUNCHUK_DISABLE_ENCRYPTION + +// Print debug information instead of a CSV stream to the serial port +// #define NUNCHUK_DEBUG + +// The Nunchuk I2C address +#define NUNCHUK_ADDRESS 0x52 + +#if ARDUINO >= 100 +#define I2C_READ() Wire.read() +#define I2C_WRITE(x) Wire.write(x) +#else +#define I2C_READ() Wire.receive() +#define I2C_WRITE(x) Wire.send(x) +#endif + +#define I2C_START(x) Wire.beginTransmission(x) +#define I2C_STOP() Wire.endTransmission(true) + +uint8_t nunchuk_data[6]; +uint8_t nunchuk_cali[16]; + +#if defined(__AVR_ATmega168__) || \ + defined(__AVR_ATmega328P__) // Only Arduino UNO +/** + * Use normal analog ports as power supply, which is useful if you want to have + * all pins in a row Like for the famous WiiChuck adapter + * @see + * https://todbot.com/blog/2008/02/18/wiichuck-wii-nunchuck-adapter-available/ + */ +static void nunchuk_init_power() { + // Add power supply for port C2 (GND) and C3 (PWR) + PORTC &= ~_BV(PORTC2); + PORTC |= _BV(PORTC3); + DDRC |= _BV(PORTC2) | _BV(PORTC3); + delay(100); +} +#endif +/** + * Initializes the Nunchuk communication by sending a sequence of bytes + */ +static void nunchuk_init() { +#ifdef NUNCHUK_DISABLE_ENCRYPTION + I2C_START(NUNCHUK_ADDRESS); + I2C_WRITE(0xF0); + I2C_WRITE(0x55); + I2C_STOP(); + // delay(1); + I2C_START(NUNCHUK_ADDRESS); + I2C_WRITE(0xFB); + I2C_WRITE(0x00); + I2C_STOP(); + // delay(1); +#else + I2C_START(NUNCHUK_ADDRESS); + I2C_WRITE(0x40); + I2C_WRITE(0x00); + I2C_STOP(); + // delay(1); +#endif + +#ifdef NUNCHUK_DEBUG + Serial.print("Ident: "); // 0xA4200000 for Nunchuck, 0xA4200101 for Classic, + // 0xA4200402 for Balance + + I2C_START(NUNCHUK_ADDRESS); + I2C_WRITE(0xFA); + I2C_STOP(); + + Wire.requestFrom(NUNCHUK_ADDRESS, 6); + for (uint8_t i = 0; i < 6; i++) { + if (Wire.available()) { + Serial.print(I2C_READ(), HEX); + Serial.print(" "); + } + } + I2C_STOP(); + Serial.println(""); + + delay(100); // Wait for serial transfer, before loop()ing +#endif +} + +/** + * Decodes a byte if encryption is used + * + * @param x The byte to be decoded + */ +static inline uint8_t nunchuk_decode_byte(uint8_t x) { +#ifdef NUNCHUK_DISABLE_ENCRYPTION + return x; +#else + return (x ^ 0x17) + 0x17; +#endif +} + +/** + * Central function to read a full chunk of data from Nunchuk + * + * @return A boolean if the data transfer was successful + */ +static uint8_t nunchuk_read() { + uint8_t i; + Wire.requestFrom(NUNCHUK_ADDRESS, 6); +#ifdef SAM + delayMicroseconds(10); +#endif + for (i = 0; i < 6 && Wire.available(); i++) { + nunchuk_data[i] = nunchuk_decode_byte(I2C_READ()); + } + I2C_START(NUNCHUK_ADDRESS); + I2C_WRITE(0x00); +#ifdef SAM + delayMicroseconds(100); +#endif + I2C_STOP(); + return i == 6; +} + +/** + * Checks the current state of button Z + */ +static uint8_t nunchuk_buttonZ() { return (~nunchuk_data[5] >> 0) & 1; } + +/** + * Checks the current state of button C + */ +static uint8_t nunchuk_buttonC() { return (~nunchuk_data[5] >> 1) & 1; } + +/** + * Retrieves the raw X-value of the joystick + */ +static uint8_t nunchuk_joystickX_raw() { return nunchuk_data[0]; } + +/** + * Retrieves the raw Y-value of the joystick + */ +static uint8_t nunchuk_joystickY_raw() { return nunchuk_data[1]; } + +/** + * Retrieves the calibrated X-value of the joystick + */ +static int16_t nunchuk_joystickX() { + return (int16_t)nunchuk_joystickX_raw() - (int16_t)NUNCHUK_JOYSTICK_X_ZERO; +} + +/** + * Retrieves the calibrated Y-value of the joystick + */ +static int16_t nunchuk_joystickY() { + return (int16_t)nunchuk_joystickY_raw() - (int16_t)NUNCHUK_JOYSTICK_Y_ZERO; +} + +/** + * Calculates the angle of the joystick + */ +static float nunchuk_joystick_angle() { + return atan2((float)nunchuk_joystickY(), (float)nunchuk_joystickX()); +} + +/** + * Retrieves the raw X-value of the accelerometer + */ +static uint16_t nunchuk_accelX_raw() { + return ((uint16_t)nunchuk_data[2] << 2) | ((nunchuk_data[5] >> 2) & 3); +} + +/** + * Retrieves the raw Y-value of the accelerometer + */ +static uint16_t nunchuk_accelY_raw() { + return ((uint16_t)nunchuk_data[3] << 2) | ((nunchuk_data[5] >> 4) & 3); +} + +/** + * Retrieves the raw Z-value of the accelerometer + */ +static uint16_t nunchuk_accelZ_raw() { + return ((uint16_t)nunchuk_data[4] << 2) | ((nunchuk_data[5] >> 6) & 3); +} + +/** + * Retrieves the calibrated X-value of the accelerometer + */ +static int16_t nunchuk_accelX() { + return (int16_t)nunchuk_accelX_raw() - (int16_t)NUNCHUK_ACCEL_X_ZERO; +} + +/** + * Retrieves the calibrated Y-value of the accelerometer + */ +static int16_t nunchuk_accelY() { + return (int16_t)nunchuk_accelY_raw() - (int16_t)NUNCHUK_ACCEL_Y_ZERO; +} + +/** + * Retrieves the calibrated Z-value of the accelerometer + */ +static int16_t nunchuk_accelZ() { + return (int16_t)nunchuk_accelZ_raw() - (int16_t)NUNCHUK_ACCEL_Z_ZERO; +} + +/** + * Calculates the pitch angle THETA around y-axis of the Nunchuk in radians + */ +static float nunchuk_pitch() { // tilt-y + return atan2((float)nunchuk_accelY(), (float)nunchuk_accelZ()); +} + +/** + * Calculates the roll angle PHI around x-axis of the Nunchuk in radians + */ +static float nunchuk_roll() { // tilt-x + return atan2((float)nunchuk_accelX(), (float)nunchuk_accelZ()); +} + +/** + * A handy function to print either verbose information of the Nunchuk or a CSV + * stream for Processing + */ +static void nunchuk_print() { +#ifdef NUNCHUK_DEBUG + char buf[100]; + + sprintf(buf, "Joy X=%4d Y=%4d Acc X=%4d Y=%4d Z=%4d Btn Z=%1d C=%1d\n", + nunchuk_joystickX(), nunchuk_joystickY(), nunchuk_accelX(), + nunchuk_accelY(), nunchuk_accelZ(), nunchuk_buttonZ(), + nunchuk_buttonC()); + Serial.print(buf); +#else + Serial.print(nunchuk_joystickX(), DEC); + Serial.print(","); + Serial.print(nunchuk_joystickY(), DEC); + Serial.print(","); + Serial.print(nunchuk_accelX(), DEC); + Serial.print(","); + Serial.print(nunchuk_accelY(), DEC); + Serial.print(","); + Serial.print(nunchuk_accelZ(), DEC); + Serial.print(","); + Serial.print(nunchuk_buttonZ(), DEC); + Serial.print(","); + Serial.print(nunchuk_buttonC(), DEC); + Serial.print("\n"); +#endif +} + +#endif \ No newline at end of file diff --git a/examples/simple/simple.ino b/examples/simple/simple.ino new file mode 100644 index 0000000..7baa5c5 --- /dev/null +++ b/examples/simple/simple.ino @@ -0,0 +1,40 @@ +/* + * DS3231: Real-Time Clock. Alarm simple + * + * created 03 Feb 2021 + * by Lars Erik Storbukås + * + * Source: https://github.com/storbukas/WiiNunchuck + * + * Licensed under the MIT License + * https://opensource.org/licenses/MIT + * + */ + +// --------------------------------------------------------------------- +// INCLUDES +// +#include + +#include "WiiNunchuk.h" + +// --------------------------------------------------------------------- +// SETUP +// +void setup() { + Serial.begin(9600); + Wire.begin(); + // nunchuk_init_power(); // A1 and A2 is power supply + nunchuk_init(); +} + +// --------------------------------------------------------------------- +// LOOP +// +void loop() { + if (nunchuk_read()) { + // Work with nunchuk_data + nunchuk_print(); + } + delay(10); +} \ No newline at end of file