Diff: rgbSensor.h

Revision:

20:bd09cc476987

Parent:

2:b57d7156830c

--- a/rgbSensor.h	Tue Dec 11 02:09:08 2018 +0000
+++ b/rgbSensor.h	Tue Dec 11 02:27:20 2018 +0000
@@ -3,13 +3,14 @@
 {
 protected:
     I2C _i2c;
+    DigitalOut _led;
     int sensor_addr;
     int value_C;
     int value_R;
     int value_G;
     int value_B;
 public:
-    rgbSensor(PinName,PinName);
+    rgbSensor(PinName,PinName,PinName);
     void update();
     int get_C();
     int get_R();
@@ -17,8 +18,8 @@
     int get_B();
 };
 
-rgbSensor::rgbSensor(PinName sda, PinName scl) :
-    _i2c(sda, scl){
+rgbSensor::rgbSensor(PinName sda, PinName scl, PinName led) :
+    _i2c(sda, scl), _led(led){
     value_R = 0;
     value_G = 0;
     value_B = 0; 
@@ -30,6 +31,17 @@
     char data[1] = {0};
     _i2c.write(sensor_addr,id_regval,1, true);
     _i2c.read(sensor_addr,data,1,false);
+    
+    char timing_register[2] = {129,0};
+    _i2c.write(sensor_addr,timing_register,2,false);
+    
+    char control_register[2] = {143,0};
+    _i2c.write(sensor_addr,control_register,2,false);
+    
+    char enable_register[2] = {128,3};
+    _i2c.write(sensor_addr,enable_register,2,false);
+
+    _led = 1;
 }
 
 void rgbSensor::update()