Diff: main.cpp

Revision:

3:f41f244de0b3

Parent:

2:924e2280acf4

Child:

4:28185f157011

Child:

5:7a63cb7ec666

diff -r 924e2280acf4 -r f41f244de0b3 main.cpp
--- a/main.cpp	Fri Nov 22 15:14:38 2019 +0000
+++ b/main.cpp	Fri Nov 29 12:46:05 2019 +0000
@@ -2,73 +2,68 @@
 #include "glibr.h"
 
 Serial USB_link(USBTX, USBRX);       // USB initialization
-glibr GSensor(D4,D5);                // I²C initialization : D4 = SDA ; D5 = SCL
+
+glibr capt1(D4,D5);                // I²C initialization : D4 = SDA ; D5 = SCL
+glibr capt2(D6,D7);                //                      D6 = SDA ; D7 = SCL
+glibr capt3(D8,D9);                //                      D8 = SDA ; D9 = SCL
 
+bool initialization(void)
+{
+    //  USB initialization
+    USB_link.baud(115200);
+    USB_link.format(8, SerialBase::None, 1);
+
+    // sensors initalization
+    if( (capt1.ginit())&& (capt1.enableLightSensor(true))&& (capt2.ginit())&& (capt2.enableLightSensor(true)) && (capt3.ginit())&& (capt3.enableLightSensor(true)) ) {
+        return true;
+    } else {
+        return false;
+    }
+}
 
 int main (void)
 {
-
-    USB_link.baud(115200);
-    USB_link.format(8, SerialBase::None, 1);
-    uint16_t r,g,b,a;
-    if (GSensor.ginit()) {
-        USB_link.printf("APDS-9960 initialization complete\n\r");
+    int i;
+    uint16_t r[3],g[3],b[3],a[3];
+    if (initialization()) {
+        USB_link.printf("Initialization complete \r\n");
     } else {
-        USB_link.printf("Something went wrong during APDS-9960 init\n\r");
-    }
-//    GSensor.disableGestureSensor();
-//    GSensor.disableProximitySensor();
-    if( GSensor.enableLightSensor(true)) {  // enables light sensor
-        USB_link.printf("light sensor enabled\n\r");
-    } else {
-        USB_link.printf("Something went wrong with the light sensor\n\r");
+        USB_link.printf("Error during initialization\r\n");
     }
     
-    /*    if(GSensor.setLEDDrive(0x00)) {  // led current : 100mA
-            USB_link.printf("led current set at 100 mA\n\r");
-        } else {
-            USB_link.printf("Something went wrong during LED initialization\n\r");
-        }*/
     while(1) {
-        //r = GSensor.getMode();
-        // USB_link.printf("mode :%hx ",r);
-        if (GSensor.readRedLight(r)) {
-           //  USB_link.printf("R:%4hu   ",r);
-        } else {
-            USB_link.printf("Something went wrong during red value reading\n\r");
-        }
-        
-        if (GSensor.readGreenLight(g)) {
-            //USB_link.printf("G:%4hu   ",g);
-        } else {
-            USB_link.printf("Something went wrong during green value reading\n\r");
+        capt1.readRedLight(r[0]);
+        capt1.readGreenLight(g[0]);
+        capt1.readBlueLight(b[0]) ;
+        capt1.readAmbientLight(a[0]);
+
+        capt2.readRedLight(r[1]);
+        capt2.readGreenLight(g[1]);
+        capt2.readBlueLight(b[1]) ;
+        capt2.readAmbientLight(a[1]);
+
+        capt3.readRedLight(r[2]);
+        capt3.readGreenLight(g[2]);
+        capt3.readBlueLight(b[2]) ;
+        capt3.readAmbientLight(a[2]);
+
+        // display of color
+        /*for(i=0; i<3; i++) {
+            if (a[i]>100) {
+                USB_link.printf("n  ||");
+            } else if (r[i] > g[i] ) {
+                USB_link.printf("r  ||");
+            } else if (g[i] > r[i] ) {
+                USB_link.printf("g  ||");
+            }
         }
-        
-        if (GSensor.readBlueLight(b)) {
-           //  USB_link.printf("B:%4hu   ",b);
-        } else {
-            USB_link.printf("Something went wrong during blue value reading\n\r");
-        }
-        
-        if (GSensor.readAmbientLight(a)) {
-            // USB_link.printf("light:%4hu\r\n",a);
-        } else {
-            USB_link.printf("Something went wrong during blue value reading\n\r");
-        }
+        USB_link.printf("\r\n");*/
 
-        // affichage couleur
-        if (a>100) {
-            USB_link.printf("no color \r\n");
-        }
-        else if (r > g ) {
-            USB_link.printf("red \r\n");
+        //display of red and green variables
+        for(i=0; i<3; i++) {
+            USB_link.printf("Capt%d r: %hu g : %hu  || ",i,r[i],g[i]);
         }
-        else if (g > r ) {
-            USB_link.printf("green \r\n");
-        }
-        
-
+        USB_link.printf("\r\n");
     }
-
     return 0;
 }
\ No newline at end of file