Steven Burg / VL6180

Library for the VL6180 time of flight range finder.

Dependents:   VL6180_Hello_World STM32F103C8T6_VL6180 BLE_Sensor_VL6180 BLE_Sensor_VL6180_window

VL6180.cpp@3:5d61f202b1bd, 2015-10-19 (annotated)

Committer:
sburg
Date:
Mon Oct 19 21:58:52 2015 +0000
Revision:
3:5d61f202b1bd
Parent:
0:f23c00f688b2 
Fixed address error in read()

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sburg 0:f23c00f688b2 1 #include "VL6180.h"
sburg 0:f23c00f688b2 2 #include "mbed.h"
sburg 0:f23c00f688b2 3
sburg 0:f23c00f688b2 4 VL6180::VL6180(PinName sda, PinName scl) : _i2c(sda, scl) {
sburg 0:f23c00f688b2 5 char poweron;
sburg 0:f23c00f688b2 6 poweron = readI2C(0x16);
sburg 0:f23c00f688b2 7 if(poweron == 1) {
sburg 0:f23c00f688b2 8 //mandatory initialization
sburg 0:f23c00f688b2 9 writeI2C(0x0207,0x01);
sburg 0:f23c00f688b2 10 writeI2C(0x0208,0x01);
sburg 0:f23c00f688b2 11 writeI2C(0x0096,0x00);
sburg 0:f23c00f688b2 12 writeI2C(0x0097,0xfd);
sburg 0:f23c00f688b2 13 writeI2C(0x00e3,0x00);
sburg 0:f23c00f688b2 14 writeI2C(0x00e4,0x04);
sburg 0:f23c00f688b2 15 writeI2C(0x00e5,0x02);
sburg 0:f23c00f688b2 16 writeI2C(0x00e6,0x01);
sburg 0:f23c00f688b2 17 writeI2C(0x00e7,0x03);
sburg 0:f23c00f688b2 18 writeI2C(0x00f5,0x02);
sburg 0:f23c00f688b2 19 writeI2C(0x00d9,0x05);
sburg 0:f23c00f688b2 20 writeI2C(0x00db,0xce);
sburg 0:f23c00f688b2 21 writeI2C(0x00dc,0x03);
sburg 0:f23c00f688b2 22 writeI2C(0x00dd,0xf8);
sburg 0:f23c00f688b2 23 writeI2C(0x009f,0x00);
sburg 0:f23c00f688b2 24 writeI2C(0x00a3,0x3c);
sburg 0:f23c00f688b2 25 writeI2C(0x00b7,0x00);
sburg 0:f23c00f688b2 26 writeI2C(0x00bb,0x3c);
sburg 0:f23c00f688b2 27 writeI2C(0x00b2,0x09);
sburg 0:f23c00f688b2 28 writeI2C(0x00ca,0x09);
sburg 0:f23c00f688b2 29 writeI2C(0x0198,0x01);
sburg 0:f23c00f688b2 30 writeI2C(0x01b0,0x17);
sburg 0:f23c00f688b2 31 writeI2C(0x01ad,0x00);
sburg 0:f23c00f688b2 32 writeI2C(0x00ff,0x05);
sburg 0:f23c00f688b2 33 writeI2C(0x0100,0x05);
sburg 0:f23c00f688b2 34 writeI2C(0x0199,0x05);
sburg 0:f23c00f688b2 35 writeI2C(0x01a6,0x1b);
sburg 0:f23c00f688b2 36 writeI2C(0x01ac,0x3e);
sburg 0:f23c00f688b2 37 writeI2C(0x01a7,0x1f);
sburg 0:f23c00f688b2 38 writeI2C(0x0030,0x00);
sburg 0:f23c00f688b2 39 //recommended initialization
sburg 0:f23c00f688b2 40 writeI2C(0x0011,0x10);// Enables polling for ‘New Sample ready’ when measurement completes
sburg 0:f23c00f688b2 41 writeI2C(0x010a,0x30);// Set the averaging sample period (compromise between lower noise and increased execution time)
sburg 0:f23c00f688b2 42 writeI2C(0x003f,0x46);// Sets the light and dark gain (upper nibble). Dark gain should not be changed.
sburg 0:f23c00f688b2 43 writeI2C(0x0031,0xFF);// sets the # of range measurements after which auto calibration of system is performed
sburg 0:f23c00f688b2 44 writeI2C(0x0040,0x63);// Set ALS integration time to 100ms
sburg 0:f23c00f688b2 45 writeI2C(0x002e,0x01);// perform a single temperature calibration of the ranging sensor
sburg 0:f23c00f688b2 46 //optional initialization
sburg 0:f23c00f688b2 47 writeI2C(0x001b,0x09);// Set default ranging inter-measurement period to 100ms
sburg 0:f23c00f688b2 48 writeI2C(0x003e,0x31);// Set default ALS inter-measurement period to 500ms
sburg 0:f23c00f688b2 49 writeI2C(0x0014,0x24);// Configures interrupt on ‘New Sample Ready threshold event’
sburg 0:f23c00f688b2 50
sburg 0:f23c00f688b2 51 writeI2C(0x016,0x00);//change fresh out of set status to 0
sburg 0:f23c00f688b2 52 }
sburg 0:f23c00f688b2 53 }
sburg 0:f23c00f688b2 54
sburg 0:f23c00f688b2 55 float VL6180::read() {
sburg 0:f23c00f688b2 56 char status;
sburg 0:f23c00f688b2 57 char retn;
sburg 0:f23c00f688b2 58
sburg 0:f23c00f688b2 59 writeI2C(0x18, 0x01);
sburg 0:f23c00f688b2 60
sburg 0:f23c00f688b2 61 status = readI2C(0x4F);
sburg 3:5d61f202b1bd 62 while((status & 0x7) != 4) {
sburg 0:f23c00f688b2 63 status = readI2C(0x4F);
sburg 0:f23c00f688b2 64 }
sburg 0:f23c00f688b2 65
sburg 0:f23c00f688b2 66 retn = readI2C(0x62);
sburg 0:f23c00f688b2 67
sburg 0:f23c00f688b2 68 writeI2C(0x15, 0x07);
sburg 0:f23c00f688b2 69
sburg 0:f23c00f688b2 70 return (float)retn / 10.0;
sburg 0:f23c00f688b2 71 }
sburg 0:f23c00f688b2 72
sburg 0:f23c00f688b2 73 VL6180::operator float() {
sburg 0:f23c00f688b2 74 return read();
sburg 0:f23c00f688b2 75 }
sburg 0:f23c00f688b2 76
sburg 0:f23c00f688b2 77
sburg 0:f23c00f688b2 78 void VL6180::writeI2C(int reg, char data) {
sburg 0:f23c00f688b2 79 char dataout[3];
sburg 0:f23c00f688b2 80
sburg 0:f23c00f688b2 81 dataout[0] = (reg >> 8) & 0xFF;
sburg 0:f23c00f688b2 82 dataout[1] = reg & 0xFF;
sburg 0:f23c00f688b2 83 dataout[2] = data & 0xFF;
sburg 0:f23c00f688b2 84
sburg 0:f23c00f688b2 85 _i2c.write(_addr, dataout, 3);
sburg 0:f23c00f688b2 86 }
sburg 0:f23c00f688b2 87
sburg 0:f23c00f688b2 88 char VL6180::readI2C(int reg) {
sburg 0:f23c00f688b2 89 char dataout[2];
sburg 0:f23c00f688b2 90 char datain[1];
sburg 0:f23c00f688b2 91
sburg 0:f23c00f688b2 92 dataout[0] = (reg >> 8) & 0xFF;
sburg 0:f23c00f688b2 93 dataout[1] = reg & 0xFF;
sburg 0:f23c00f688b2 94
sburg 0:f23c00f688b2 95 _i2c.write(_addr, dataout, 2);
sburg 0:f23c00f688b2 96 _i2c.read(_addr, datain, 1);
sburg 0:f23c00f688b2 97
sburg 0:f23c00f688b2 98 return datain[0];
sburg 0:f23c00f688b2 99 }
sburg 0:f23c00f688b2 100