File content as of revision 2:c95e4e33eaee:

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

Motor m(p26,p29,p30);
Servo servo1(p21);
Servo servo2(p22);


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

int main()
{
    while (1) {
        int sw1=Switch1;
        int sw2=Switch2;
        int sw3=Switch3;
        int sw4=Switch4;
        
        while (sw1==1) {
            m.speed(motorspeed);
            motorspeed=.35;
            for(servopos=.48; servopos<=.68; servopos+=.005) {
                servo1=servopos+.07;
                servo2=servopos;
                counter=counter+1;
                counter1=counter%20;
                if (counter1==17) {
                    LED=rand()%129;
                }
                wait (.01);
            }
            for(servopos=.68; servopos>=.48; servopos-=.005) {
                servo1=servopos+.07;
                servo2=servopos;
                counter=counter+1;
                counter1=counter%20;
                if (counter1==17) {
                    LED=rand()%129;
                }
                wait (.01);
            }
        }
        while(sw2==1) {
            m.speed(motorspeed);
            motorspeed=.41;
            for(servopos=.48; servopos<=.68; servopos+=.005) {
                servo1=servopos+.07;
                servo2=servopos;
                counter=counter+1;
                counter1=counter%20;
                if (counter1==17) {
                    LED=rand()%129;
                }
                wait (.009);
            }
            for(servopos=.68; servopos>=.48; servopos-=.005) {
                servo1=servopos+.07;
                servo2=servopos;
                counter=counter+1;
                counter1=counter%20;
                if (counter1==17) {
                    LED=rand()%129;
                }
                wait (.009);
            }
        }
        while(sw3==1) {
            m.speed(motorspeed);
            motorspeed=.47;
            for(servopos=.48; servopos<=.68; servopos+=.005) {
                servo1=servopos+.07;
                servo2=servopos;
                counter=counter+1;
                counter1=counter%20;
                if (counter1==17) {
                    LED=rand()%129;
                }
                wait (.008);
            }
            for(servopos=.68; servopos>=.48; servopos-=.005) {
                servo1=servopos+.07;
                servo2=servopos;
                counter=counter+1;
                counter1=counter%20;
                if (counter1==17) {
                    LED=rand()%129;
                }
                wait (.008);
            }
        }
        while(sw4==1) {
            m.speed(motorspeed);
            motorspeed=.77;
            for(servopos=.48; servopos<=.68; servopos+=.005) {
                servo1=servopos+.07;
                servo2=servopos;
                counter=counter+1;
                counter1=counter%20;
                if (counter1==17) {
                    LED=rand()%129;
                }
                wait (.005);
            }
            for(servopos=.68; servopos>=.48; servopos-=.005) {
                servo1=servopos+.07;
                servo2=servopos;
                counter=counter+1;
                counter1=counter%20;
                if (counter1==17) {
                    LED=rand()%129;
                }
                wait (.005);
            }
        }

    }
}