File content as of revision 4:4b093f9bd41c:

#include "mbed.h"
#include "Servo.h"
#include "Motor.h"

//DigitalIn Switch1(p16);
//DigitalIn Switch2(p17);
//DigitalIn Switch3(p18);
//DigitalIn Switch4(p19);

BusIn Switch(p16,p17,p18,p19);
BusOut LED(p5,p6,p7,p8,p11);

Motor m(p26,p29,p30);
Servo servo1(p21); //top    .39 to 1.02
Servo servo2(p22); //bottom .38 to .93


float servopos;
float motorspeed=.3;
int counter=0;
int counter1=0;

//float sw1=Switch1;
//float sw2=Switch2;
//float sw3=Switch3;
//float sw4=Switch4;

int main()
{
    while(1) {


        while (Switch==1) {


            for(servopos=.40; servopos<=.60; servopos+=.03) {
                servo1=.7;
                servo2=servopos;
                motorspeed=0;
                m.speed(motorspeed);
                counter=counter+1;
                counter1=counter%20;
                if (counter1==17) {
                    LED=rand()%129;
                }
                wait (.1);
            }
            for(servopos=.60; servopos>=.40; servopos-=.03) {
                servo1=.7;
                servo2=servopos;
                motorspeed=0;
                m.speed(motorspeed);
                counter=counter+1;
                counter1=counter%20;
                if (counter1==17) {
                    LED=rand()%129;
                }
                wait (.1);
            }
        }//Swartzwelder  swartzwe.usna.edu
        while(Switch==2) {


            for(servopos=.40; servopos<=.60; servopos+=.03) {
                servo1=servopos+.2;
                servo2=.5;
                motorspeed=0;
                m.speed(motorspeed);
                counter=counter+1;
                counter1=counter%20;
                if (counter1==17) {
                    LED=rand()%129;
                }
                wait (.03);
            }
            for(servopos=.60; servopos>=.40; servopos-=.03) {
                servo1=servopos+.2;
                servo2=.5;
                motorspeed=0;
                m.speed(motorspeed);
                counter=counter+1;
                counter1=counter%20;
                if (counter1==17) {
                    LED=rand()%129;
                }
                wait (.03);
            }
        }
        while(Switch==4) {

            for(servopos=.40; servopos<=.60; servopos+=.03) {
                servo1=servopos+.2;
                servo2=servopos;
                counter=counter+1;
                counter1=counter%20;
                if (counter1==17) {
                    LED=rand()%129;
                }
                wait (.02);
            }
            for(servopos=.60; servopos>=.40; servopos-=.03) {
                servo1=servopos+.2;
                servo2=servopos;
                counter=counter+1;
                counter1=counter%20;
                if (counter1==17) {
                    LED=rand()%129;
                }
                wait (.02);
            }
        }

        while(Switch==8) {
            motorspeed=.31;
            m.speed(motorspeed);
            for(servopos=.40; servopos<=.60; servopos+=.03) {
                servo1=servopos+.2;
                servo2=servopos;
                m.speed(motorspeed);
                counter=counter+1;
                counter1=counter%20;
                if (counter1==17) {
                    LED=rand()%129;
                }
                wait (.025);
            }
            for(servopos=.60; servopos>=.40; servopos-=.03) {
                servo1=servopos+.2;
                servo2=servopos;
                m.speed(motorspeed);
                counter=counter+1;
                counter1=counter%20;
                if (counter1==17) {
                    LED=rand()%129;
                }
                wait (.025);
            }
        }

        while(Switch==0) {
            servo1=.7;
            servo2=.5;
            motorspeed=0;
            m.speed(motorspeed);
        }
    }
}