Diff: main.cpp

Revision:

2:9e6ed6302c78

Parent:

1:5160ea45399b

Child:

3:1425359662e4

diff -r 5160ea45399b -r 9e6ed6302c78 main.cpp
--- a/main.cpp	Sun Sep 21 06:39:30 2014 +0000
+++ b/main.cpp	Wed Dec 17 09:25:43 2014 +0000
@@ -1,12 +1,42 @@
 #include "mbed.h"
 
-PwmOut led(LED1);
+#define PWM_period 2500
+
+
+int valPWM1 = 1000;
+int valPWM2 = 1000;
+int valPWM3 = 1000;
+int valPWM4 = 1000;
+
+
+PwmOut motor1 (D10);
+PwmOut motor2 (D11);
+PwmOut motor3 (D12);
+PwmOut motor4 (D13);
+
 
 int main() {
-    // specify period first
-    led.period(4.0f);      // 4 second period
-    led.write(0.50f);      // 50% duty cycle, relative to period
-    //led = 0.5f;          // shorthand for led.write()
-    //led.pulsewidth(2);   // alternative to led.write, set duty cycle time in seconds
-    while(1);
+    
+    motor1.period_us(PWM_period);
+    motor2.period_us(PWM_period);
+    motor3.period_us(PWM_period);
+    motor4.period_us(PWM_period);
+    
+    while(1) {
+     
+    for (int i = 1000; i < 1500;i++)
+     {
+     
+     valPWM1 = i;
+     valPWM3 = i;
+     valPWM2 = 2500 - i;
+     valPWM4 = 2500 - i;
+     
+    motor1.pulsewidth_ms(valPWM1); 
+    motor2.pulsewidth_ms(valPWM2); 
+    motor3.pulsewidth_ms(valPWM3); 
+    motor4.pulsewidth_ms(valPWM4); 
+       }
+       
+    }
 }
\ No newline at end of file