Test
VL6180.cpp
- Committer:
- brucewthomson
- Date:
- 2016-10-14
- Revision:
- 0:82297674d72d
File content as of revision 0:82297674d72d:
/****************************************************************************** * SFE_VL6180.cpp * Library for VL6180 time of flight range finder. * Casey Kuhns @ SparkFun Electronics * 10/29/2014 * https://github.com/sparkfun/ * * The VL6180 by ST micro is a time of flight range finder that * uses pulsed IR light to determine distances from object at close * range. The average range of a sensor is between 0-200mm * * In this file are the functions in the VL6180 class * * Resources: * This library uses the Arduino Wire.h to complete I2C transactions. * * Development environment specifics: * IDE: Arduino 1.0.5 * Hardware Platform: Arduino Pro 3.3V/8MHz * VL6180 Breakout Version: 1.0 * * * This code is beerware. If you see me (or any other SparkFun employee) at the * local pub, and you've found our code helpful, please buy us a round! * * Distributed as-is; no warranty is given. ******************************************************************************/ #include "VL6180.h" // // Constructors // VL6180::VL6180(PinName sda, PinName scl) : i2c(sda, scl) { VL6180_i2cAddress = VL6180_DEF_ADDR; } VL6180::VL6180(PinName sda, PinName scl, int i2cAddress) : i2c(sda, scl) { VL6180_i2cAddress = i2cAddress; VL6180_error_no = 0; } // // destructor // VL6180::~VL6180() { } int8_t VL6180::VL6180_Init(void) { uint8_t data; //for temp data storage data = VL6180_getRegister(VL6180_SYSTEM_FRESH_OUT_OF_RESET); if(data != 1) return VL6180_FAILURE_RESET; //Required by datasheet //http://www.st.com/st-web-ui/static/active/en/resource/technical/document/application_note/DM00122600.pdf VL6180_setRegister(0x0207, 0x01); VL6180_setRegister(0x0208, 0x01); VL6180_setRegister(0x0096, 0x00); VL6180_setRegister(0x0097, 0xfd); VL6180_setRegister(0x00e3, 0x00); VL6180_setRegister(0x00e4, 0x04); VL6180_setRegister(0x00e5, 0x02); VL6180_setRegister(0x00e6, 0x01); VL6180_setRegister(0x00e7, 0x03); VL6180_setRegister(0x00f5, 0x02); VL6180_setRegister(0x00d9, 0x05); VL6180_setRegister(0x00db, 0xce); VL6180_setRegister(0x00dc, 0x03); VL6180_setRegister(0x00dd, 0xf8); VL6180_setRegister(0x009f, 0x00); VL6180_setRegister(0x00a3, 0x3c); VL6180_setRegister(0x00b7, 0x00); VL6180_setRegister(0x00bb, 0x3c); VL6180_setRegister(0x00b2, 0x09); VL6180_setRegister(0x00ca, 0x09); VL6180_setRegister(0x0198, 0x01); VL6180_setRegister(0x01b0, 0x17); VL6180_setRegister(0x01ad, 0x00); VL6180_setRegister(0x00ff, 0x05); VL6180_setRegister(0x0100, 0x05); VL6180_setRegister(0x0199, 0x05); VL6180_setRegister(0x01a6, 0x1b); VL6180_setRegister(0x01ac, 0x3e); VL6180_setRegister(0x01a7, 0x1f); VL6180_setRegister(0x0030, 0x00); return 0; } void VL6180::VL6180_DefautSettings(void) { //Recommended settings from datasheet //http://www.st.com/st-web-ui/static/active/en/resource/technical/document/application_note/DM00122600.pdf //Enable Interrupts on Conversion Complete (any source) VL6180_setRegister(VL6180_SYSTEM_INTERRUPT_CONFIG_GPIO, (4 << 3)|(4) ); // Set GPIO1 high when sample complete VL6180_setRegister(VL6180_SYSTEM_MODE_GPIO1, 0x10); // Set GPIO1 high when sample complete VL6180_setRegister(VL6180_READOUT_AVERAGING_SAMPLE_PERIOD, 0x30); //Set Avg sample period VL6180_setRegister(VL6180_SYSALS_ANALOGUE_GAIN, 0x46); // Set the ALS gain VL6180_setRegister(VL6180_SYSRANGE_VHV_REPEAT_RATE, 0xFF); // Set auto calibration period (Max = 255)/(OFF = 0) VL6180_setRegister(VL6180_SYSALS_INTEGRATION_PERIOD, 0x63); // Set ALS integration time to 100ms VL6180_setRegister(VL6180_SYSRANGE_VHV_RECALIBRATE, 0x01); // perform a single temperature calibration //Optional settings from datasheet //http://www.st.com/st-web-ui/static/active/en/resource/technical/document/application_note/DM00122600.pdf VL6180_setRegister(VL6180_SYSRANGE_INTERMEASUREMENT_PERIOD, 0x09); // Set default ranging inter-measurement period to 100ms VL6180_setRegister(VL6180_SYSALS_INTERMEASUREMENT_PERIOD, 0x0A); // Set default ALS inter-measurement period to 100ms VL6180_setRegister(VL6180_SYSTEM_INTERRUPT_CONFIG_GPIO, 0x24); // Configures interrupt on ‘New Sample Ready threshold event’ //Additional settings defaults from community VL6180_setRegister(VL6180_SYSRANGE_MAX_CONVERGENCE_TIME, 0x32); VL6180_setRegister(VL6180_SYSRANGE_RANGE_CHECK_ENABLES, 0x10 | 0x01); VL6180_setRegister16bit(VL6180_SYSRANGE_EARLY_CONVERGENCE_ESTIMATE, 0x7B ); VL6180_setRegister16bit(VL6180_SYSALS_INTEGRATION_PERIOD, 0x64); VL6180_setRegister(VL6180_READOUT_AVERAGING_SAMPLE_PERIOD,0x30); VL6180_setRegister(VL6180_SYSALS_ANALOGUE_GAIN,0x40); VL6180_setRegister(VL6180_FIRMWARE_RESULT_SCALER,0x01); } void VL6180::getIdentification(struct VL6180Identification *temp) { temp->idModel = VL6180_getRegister(VL6180_IDENTIFICATION_MODEL_ID); temp->idModelRevMajor = VL6180_getRegister(VL6180_IDENTIFICATION_MODEL_REV_MAJOR); temp->idModelRevMinor = VL6180_getRegister(VL6180_IDENTIFICATION_MODEL_REV_MINOR); temp->idModuleRevMajor = VL6180_getRegister(VL6180_IDENTIFICATION_MODULE_REV_MAJOR); temp->idModuleRevMinor = VL6180_getRegister(VL6180_IDENTIFICATION_MODULE_REV_MINOR); temp->idDate = VL6180_getRegister16bit(VL6180_IDENTIFICATION_DATE); temp->idTime = VL6180_getRegister16bit(VL6180_IDENTIFICATION_TIME); } uint8_t VL6180::changeAddress(uint8_t old_address, uint8_t new_address) { //NOTICE: IT APPEARS THAT CHANGING THE ADDRESS IS NOT STORED IN NON-VOLATILE MEMORY // POWER CYCLING THE DEVICE REVERTS ADDRESS BACK TO 0X29 if( old_address == new_address) return old_address; if( new_address > 127) return old_address; VL6180_setRegister(VL6180_I2C_SLAVE_DEVICE_ADDRESS, new_address); return VL6180_getRegister(VL6180_I2C_SLAVE_DEVICE_ADDRESS); } uint8_t VL6180::getDistance() { VL6180_setRegister(VL6180_SYSRANGE_START, 0x01); //Start Single shot mode wait(0.01); // 10mS return VL6180_getRegister(VL6180_RESULT_RANGE_VAL); // VL6180_setRegister(VL6180_SYSTEM_INTERRUPT_CLEAR, 0x07); // return distance; } float VL6180::getAmbientLight(VL6180_als_gain VL6180_ALS_GAIN) { //First load in Gain we are using, do it everytime incase someone changes it on us. //Note: Upper nibble shoudl be set to 0x4 i.e. for ALS gain of 1.0 write 0x46 VL6180_setRegister(VL6180_SYSALS_ANALOGUE_GAIN, (0x40 | VL6180_ALS_GAIN)); // Set the ALS gain //Start ALS Measurement VL6180_setRegister(VL6180_SYSALS_START, 0x01); wait(0.1); //100Ms VL6180_setRegister(VL6180_SYSTEM_INTERRUPT_CLEAR, 0x07); //Retrieve the Raw ALS value from the sensoe unsigned int alsRaw = VL6180_getRegister16bit(VL6180_RESULT_ALS_VAL); //Get Integration Period for calculation, we do this everytime incase someone changes it on us. unsigned int alsIntegrationPeriodRaw = VL6180_getRegister16bit(VL6180_SYSALS_INTEGRATION_PERIOD); float alsIntegrationPeriod = 100.0 / alsIntegrationPeriodRaw ; //Calculate actual LUX from Appnotes float alsGain = 0.0; switch (VL6180_ALS_GAIN) { case GAIN_20: alsGain = 20.0; break; case GAIN_10: alsGain = 10.32; break; case GAIN_5: alsGain = 5.21; break; case GAIN_2_5: alsGain = 2.60; break; case GAIN_1_67: alsGain = 1.72; break; case GAIN_1_25: alsGain = 1.28; break; case GAIN_1: alsGain = 1.01; break; case GAIN_40: alsGain = 40.0; break; } //Calculate LUX from formula in AppNotes float alsCalculated = (float)0.32 * ((float)alsRaw / alsGain) * alsIntegrationPeriod; return alsCalculated; } // --- Private Functions --- // uint8_t VL6180::VL6180_getRegister(uint16_t reg_address) { char data[2]; data[0] = (reg_address >> 8) & 0xFF; //MSB of register address data[1] = reg_address & 0xFF; //LSB of register address VL6180_error_no = i2c.write(VL6180_i2cAddress, data, 2); VL6180_error_no = i2c.read(VL6180_i2cAddress, data, 1, false); return data[0]; } uint16_t VL6180::VL6180_getRegister16bit(uint16_t reg_address) { char data[2]; data[0] = (reg_address >> 8) & 0xFF; //MSB of register address data[1] = reg_address & 0xFF; //LSB of register address VL6180_error_no = i2c.write(VL6180_i2cAddress, data, 2); VL6180_error_no = i2c.read(VL6180_i2cAddress, data, 2, false); return (data[0] + ((data[1] << 8) & 0xFF00)); } void VL6180::VL6180_setRegister(uint16_t reg_address, uint8_t value) { char data[3]; data[0] = (reg_address >> 8) & 0xFF; //MSB of register address data[1] = reg_address & 0xFF; //LSB of register address data[2] = value; VL6180_error_no = VL6180_error_no = i2c.write(VL6180_i2cAddress, data, 3); } void VL6180::VL6180_setRegister16bit(uint16_t reg_address, uint16_t value) { char data[4]; data[0] = (reg_address >> 8) & 0xFF; //MSB of register address data[1] = reg_address & 0xFF; //LSB of register address data[2] = value & 0xFF; data[3] = ((value >> 8) & 0xFF); VL6180_error_no = VL6180_error_no = i2c.write(VL6180_i2cAddress, data, 4); } int VL6180::writeSingleRegister( uint16_t reg_address, uint8_t data ) { char data_write[3]; data_write[0] = (reg_address >> 8) & 0xFF; //MSB of register address data_write[1] = reg_address & 0xFF; //LSB of register address data_write[2] = data & 0xFF; return i2c.write(VL6180_DEF_ADDR, data_write, 3); // char tx[2] = { address | 160, data }; //0d160 = 0b10100000 // int ack = i2c.write( SLAVE_ADDRESS << 1, tx, 2 ); // return ack; }