![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
Robot team project
Dependencies: QEI Motordriver ros_lib_melodic
Diff: sensor/Sensor.cpp
- Revision:
- 1:d5adc483bce0
- Parent:
- 0:57855aafa907
- Child:
- 2:c537f1ebad7b
--- a/sensor/Sensor.cpp Tue Oct 22 09:12:03 2019 +0000 +++ b/sensor/Sensor.cpp Tue Oct 22 09:41:35 2019 +0000 @@ -3,14 +3,10 @@ #include "Sensor.h" - - -Sensor::Sensor(char address, PinName sda, PinName scl, PinName shdn) +Sensor::Sensor(PinName sda, PinName scl, PinName shdn) : i2c(sda, scl), SHDN(shdn) { - addr = DEFAULT_SENSOR_ADDRESS; - init(); - addr = address; + addr = DEFAULT_SENSOR_ADDRESS; } /////////////////////////////////////////////////////////////////// @@ -62,9 +58,10 @@ return 0; } -void Sensor::startRange() +void Sensor::changeAddress(char address) { - writeByte(0x018,0x03); + setRegister(I2C_SLAVE_DEVICE_ADDRESS, address); + addr = address; } /////////////////////////////////////////////////////////////////// @@ -90,9 +87,10 @@ return range; } - - - +void Sensor::startRange() +{ + writeByte(0x018,0x03); +} void Sensor::pollRange() { @@ -122,6 +120,16 @@ writeByte(0x015,0x07); } +void Sensor::turnOff() +{ + SHDN = 0; +} + +void Sensor::turnOn() +{ + SHDN = 1; +} + /////////////////////////////////////////////////////////////////// // Update a VL6180X register ///////////////////////////////////////////////////////////////////