sunday code for project. needs slight revision.

Dependencies:   Motor Servo22oct mbed

main.cpp

Committer:
KyleSchaff
Date:
2014-10-19
Revision:
0:db9e971c8ba6
Child:
1:33ef833aae0b

File content as of revision 0:db9e971c8ba6:

#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);
            }
        }

    }
}