CRAC Team / Mbed 2 deprecated Capt_couleur_CAN

Dependencies:   mbed APDS_9960

main.cpp

Committer:
guilhemMBED
Date:
2019-11-29
Revision:
3:f41f244de0b3
Parent:
2:924e2280acf4
Child:
4:28185f157011
Child:
5:7a63cb7ec666

File content as of revision 3:f41f244de0b3:

#include "mbed.h"
#include "glibr.h"

Serial USB_link(USBTX, USBRX);       // USB initialization

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)
{
    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("Error during initialization\r\n");
    }
    
    while(1) {
        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  ||");
            }
        }
        USB_link.printf("\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]);
        }
        USB_link.printf("\r\n");
    }
    return 0;
}