File content as of revision 2:c23c90a74ac6:

#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,p10,p11);


int main()
{
    clamp.calibrate(0.0009,90); 
    toppings.calibrate(0.0009, 90);
    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
            clamp=0.0;
            m.speed(0.0);
        }
        else if(sw4==1) { //dc motor off and reset toppings
            lights=15;
            printf("light 4 is on\n\r");//Prof said to leave this is to prove our code works
            m.speed(0.0);
            toppings=0.0;
            }
        else if(sw3==1) { //toppings dump
            lights=7;
            toppings=0.5;
            }
        else if(sw2==1) { //dc motor on
            lights=3;
            m.speed(1.0);
            }
        else if(sw1==1) { //clamp turns on
            lights=1;
            }
        else {
            lights=0; //no switches on = no lights, DC motor off
            m.speed(0.0);
            }
        
    }
}