File content as of revision 3:48d837d59ae7:

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

Servo clamp(p21);
Servo toppings(p22);
Motor m(p26,p30,p29);
DigitalIn sw1(p15), sw2(p16), sw3(p17), sw4(p18), sw5(p19);
BusOut lights(p5,p6,p7,p8,p9);


int main()
{
    clamp.calibrate(0.0009,90); 
    toppings.calibrate(0.0009, 90);
    toppings=1.0;
    while(1) 
    {
        wait(0.5);
        if(sw5==1) { //clamp open, dc motor off
            lights=31;
            printf("light 5 is on\n\r");//Prof said to leave this in to prove our code works
            m.speed(0.0);
            wait(0.02);
            clamp=0.5;
        }
        else if(sw4==1) { //dc motor on
            lights=15;
            printf("light 4 is on\n\r");//Prof said to leave this is to prove our code works
            m.speed(0.5);
            }
        else if(sw3==1) { //toppings return
            lights=7;
            toppings=1.0;
            }
        else if(sw2==1) { //toppings dump
            lights=3;
            toppings=0.8;
            
            }
        else if(sw1==1) { //clamp turns on
            lights=1;
            clamp=0.12;
            }
        else {
            lights=0; //no switches on = no lights, DC motor off
            m.speed(0.0);
            }
        
    }
}