X-Git-Url: http://git.piffa.net/web?p=rover;a=blobdiff_plain;f=prototypes%2Fmotor%2Fdrive%2Fdrive.ino;fp=prototypes%2Fmotor%2Fdrive%2Fdrive.ino;h=8c0c8e9db84d91c99333be17eeab06fe0175bc8f;hp=0000000000000000000000000000000000000000;hb=e5ee18ad49f4c9c25628e3925e51352083b18ced;hpb=ca67a73d0b0c3e654431b7675327a9c4bd88ba3e

diff --git a/prototypes/motor/drive/drive.ino b/prototypes/motor/drive/drive.ino
new file mode 100644
index 0000000..8c0c8e9
--- /dev/null
+++ b/prototypes/motor/drive/drive.ino
@@ -0,0 +1,76 @@
+/* L298n motor
+Aggiunta
+
+Guida 2WD composta da 2 motori
+
+- 2 motori DC
+- L298n module
+- Batteria > 6v
+
+*/
+
+#include <rover.h>
+
+void setup() {
+    abilita();
+}
+
+
+void loop() {
+// Avanti
+    avanti();
+    delay(2000);
+// Stop
+    stop();
+    delay(1000);
+
+// TurnSX
+    turnSX();
+    delay(1000);
+
+// Avanti
+    avanti();
+    delay(2000);
+// Stop
+    stop();
+    delay(1000);
+
+
+// TurnDX
+    turnDX();
+    delay(1000);
+
+// Stop
+    stop();
+    delay(1000);
+}
+
+// Functions
+void avanti() {
+    // Drive ahead: funzione composita
+    forwardA() ;
+    forwardB() ;
+}
+
+void indietro() {
+    // Drive backward: funzione composita
+    backwardA();
+    backwardB();
+}
+
+void turnDX() {
+    // Gira a DX
+    forwardB() ;
+    backwardA();
+}
+
+void turnSX() {
+    // Gira a DX
+    forwardA() ;
+    backwardB();
+}
+
+void stop() {
+    stopA();
+    stopB();
+}