Diff: main.cpp

Revision:

0:fa523db3f4f5

Child:

1:5b9fa1823663

diff -r 000000000000 -r fa523db3f4f5 main.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Tue Oct 20 01:40:02 2015 +0000
@@ -0,0 +1,59 @@
+#include "mbed.h"
+
+PwmOut motor1_forward(PB_4);
+PwmOut motor1_reverse(PB_10);
+PwmOut motor2_forward(PA_7);
+PwmOut motor2_reverse(PB_6);
+
+DigitalOut myled(LED1);
+
+void rightForward(float speed);
+void leftForward(float speed);
+
+int main() {
+    rightForward(0.5);
+    leftForward(-0.5);
+   // mypwm.period_ms(10);
+    //mypwm.pulsewidth_ms(1);
+  
+    //printf("pwm set to %.2f %%\n", mypwm.read() * 100);
+    
+    while(1) {
+        myled = !myled;
+       wait(1);
+    }
+}
+
+void rightForward(float speed) {
+    if (speed == 0) {
+        motor1_forward = 1.0;
+        motor1_reverse = 1.0;
+    }
+    
+    if (speed > 0) {
+        motor1_forward = speed;
+        motor1_reverse = 0;
+    }
+    
+    else {
+        motor1_forward = 0;
+        motor1_reverse = -speed;
+    }
+}
+
+void leftForward(float speed) {
+    if (speed == 0) {
+        motor2_forward = 1.0;
+        motor2_reverse = 1.0;
+    }
+    
+    if (speed > 0) {
+        motor2_forward = speed;
+        motor2_reverse = 0;
+    }
+    
+    else {
+        motor2_forward = 0;
+        motor2_reverse = -speed;
+    }
+}
\ No newline at end of file