Diff: main.cpp

Revision:

2:fab667092434

Parent:

1:1997f5ee08bc

--- a/main.cpp	Sat Sep 05 22:49:48 2015 +0000
+++ b/main.cpp	Tue Oct 06 19:34:09 2015 +0000
@@ -3,13 +3,33 @@
 #include "mbed.h"
 #include "Motor.h"
 
-AnalogIn pot(p20);
-Motor m(p25, p6, p5); // pwm, fwd, rev
+//AnalogIn pot(p20);
+//Motor m(p21, p17, p18); // pwm, fwd, rev
+Motor mA(p25, p6, p5); // pwm, fwd, rev
+Motor mB(p26, p7, p8);//pwm, fwd, rev
+DigitalOut STBY(p10);
+//Serial pc(USBTX, USBRX);
 
 int main() {
+    STBY = 1;
     while (true)
     {
-       m.speed((pot-1.65f)/1.65f);
-       wait(0.02);
+       //pc.printf("analogin%2f\n",pot.read());
+       //m.speed((pot.read()-0.5f)/0.5f);
+       mA.speed(0.5f);
+       mB.speed(0.5f);
+       wait(5.0);
+       mA.speed(-0.5f);
+       mB.speed(-0.5f);
+       wait(5.0);
+       mA.speed(0.5f);
+       mB.speed(0.0f);
+       wait(5.0);
+       mA.speed(0.0f);
+       mB.speed(0.5f);
+       wait(5.0);
+       mA.speed(0.0f);
+       mB.speed(0.0f);
+       wait(1.0);
     }
 }
\ No newline at end of file