tarou yamada / I2CServo

Diff: I2CServo.cpp

Revision:
0:d4e07340fb0e
Child:
1:e06cf312e9f0
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/I2CServo.cpp	Thu Jul 02 00:58:28 2015 +0000
@@ -0,0 +1,14 @@
+#include "mbed.h"
+#include "I2CServo.h"
+
+I2CServo::I2CServo( I2C* i2c, char address ) : I2CDevice( i2c, address ){
+    mPosition = 512;
+}
+
+void I2CServo::write(){
+    char trans[] = {
+        static_cast< char >( ( mPosition >> 8 ) & 0x03 ),
+        static_cast< char >( mPosition & 0xFF )
+    };
+    mI2C->write( mAddress, trans, 2 );
+}
\ No newline at end of file