Diff: motors.cpp

Revision:

0:dc036b67c87c

Child:

1:2fe8c402ee79

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/motors.cpp	Wed Jul 08 19:51:28 2020 +0000
@@ -0,0 +1,44 @@
+#include "pins.h"
+
+void drv_init(){
+    mot_dis();
+}
+
+void test_drv(){
+    mot_en();
+    motGauche_fwd();
+    drvGauche.move(1);  
+    wait(2);
+    motGauche_bck();
+    wait(2);
+    mot_dis();
+}
+
+// ENABLE/DISABLE // Les deux modules ont le même enable
+void mot_en(){
+    drvGauche.setEnable(START);
+    //drvDroite.setEnable(START);
+}
+
+void mot_dis(){
+    drvGauche.setEnable(STOP);
+    //drvDroite.setEnable(STOP);
+}
+
+// FORWARD
+void motGauche_fwd(){
+    drvGauche.setDir(FORWARD);
+}
+
+void motDroite_fwd(){
+    drvDroite.setDir(FORWARD);
+}
+
+// BACKWARD
+void motGauche_bck(){
+    drvGauche.setDir(BACKWARD);
+}
+
+void motDroite_bck(){
+    drvDroite.setDir(BACKWARD);
+}
\ No newline at end of file