Diff: motors.cpp

Revision:

16:ae65ce77b1f9

Parent:

10:0714feaaaee1

Child:

18:48246daf0c06

--- a/motors.cpp	Wed Sep 16 12:31:54 2020 +0000
+++ b/motors.cpp	Fri Oct 02 21:09:45 2020 +0000
@@ -4,9 +4,11 @@
 void drv_init()
 {
     mot_dis();
-    motGauche_fwd();
-    //motDroite_fwd();
-    motDroite_bck();
+    motGauche_bck();
+    motDroite_fwd();
+
+    //motGauche_fwd();
+    //motDroite_bck();
     drvGauche.moveLinSpeed(0.01);
     drvDroite.moveLinSpeed(0.01);
     //mode = 0b111; // M0, M1 et M2 sont à 1
@@ -14,7 +16,7 @@
     mode_M0 = 1;
     //mode_M1 = 1;
     //mode_M2 = 1;
-    
+
     //mot_en();
 }
 
@@ -78,6 +80,16 @@
     //drvDroite.setDir(BACKWARD);
 }
 
+void vitesseMotG(int vitesse)
+{
+    drvGauche.moveLinSpeed((double)vitesse/1000);
+}
+
+void vitesseMotD(int vitesse)
+{
+    drvDroite.moveLinSpeed((double)vitesse/1000);
+}
+
 
 // FONCTIONS TESTS
 //