Diff: main.cpp

Revision:

0:0c5a2df4bdb6

diff -r 000000000000 -r 0c5a2df4bdb6 main.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Thu Jul 13 10:03:43 2017 +0000
@@ -0,0 +1,37 @@
+#include "mbed.h"
+#include "MotorDriverController.h"
+#include "constants.h"
+
+MDC motors[4];
+
+int main() {
+    for(int i = 0; i < 4;i++)
+    {
+        motors[i].setAddr(0,i);
+    }  
+    while(true) {
+        motors[0].write(0.7);
+        motors[1].write(-0.7);
+        motors[2].write(0);
+        motors[3].write(0);
+        
+        wait(2);
+        motors[0].write(0);
+        motors[1].write(0);
+        motors[2].write(0.7);
+        motors[3].write(-0.7);
+        
+        wait(2);
+        motors[0].write(0.7);
+        motors[1].write(0.7);
+        motors[2].write(0.7);
+        motors[3].write(0.7);
+        wait(2);
+        
+        motors[0].write(-0.7);
+        motors[1].write(-0.7);
+        motors[2].write(-0.7);
+        motors[3].write(-0.7);
+        wait(2);
+    }
+}