Revision 0:726fea07d08f, committed 2016-06-16

Comitter:

kambara1415

Date:

Thu Jun 16 03:39:36 2016 +0000

Commit message:

wii classic controller???????????

Changed in this revision

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/WiiClassicController.cpp	Thu Jun 16 03:39:36 2016 +0000
@@ -0,0 +1,264 @@
+#include "mbed.h"
+#include "WiiClassicController.h"
+
+WiiClassicController::WiiClassicController(PinName p_sda, PinName p_scl):i2c(p_sda, p_scl)
+{
+    WiiClaInitFlag = init();
+    timer.start();
+}
+
+
+bool WiiClassicController::init()
+{
+    bool result = false; 
+    unsigned char cmd[] = {CLASSIC_REGADDR, 0x00};    
+    if (i2c.write(CLASSIC_ADDR, (const char*)cmd, sizeof(cmd)) == I2C_ACK) {
+        result = true;
+    }
+    return result;
+}
+
+
+void WiiClassicController::read()
+{
+    int i;
+    
+    if(timer.read_ms() < 50) return;
+    
+    if(!WiiClaInitFlag) {
+        WiiClaInitFlag = init();
+    }
+    
+    if(WiiClaInitFlag) {
+        const unsigned char cmd[] = {0x00};
+        if (i2c.write(CLASSIC_ADDR, (const char*)cmd, sizeof(cmd)) == I2C_ACK) {
+            wait(I2C_READ_DELAY);
+            if (i2c.read(CLASSIC_ADDR, readBuf, sizeof(readBuf)) == I2C_ACK) {
+                for(i = 0; i < CLASSIC_READLEN; ++i) {
+                    readBuf[i] = (readBuf[i] ^ 0x17) + 0x17;
+                }
+                
+                    if(readBuf[0] & 0x80) joyRX = 0x10;
+                    else    joyRX = 0;
+                    
+                    if(readBuf[0] & 0x40) joyRX += 0x08;
+                    if(readBuf[1] & 0x80) joyRX += 0x04;
+                    if(readBuf[1] & 0x40) joyRX += 0x02;
+                    if(readBuf[1] & 0x80) joyRX += 0x01; 
+                    
+                    joyRY = readBuf[2] & 0x1F;
+                    joyLX = readBuf[0] & 0x3F;
+                    joyLY = readBuf[1] & 0x3F;
+                    
+                    
+                if(readBuf[4] & 0x80) {
+                    buttonDR = 0;
+                } else {
+                    buttonDR = 1;
+                }
+                
+                if(readBuf[4] & 0x40) {
+                    buttonDD = 0;
+                } else {
+                    buttonDD = 1;
+                }
+                
+                if(readBuf[4] & 0x20) {
+                    buttonL = 0;
+                } else {
+                    buttonL = 1;
+                }
+                
+                if(readBuf[4] & 0x10) {
+                    buttonMinus = 0;
+                } else {
+                    buttonMinus = 1;
+                }
+                
+                if(readBuf[4] & 0x08) {
+                    buttonHome = 0;
+                } else {
+                    buttonHome = 1;
+                }
+                
+                if(readBuf[4] & 0x04) {
+                    buttonPlus = 0;
+                } else {
+                    buttonPlus = 1;
+                }
+                
+                if(readBuf[4] & 0x02) {
+                    buttonR = 0;
+                } else {
+                    buttonR = 1;
+                }
+                
+                if(readBuf[5] & 0x80) {
+                    buttonZL = 0;
+                } else {
+                    buttonZL = 1;
+                }
+                
+                if(readBuf[5] & 0x40) {
+                    buttonB = 0;
+                } else {
+                    buttonB = 1;
+                }
+                
+                if(readBuf[5] & 0x20) {
+                    buttonY = 0;
+                } else {
+                    buttonY = 1;
+                }
+                
+                if(readBuf[5] & 0x10) {
+                    buttonA = 0;
+                } else {
+                    buttonA = 1;
+                }
+                
+                if(readBuf[5] & 0x08) {
+                    buttonX = 0;
+                } else {
+                    buttonX = 1;
+                }
+                
+                if(readBuf[5] & 0x04) {
+                    buttonZR = 0;
+                } else {
+                    buttonZR = 1;
+                }
+                
+                if(readBuf[5] & 0x02) {
+                    buttonDL = 0;
+                } else {
+                    buttonDL = 1;
+                }
+                
+                if(readBuf[5] & 0x01) {
+                    buttonDU = 0;
+                } else {
+                    buttonDU = 1;
+                }
+            }
+        }
+    }
+    timer.reset();
+}
+
+
+unsigned char WiiClassicController::joy_RX()
+{
+    read();
+    return joyRX;
+}
+
+
+unsigned char WiiClassicController::joy_RY()
+{
+    read();
+    return joyRY;
+}
+
+unsigned char WiiClassicController::joy_LX()
+{
+    read();
+    return joyLX;
+}
+
+
+unsigned char WiiClassicController::joy_LY()
+{
+    read();
+    return joyLY;
+}
+
+bool WiiClassicController::button_A()
+{
+    read();
+    return buttonA;
+}
+
+bool WiiClassicController::button_B()
+{
+    read();
+    return buttonB;
+}
+
+bool WiiClassicController::button_X()
+{
+    read();
+    return buttonX;
+}
+
+bool WiiClassicController::button_Y()
+{
+    read();
+    return buttonY;
+}
+
+bool WiiClassicController::button_minus()
+{
+    read();
+    return buttonMinus;
+}
+
+bool WiiClassicController::button_plus()
+{
+    read();
+    return buttonPlus;
+}
+
+bool WiiClassicController::button_home()
+{
+    read();
+    return buttonHome;
+}
+
+bool WiiClassicController::button_R()
+{
+    read();
+    return buttonR;
+}
+
+bool WiiClassicController::button_L()
+{
+    read();
+    return buttonL;
+}
+
+bool WiiClassicController::button_ZL()
+{
+    read();
+    return buttonZL;
+}
+
+bool WiiClassicController::button_ZR()
+{
+    read();
+    return buttonZR;
+}
+
+bool WiiClassicController::button_DU()
+{
+    read();
+    return buttonDU;
+}
+
+bool WiiClassicController::button_DD()
+{
+    read();
+    return buttonDD;
+}
+
+bool WiiClassicController::button_DL()
+{
+    read();
+    return buttonDL;
+}
+
+bool WiiClassicController::button_DR()
+{
+    read();
+    return buttonDR;
+}

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/WiiClassicController.h	Thu Jun 16 03:39:36 2016 +0000
@@ -0,0 +1,62 @@
+/*********************************
+
+TOTTORI_U
+ROBOT_LABO
+
+2016/6/16
+**********************************/
+
+#ifndef WII_CLASSIC_CONTROLLER_H
+#define WII_CLASSIC_CONTROLLER_H
+
+#include "mbed.h"
+
+// I2C
+#define CLASSIC_ADDR     0xA4  // 0x52 << 1
+#define CLASSIC_REGADDR  0x40  // 
+#define CLASSIC_READLEN  0x06  //
+#define I2C_ACK 0
+#define I2C_READ_DELAY  0.01
+
+
+class WiiClassicController{
+public:
+    WiiClassicController(PinName p_sda, PinName p_scl);
+    //read();
+    unsigned char joy_LX();
+    unsigned char joy_LY();
+    unsigned char joy_RX();
+    unsigned char joy_RY();
+    bool button_DL();
+    bool button_DR();
+    bool button_DD();
+    bool button_DU();
+    bool button_minus();
+    bool button_plus();
+    bool button_home();
+    bool button_B();
+    bool button_Y();
+    bool button_A();
+    bool button_X();
+    bool button_R();
+    bool button_L();
+    bool button_ZL();
+    bool button_ZR();
+    
+private:
+    I2C i2c;
+    Timer timer;
+    bool WiiClaInitFlag; //= false;
+    char readBuf[CLASSIC_READLEN];
+    unsigned char joyRX, joyRY, joyLX, joyLY;
+    bool buttonA, buttonB, buttonX,
+            buttonY, buttonR, buttonL,
+            buttonZR, buttonZL, buttonDU,
+            buttonDD, buttonDL, buttonDR,
+            buttonPlus, buttonMinus, buttonHome;
+    bool init();
+    void read();
+};
+
+
+#endif
\ No newline at end of file