Diff: main.cpp

Revision:

0:db9e971c8ba6

Child:

1:33ef833aae0b

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Sun Oct 19 23:38:13 2014 +0000
@@ -0,0 +1,128 @@
+#include "mbed.h"
+#include "Servo.h"
+#include "Motor.h"
+
+DigitalIn Switch1(p16);
+DigitalIn Switch2(p17);
+DigitalIn Switch3(p18);
+DigitalIn Switch4(p19);
+
+BusOut LED(p5,p6,p7,p8,p11);
+
+DigitalOut servo1(p21);
+DigitalOut servo2(p22);
+DigitalOut motor(p29); //Don't know if this is correct
+
+int sw1=Switch1;
+int sw2=Switch2;
+int sw3=Switch3;
+int sw4=Switch4;
+
+int servopos;
+int servoposition;
+int motorspeed=motor;
+int counter=0;
+int counter1=0;
+
+int main()
+{
+    while (1) {
+        while (sw1==1) {
+            for(servopos=.38; servopos<=.51; servopos+=.001) {
+                servo1=servopos;
+                servo2=servopos;
+                motorspeed=.35;
+                counter=counter+1;
+                counter1=counter%20;
+                if (counter1==17) {
+                    LED=rand()%129;
+                }
+                wait (.005);
+            }
+             for(servopos=.51; servopos<=.38; servopos+=.001) {
+                        servo1=servopos;
+                        servo2=servopos;
+                        motorspeed=.35;
+                        counter=counter+1;
+                        counter1=counter%20;
+                        if (counter1==17) {
+                            LED=rand()%129;
+                        }
+                        wait (.005);
+                        }
+        }
+        while(sw2==1) {
+            for(servopos=.38; servopos<=.51; servopos+=.001) {
+                servo1=servopos;
+                servo2=servopos;
+                motorspeed=.41;
+                counter=counter+1;
+                counter1=counter%20;
+                if (counter1==17) {
+                    LED=rand()%129;
+                }
+                wait (.003);
+            }
+             for(servopos=.51; servopos<=.38; servopos+=.001) {
+                        servo1=servopos;
+                        servo2=servopos;
+                        motorspeed=.41;
+                        counter=counter+1;
+                        counter1=counter%20;
+                        if (counter1==17) {
+                            LED=rand()%129;
+                        }
+                        wait (.003);
+                        }
+        }
+        while(sw3==1) {
+            for(servopos=.38; servopos<=.51; servopos+=.001) {
+                servo1=servopos;
+                servo2=servopos;
+                motorspeed=.47;
+                counter=counter+1;
+                counter1=counter%20;
+                if (counter1==17) {
+                    LED=rand()%129;
+                }
+                wait (.002);
+            }
+             for(servopos=.51; servopos<=.38; servopos+=.001) {
+                        servo1=servopos;
+                        servo2=servopos;
+                        motorspeed=.47;
+                        counter=counter+1;
+                        counter1=counter%20;
+                        if (counter1==17) {
+                            LED=rand()%129;
+                        }
+                        wait (.002);
+                        }
+        }
+        while(sw4==1) {
+            for(servopos=.38; servopos<=.51; servopos+=.001) {
+                servo1=servopos;
+                servo2=servopos;
+                motorspeed=.77;
+                counter=counter+1;
+                counter1=counter%20;
+                if (counter1==17) {
+                    LED=rand()%129;
+                }
+                wait (.001);
+            }
+            for(servopos=.51; servopos<=.38; servopos+=.001) {
+                servo1=servopos;
+                servo2=servopos;
+                motorspeed=.77;
+                counter=counter+1;
+                counter1=counter%20;
+                if (counter1==17) {
+                    LED=rand()%129;
+                }
+                wait (.001);
+            }
+        }
+
+    }
+}
\ No newline at end of file