banc test

Dependencies:   BSP_DISCO_F429ZI LCD_DISCO_F429ZI mbed

main.cpp

Committer:
RpzEnsea4ever
Date:
2018-03-22
Revision:
0:c5b6d7cd9939
Child:
1:6defa6d9b3c8

File content as of revision 0:c5b6d7cd9939:

#include "mbed.h"
#include "LCD_DISCO_F429ZI.h"

LCD_DISCO_F429ZI lcd;


DigitalIn bouton1(PF_1); //bouton gauche -> roue droite à accélérer
DigitalIn bouton2(PF_0); //bouton central -> aucune roue à accélérer
DigitalIn bouton3(PE_6); //bouton droit -> roue gauche à accélérer

//LEDs correspondent à la vitesse du moteur (droit(1,2) ou gauche(3,4) ou arrêt)

DigitalOut led1(PG_7); //lente
DigitalOut led2(PC_8); //rapide

DigitalOut led3(PA_8); //lente
DigitalOut led4(PA_14); //rapide

DigitalOut led5(PC_12); //arrêt



void frequenceLED(int indice){
    if (indice==1){
        led1=!led1;
        }
    else if (indice==2){
        led2=!led2;
        }
    else if (indice==3){
        led3=!led3;
        }
    else if (indice==4){
        led4=!led4;        
        }
}  
    
        

int main(){     
    while(1){ 
//Arrêt
         led1=0;
         led2=0;
         led3=0;
         led4=0;
         led5=1;
//Lent    
        //capteur milieu
         if(bouton1){
             led5=0;
             //clignotement normal des deux LEDs lentes
             frequenceLED(1);
             frequenceLED(3);
             wait(0.3);
             }

        //capteur gauche
         if(bouton2){
             led5=0;
             //clignotement normal LED droite
             frequenceLED(3);
             wait(0.3);
        }      
        //capteur droit
         if(bouton3){
             led5=0;
             //clignotement normal LED gauche
             frequenceLED(1);
             wait(0.3);
        } 

//Rapide             
        //capteur gauche
         while(bouton1 && bouton2){
             led5=0;
             //clignotement rapide LED gauche
             frequenceLED(2);
             wait(0.1);
         }    
        //capteur droit
         while(bouton3 && bouton2){
             led5=0;
             //clignotement rapide LED droite
             frequenceLED(4);
             wait(0.1);
             }         
     }
}