CRAC Team / Mbed 2 deprecated Capt_couleur_CAN

Dependencies:   mbed APDS_9960

main.cpp

Committer:
guilhemMBED
Date:
2019-11-29
Revision:
4:28185f157011
Parent:
3:f41f244de0b3

File content as of revision 4:28185f157011:

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

Serial USB_link(USBTX, USBRX);     // USB initialization
PwmOut LCapt1(A2);                    // LEDs init
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);

    // LEDs initialization
    LCapt1.period_ms(10);
    LCapt1.write(0.5);
    
    // 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]>70) {
                USB_link.printf(" capt %d : n  ||",i);
            } else if (r[i] > g[i] ) {
                USB_link.printf(" capt %d : r  ||",i);
            } else if (g[i] > r[i] ) {
                USB_link.printf(" capt %d : g  ||",i);
            }
        }
        USB_link.printf("\r\n");

        //display of red and green variables
        /*
        for(i=0; i<3; i++) {
            USB_link.printf("Capt%d r: %2.hu g : %2.hu  || ",i,r[i],g[i]);
        }
        USB_link.printf("\r\n");
        */
    }
    return 0;
}