sdsd
Diff: VL6180.cpp
- Revision:
- 0:f23c00f688b2
- Child:
- 3:5d61f202b1bd
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/VL6180.cpp Mon Oct 19 16:19:05 2015 +0000 @@ -0,0 +1,100 @@ +#include "VL6180.h" +#include "mbed.h" + +VL6180::VL6180(PinName sda, PinName scl) : _i2c(sda, scl) { + char poweron; + poweron = readI2C(0x16); + if(poweron == 1) { + //mandatory initialization + writeI2C(0x0207,0x01); + writeI2C(0x0208,0x01); + writeI2C(0x0096,0x00); + writeI2C(0x0097,0xfd); + writeI2C(0x00e3,0x00); + writeI2C(0x00e4,0x04); + writeI2C(0x00e5,0x02); + writeI2C(0x00e6,0x01); + writeI2C(0x00e7,0x03); + writeI2C(0x00f5,0x02); + writeI2C(0x00d9,0x05); + writeI2C(0x00db,0xce); + writeI2C(0x00dc,0x03); + writeI2C(0x00dd,0xf8); + writeI2C(0x009f,0x00); + writeI2C(0x00a3,0x3c); + writeI2C(0x00b7,0x00); + writeI2C(0x00bb,0x3c); + writeI2C(0x00b2,0x09); + writeI2C(0x00ca,0x09); + writeI2C(0x0198,0x01); + writeI2C(0x01b0,0x17); + writeI2C(0x01ad,0x00); + writeI2C(0x00ff,0x05); + writeI2C(0x0100,0x05); + writeI2C(0x0199,0x05); + writeI2C(0x01a6,0x1b); + writeI2C(0x01ac,0x3e); + writeI2C(0x01a7,0x1f); + writeI2C(0x0030,0x00); + //recommended initialization + writeI2C(0x0011,0x10);// Enables polling for ‘New Sample ready’ when measurement completes + writeI2C(0x010a,0x30);// Set the averaging sample period (compromise between lower noise and increased execution time) + writeI2C(0x003f,0x46);// Sets the light and dark gain (upper nibble). Dark gain should not be changed. + writeI2C(0x0031,0xFF);// sets the # of range measurements after which auto calibration of system is performed + writeI2C(0x0040,0x63);// Set ALS integration time to 100ms + writeI2C(0x002e,0x01);// perform a single temperature calibration of the ranging sensor + //optional initialization + writeI2C(0x001b,0x09);// Set default ranging inter-measurement period to 100ms + writeI2C(0x003e,0x31);// Set default ALS inter-measurement period to 500ms + writeI2C(0x0014,0x24);// Configures interrupt on ‘New Sample Ready threshold event’ + + writeI2C(0x016,0x00);//change fresh out of set status to 0 + } +} + +float VL6180::read() { + char status; + char retn; + + writeI2C(0x18, 0x01); + + status = readI2C(0x4F); + while((status & 0x2) != 4) { + status = readI2C(0x4F); + } + + retn = readI2C(0x62); + + writeI2C(0x15, 0x07); + + return (float)retn / 10.0; +} + +VL6180::operator float() { + return read(); +} + + +void VL6180::writeI2C(int reg, char data) { + char dataout[3]; + + dataout[0] = (reg >> 8) & 0xFF; + dataout[1] = reg & 0xFF; + dataout[2] = data & 0xFF; + + _i2c.write(_addr, dataout, 3); +} + +char VL6180::readI2C(int reg) { + char dataout[2]; + char datain[1]; + + dataout[0] = (reg >> 8) & 0xFF; + dataout[1] = reg & 0xFF; + + _i2c.write(_addr, dataout, 2); + _i2c.read(_addr, datain, 1); + + return datain[0]; +} + \ No newline at end of file