banc test
Dependencies: BSP_DISCO_F429ZI LCD_DISCO_F429ZI mbed
Diff: main.cpp
- Revision:
- 1:6defa6d9b3c8
- Parent:
- 0:c5b6d7cd9939
--- a/main.cpp Thu Mar 22 11:04:04 2018 +0000 +++ b/main.cpp Fri Mar 23 06:41:39 2018 +0000 @@ -4,16 +4,16 @@ 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 - +AnalogIn bouton1(PF_3); //bouton gauche -> roue droite à accélérer +AnalogIn bouton2(PF_4); //bouton central -> aucune roue à accélérer +AnalogIn bouton3(PF_5); //bouton droit -> roue gauche à accélérer +float buton1, buton2, buton3; //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 led1(PG_7); //lente gauche +DigitalOut led2(PB_4); //rapide -DigitalOut led3(PA_8); //lente +DigitalOut led3(PA_8); //lente droite DigitalOut led4(PA_14); //rapide DigitalOut led5(PC_12); //arrêt @@ -34,57 +34,89 @@ led4=!led4; } } + + - - + int main(){ while(1){ //Arrêt - led1=0; + led1=0; led2=0; led3=0; led4=0; led5=1; + buton1=bouton1.read()*100; + buton2=bouton2.read()*100; + buton3=bouton3.read()*100; + //Lent - //capteur milieu - if(bouton1){ + //capteur milieu + while(buton2>95 && buton1<95 && buton3<95){ led5=0; //clignotement normal des deux LEDs lentes frequenceLED(1); frequenceLED(3); wait(0.3); - } + buton1=bouton1.read()*100; + buton2=bouton2.read()*100; + buton3=bouton3.read()*100; + } led1=0; + led3=0; //capteur gauche - if(bouton2){ + while(buton1>95 && buton2<95 && buton2<95){ led5=0; //clignotement normal LED droite frequenceLED(3); wait(0.3); - } + buton1=bouton1.read()*100; + buton2=bouton2.read()*100; + buton3=bouton3.read()*100; + } led3=0; //capteur droit - if(bouton3){ + while(buton3>95 && buton1<95 && buton2<95){ led5=0; //clignotement normal LED gauche frequenceLED(1); wait(0.3); - } + buton1=bouton1.read()*100; + buton2=bouton2.read()*100; + buton3=bouton3.read()*100; + } led1=0; -//Rapide +//Rapide //capteur gauche - while(bouton1 && bouton2){ + while(buton1>95 && buton2>95 && buton3<95){ led5=0; //clignotement rapide LED gauche - frequenceLED(2); + frequenceLED(3); wait(0.1); - } + buton1=bouton1.read()*100; + buton2=bouton2.read()*100; + buton3=bouton3.read()*100; + } led3=0; //capteur droit - while(bouton3 && bouton2){ + while(buton3>95 && buton2>95 && buton1<95){ led5=0; //clignotement rapide LED droite - frequenceLED(4); + frequenceLED(1); wait(0.1); - } + buton1=bouton1.read()*100; + buton2=bouton2.read()*100; + buton3=bouton3.read()*100; + } led1=0; + + //marche arrière + while(buton1>95 && buton2>95 && buton3>95){ + frequenceLED(2); + frequenceLED(4); + wait(0.2); + buton1=bouton1.read()*100; + buton2=bouton2.read()*100; + buton3=bouton3.read()*100;} + led2=0; + led4=0; } }