banc test

Dependencies:   BSP_DISCO_F429ZI LCD_DISCO_F429ZI mbed

Files at this revision

API Documentation at this revision

Comitter:
Alex_mln
Date:
Fri Mar 23 06:41:39 2018 +0000
Parent:
0:c5b6d7cd9939
Commit message:
Programme op

Changed in this revision

main.cpp Show annotated file Show diff for this revision Revisions of this file
--- 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;
      }
 }