Mattéo

Dependencies:   mbed Pixy2_Library2

main.cpp

Committer:
benbrou06
Date:
2020-05-15
Revision:
0:fc353d12d2b1

File content as of revision 0:fc353d12d2b1:

#include "mbed.h"
#include "Pixy2_Library.h"
#define ADRESSE 0xa8

Serial pc(USBTX,USBRX);

int state = 3;
int X,X2,X3;
int Y,Y2,Y3;
int W,W2,W3;
int H,H2,H3;
int S,S2,S3;
int I,I2,I3;


int main()
{
    int A,A2,A3;
    pc.printf("Bienvenue sur Pixy2\n\r");

    Pixy2_Library Cam1(p28,p27,ADRESSE);

    //Cam1.Pixy2_WhiteLED(true);

    while(1) {
        
        switch(state) {
            case 0 :
                /*Cam1.Pixy2_SetServo(0,0);
                wait(0.5);
                Cam1.Pixy2_SetServo(500,0);
                wait(0.5);*/
                break;
            case 1 :
                pc.printf("_______________X positions____________________\n\r");
                X = Cam1.Pixy2_GetBlock('x',1);
                X2 = Cam1.Pixy2_GetBlock('x',2);
                X3 = Cam1.Pixy2_GetBlock('x',3);
                pc.printf("Position X = %d\n\r", X);
                pc.printf("Position X2 = %d\n\r", X2);
                pc.printf("Position X3 = %d\n\r", X3);
                break;
            case 2 :
                pc.printf("_______________Y positions____________________\n\r");
                Y = Cam1.Pixy2_GetBlock('y',1);
                Y2 = Cam1.Pixy2_GetBlock('y',2);
                Y3 = Cam1.Pixy2_GetBlock('y',3);
                pc.printf("Position Y = %d\n\r", Y);
                pc.printf("Position Y2 = %d\n\r", Y2);
                pc.printf("Position Y3 = %d\n\r", Y3);
                break;
            case 3 :
                pc.printf("__________________ALL___________________________\n\r");
                X = Cam1.Pixy2_GetBlock('x',1);
                Y = Cam1.Pixy2_GetBlock('y',1);
                W = Cam1.Pixy2_GetBlock('w',1);
                H = Cam1.Pixy2_GetBlock('h',1);
                S = Cam1.Pixy2_GetBlock('s',1);
                //A = Cam1.Pixy2_GetBlock('a',1);
                //I = Cam1.Pixy2_GetBlock('i',1);

                /*X2 = Cam1.Pixy2_GetBlock('x',2);
                Y2 = Cam1.Pixy2_GetBlock('y',2);
                W2 = Cam1.Pixy2_GetBlock('w',2);
                H2 = Cam1.Pixy2_GetBlock('h',2);
                S2 = Cam1.Pixy2_GetBlock('s',2);
                A2 = Cam1.Pixy2_GetBlock('a',2);
                I2 = Cam1.Pixy2_GetBlock('i',2);

                X3 = Cam1.Pixy2_GetBlock('x',3);
                Y3 = Cam1.Pixy2_GetBlock('y',3);
                W3 = Cam1.Pixy2_GetBlock('w',3);
                H3 = Cam1.Pixy2_GetBlock('h',3);
                S3 = Cam1.Pixy2_GetBlock('s',3);
                A3 = Cam1.Pixy2_GetBlock('a',3);
                I3 = Cam1.Pixy2_GetBlock('i',3);*/

                pc.printf("Signature du block = %d\n\r", S);
                pc.printf("Position X = %d\n\r", X);
                pc.printf("Position Y = %d\n\r", Y);
                pc.printf("Largeur = %d\n\r", W);
                pc.printf("Hauteur = %d\n\r", H);
                //pc.printf("Angle code-couleur = %d\n\r", A);
                //pc.printf("Indice de suivi du block = %d\n\r", I);


               /* pc.printf("______________________________\n\r");
                pc.printf("Signature du block 2 = %d\n\r", S2);
                pc.printf("Position X2 = %d\n\r", X2);
                pc.printf("Position Y2 = %d\n\r", Y2);
                pc.printf("Largeur 2 = %d\n\r", W2);
                pc.printf("Hauteur 2 = %d\n\r", H2);
                pc.printf("Angle code-couleur 2  = %d\n\r", A2);
                pc.printf("Indice de suivi du block 2  = %d\n\r", I2);


                pc.printf("______________________________\n\r");
                pc.printf("Signature du block 3 = %d\n\r", S3);
                pc.printf("Position X3 = %d\n\r", X3);
                pc.printf("Position Y3 = %d\n\r", Y3);
                pc.printf("Largeur 3 = %d\n\r", W3);
                pc.printf("Hauteur 3 = %d\n\r", H3);
                pc.printf("Angle code-couleur 3 = %d\n\r", A3);
                pc.printf("Indice de suivi du block 3 = %d\n\r", I3);*/
                break;
        }

        wait(0.3);
    }
}