Robot team project

Dependencies:   QEI Motordriver ros_lib_melodic

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
 ///////////////////////////////////////////////////////////////////