Revision 0:e84a5ccbac19, committed 2011-03-14

Comitter:

gbrush

Date:

Mon Mar 14 23:47:12 2011 +0000

Commit message:

Initial

Changed in this revision

diff -r 000000000000 -r e84a5ccbac19 WiiChuk_compat.c
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/WiiChuk_compat.c	Mon Mar 14 23:47:12 2011 +0000
@@ -0,0 +1,154 @@
+#include "WiiChuk_compat.h"
+
+
+
+WiiChuck::WiiChuck(PinName data, PinName clk):_i2c(data, clk) {
+    _i2c.frequency(400000); // should work at 100000 too
+    Error = true;
+
+    // initialize Wii extension (nunchuk) based on "new way" initialization
+    // http://wiibrew.org/wiki/Wiimote#The_New_Way
+    // also disables need for decryption
+    
+    unsigned char cmd[] = {0xF0, 0x55};
+    if (_i2c.write(NUNCHUCK_ADDR, (const char*)cmd, sizeof(cmd)) == I2C_ACK) {
+        Error = false;
+    }
+    
+    cmd[0] = 0xfb; cmd[1]= 0x00;
+    _i2c.write(NUNCHUCK_ADDR, (const char*)cmd, sizeof(cmd));
+    
+    _oldC = 0;
+    _oldZ = 0;
+}
+
+bool WiiChuck::Read(int* joyX,int* joyY,int* accX,int* accY,int* accZ,int* buttonC,int* buttonZ) {
+
+    //int i;
+    char readBuf[NUNCHUCK_READLEN];
+    
+    if (Error) {
+        return false;
+    }
+    
+    const unsigned char cmd[] = {0x00};
+    if (_i2c.write(NUNCHUCK_ADDR, (const char*)cmd, sizeof(cmd)) == I2C_ACK) {
+        wait(I2C_READ_DELAY);
+        if (_i2c.read(NUNCHUCK_ADDR, readBuf, sizeof(readBuf)) == I2C_ACK) {
+            //init values
+            *joyX = 0; *joyY = 0; *accX = 0; *accY = 0; *accZ = 0; *buttonC = 0; *buttonZ = 0;
+   
+            /*  Decrypting not required with new initialization
+            for (i = 0; i < NUNCHUCK_READLEN; ++i) {
+                readBuf[i] = (readBuf[i] ^ 0x17) + 0x17;
+            }
+            */
+            
+            *joyX = readBuf[Joy_X];
+            *joyY = readBuf[Joy_Y];
+            *accX = readBuf[Acc_X] << 2;
+            *accY = readBuf[Acc_Y] << 2;
+            *accZ = readBuf[Acc_Z] << 2;
+
+            if (readBuf[Button] & 0x01) {
+                *buttonZ = 0;
+            } else {
+                *buttonZ = 1;
+            }
+            if (readBuf[Button] & 0x02) {
+                *buttonC = 0;
+            } else {
+                *buttonC = 1;
+            }
+            if (readBuf[Button] & 0x04) accX += 2;
+            if (readBuf[Button] & 0x08) accX += 1;
+            if (readBuf[Button] & 0x10) accY += 2;
+            if (readBuf[Button] & 0x20) accY += 1;
+            if (readBuf[Button] & 0x40) accZ += 2;
+            if (readBuf[Button] & 0x80) accZ += 1;
+            return true;
+        }
+        else
+        {
+            return false;
+        }
+    } else {
+        return false;
+    }
+
+}
+
+void WiiChuck::start()
+{
+    _getValues.attach(this, &WiiChuck::getValues,0.2);
+}
+void WiiChuck::stop()
+{
+     _getValues.detach();
+}
+
+void WiiChuck::getValues()
+{
+    int joyX = 0;int joyY = 0;
+    int accX = 0;int accY = 0;int accZ = 0;
+    int buttonC = 0;int buttonZ = 0;
+     
+    bool read = Read(&joyX,&joyY,&accX,&accY,&accZ,&buttonC,&buttonZ);
+  
+    if(read)
+    {
+        //analyse
+        if(_oldC == 0 && buttonC == 1)
+        {
+            _oldC = 1;
+            _callback_input(BUTTON_CANCEL_VALUE);
+            return;
+        }
+        else
+        {
+            _oldC = buttonC;
+        }
+        
+        //analyse
+        if(_oldZ == 0 && buttonZ == 1)
+        {
+            _oldZ = 1;
+            _callback_input(BUTTON_OK_VALUE);
+            return;
+        }
+        else
+        {
+            _oldZ = buttonZ;
+        }
+        
+        if(joyY>160)
+        {
+            _callback_input(BUTTON_VOLUME_PLUS);
+            return;
+        }
+        if(joyY<80)
+        {
+        
+            _callback_input(BUTTON_VOLUME_MINUS);
+            return;
+        }
+        if(joyX>160)
+        {
+            _callback_input(BUTTON_NEXT_VALUE);
+            return;
+        }
+        if(joyX<80)
+        {
+        
+            _callback_input(BUTTON_PREV_VALUE);
+            return;
+        }
+        
+    }
+}
+void WiiChuck::attach(pt2Func function)
+{
+    _callback_input = function;
+}
+
+

diff -r 000000000000 -r e84a5ccbac19 WiiChuk_compat.h
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/WiiChuk_compat.h	Mon Mar 14 23:47:12 2011 +0000
@@ -0,0 +1,79 @@
+/*
+ * Copyright (c) 2011 Greg Brush
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a copy
+ * of this software and associated documentation files (the "Software"), to deal
+ * in the Software without restriction, including without limitation the rights
+ * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
+ * copies of the Software, and to permit persons to whom the Software is
+ * furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be included in
+ * all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
+ * THE SOFTWARE.
+ *
+ * This code based on:
+ *  WiiChuck
+ *  http://mbed.org/users/FrankWeissenborn/libraries/WiiChuck/lnae1a
+ *  2011-03-14
+ *  New initialization compatible with 3rd party controllers
+ *
+ */
+ 
+#ifndef __WIICHUCK_H
+#define __WIICHUCK_H
+
+#include "mbed.h"
+
+#define NUNCHUCK_ADDR     0xA4  // 0x52 << 1
+#define NUNCHUCK_READLEN  0x06  //
+#define I2C_ACK 0
+#define I2C_READ_DELAY  0.0001
+
+#define Joy_X   0
+#define Joy_Y   1
+#define Acc_X   2
+#define Acc_Y   3
+#define Acc_Z   4
+#define Button  5
+
+// ----------------------------------------------------------------------------
+//   Control values
+// ----------------------------------------------------------------------------
+#define BUTTON_PREV_VALUE               '1'
+#define BUTTON_NEXT_VALUE               '2'
+#define BUTTON_OK_VALUE                 '3'
+#define BUTTON_CANCEL_VALUE             '4'
+#define BUTTON_RESET_VALUE              'r'
+#define BUTTON_VOLUME_PLUS              '+'
+#define BUTTON_VOLUME_MINUS             '-'
+
+typedef void(*pt2Func)(int);
+
+class WiiChuck {
+public:
+    bool Error;
+    WiiChuck(PinName data, PinName clk);
+    bool Read(int* joyX,int* joyY,int* accX,int* accY,int* accZ,int* buttonC,int* buttonZ);
+    void start();
+    void stop();
+    void attach(pt2Func function);
+private: 
+    I2C _i2c;
+    pt2Func _callback_input;
+    Ticker _getValues;
+    void getValues();
+    int _oldC;
+    int _oldZ;
+    
+
+};
+
+#endif
\ No newline at end of file