tarou yamada / I2CServo

I2CServo.cpp

Committer:
inst
Date:
2015-07-02
Revision:
0:d4e07340fb0e
Child:
1:e06cf312e9f0

File content as of revision 0:d4e07340fb0e:

#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 );
}