Diff: main.cpp

Revision:

4:aafb0016ed84

Parent:

3:0b19b5b7c3a4

Child:

5:8c2101d3ecef

diff -r 0b19b5b7c3a4 -r aafb0016ed84 main.cpp
--- a/main.cpp	Wed May 31 18:35:50 2017 +0000
+++ b/main.cpp	Wed May 31 18:36:25 2017 +0000
@@ -16,7 +16,7 @@
 DigitalOut myled4(LED4);
 DigitalOut S2 (p11);
 
-int iCoefVirage=0.44;
+
 void Led (bool l1,bool l2,bool l3,bool l4){  //Fonction pour aider au debug avec les led
   
     myled1=l1;
@@ -29,6 +29,7 @@
      sbt.putc(Code); 
      sbt.putc(Vit);  
      sbt.putc((Adress+Code+Vit) & 127);
+     iActualSpeed=Vit;
     }
 
 void forward(char Vit) {
@@ -46,8 +47,8 @@
     emiss(0,Vit);
     emiss(5,Vit);   
     wait((Ang*iCoefVirage)/Vit);
-    emiss(1,0);
-    emiss(4,0);
+    emiss(0,0);
+    emiss(5,0);
     }
 void avancer(char Vit) {
      int i=0;
@@ -58,7 +59,7 @@
      }
 }
 void arreter(char Vit){
-     int i=Vit;
+     int i=iActualSpeed;
      for(i ; i>0;i=i-(Vit/5)){
          emiss(0,i);
          emiss(4,i);