Six crescent shaped legs

Dependencies:   mbed

Revision:
29:f905e66e1a6f
Parent:
28:fd21faad6dd8
Child:
30:476ab400d765
--- a/main.cpp	Fri May 13 09:26:13 2016 +0000
+++ b/main.cpp	Tue May 17 16:49:13 2016 +0000
@@ -92,11 +92,16 @@
     
     while(1)
     {
-        int oldactive = active;
+        /*int oldactive = active;
         scanf("%d", &active);
         active--;
         ms[oldactive]->drive(0);
-        ms[active]->drive(0.25);
+        ms[active]->drive(0.25);*/
+        
+        for (int i = 0; i < MOTORS; i++)
+            pc.printf("%ld ", ms[i]->encoder.getCount());
+        pc.printf("\n");
+        
         //pc.printf("%d", active);
         //scanf("%f", &turn);
         //m.rotate(turn, 0.2);