Diff: WiiClassicController.cpp

Revision:

0:242100dadee8

Child:

3:ecae3d286a99

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/WiiClassicController.cpp	Sat Jun 29 22:02:08 2013 +0000
@@ -0,0 +1,76 @@
+/*
+ * SOURCE FILE : WiiClassicController.cpp
+ *
+ * Definition of class WiiClassicController.
+ * Allows use of a Wii classic controller using an I2C bus.
+ *
+ */
+
+#include "WiiClassicController.h"
+
+// REMOVE THIS!
+extern Serial pc;
+
+/** Constructor.
+ * @param sda pin to use for SDA.
+ * @param scl pin to use for SCL.
+ */
+WiiClassicController::WiiClassicController( PinName sda, PinName scl ) :
+    controllerPort( sda, scl ),
+    initialised( false )
+{
+}
+
+/** Destructor.
+ */
+WiiClassicController::~WiiClassicController() {
+}
+
+/** Read from the controller.
+ * @returns true on success, false on failure.
+ */
+bool WiiClassicController::Read( void ) {
+    // Don't expect client to remember to send an init to the nunchuck
+    // so do it for them here.
+    if( ! initialised ) {
+        initialised = ControllerInit();
+    }
+    // Don't start reading if init failed
+    return initialised && ControllerRead();
+}
+
+/** Initialise the controller.
+ * @returns true on success, false on failure.
+ */
+bool WiiClassicController::ControllerInit( void ) {
+    const UInt8 cmd[] = { CONTROLLER_REGADDR, 0x00 };
+    bool ok = ( controllerPort.write( CONTROLLER_ADDR, (const char*)cmd, sizeof(cmd) ) == 0 );
+    pc.printf( "ControllerInit returned %d\r\n", (int)ok );
+    return ok;
+}
+
+/** Read from the controller, assuming it has been initialised.
+ * @returns true on success, false on failure.
+ */
+bool WiiClassicController::ControllerRead() {
+    // write the address we want to read from
+    const UInt8 cmd[] = { 0x00 };
+    if( controllerPort.write( CONTROLLER_ADDR, (const char*)cmd, sizeof(cmd) ) == 0 ) {
+        // The Wii Classic Controller is non-standard I2C
+        // and can't manage setting the read address and immediately supplying the data
+        // so wait a bit.
+        wait( 0.01 );
+        if( controllerPort.read( CONTROLLER_ADDR, (char*)readBuf, sizeof(readBuf) ) == 0 ) {
+            for( int i = 0; i < CONTROLLER_READLEN; ++i ) {
+                readBuf[ i ] = Decode( readBuf[ i ] );
+            }
+            return true;
+        }
+        else {
+            return false;
+        }
+    }
+    else {
+        return false;
+    }
+}