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