Diff: main.cpp

Revision:

0:cb674e873f8e

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Mon Oct 12 17:54:27 2015 +0000
@@ -0,0 +1,82 @@
+#include "mbed.h"
+#include "Motor.h"
+#include "Servo.h"
+
+
+
+Motor m(p25,p27,p28);
+Servo mservo(p24);
+Servo mservo1(p23);
+
+float i = 0.0;
+float j = 0.0;
+
+int main()
+{
+
+    mservo.calibrate(.0009,90);
+    mservo1.calibrate(.0009,90);
+
+    m.speed(i);
+    while(1) {
+
+        if (i!=1) {
+
+            for(i=0.2; i<=1.0; i=i+.1 ) {
+
+                m.speed(i);
+
+                for( j=0.0; j<=1.0; j=j+0.001 ) {
+
+                    mservo = j ;
+                    mservo1 = (1-j);
+                    wait(.005);
+
+                }
+
+                m.speed(-i);
+
+                for( j=1.0 ; j>=0.0; j=j-0.001 ) {
+
+                    mservo = j ;
+                    mservo1 = (1-j);
+                    wait(.005);
+
+                }
+
+            }
+
+        }
+
+        else if (i>=1) {
+
+            m.speed(i);
+
+            for( j=0.0; j<=1.0; j=j+0.001 ) {
+
+                mservo = j ;
+                mservo1 = (1-j);
+                wait(.005);
+
+            }
+
+            m.speed(-i);
+
+            for( j=1.0 ; j>=0.0; j=j-0.001 ) {
+
+                mservo = j ;
+                mservo1 = (1-j);
+                wait(.005);
+
+            }
+
+        }
+
+    }
+
+}
+
+
+
+
+