add servos

Dependencies:   Servo1 mbed

Fork of ES200_Project2 by Project 2

main.cpp

Committer:
m211656
Date:
2018-10-18
Revision:
1:852f86d263c8
Parent:
0:b6a454c0b00a

File content as of revision 1:852f86d263c8:

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

Servo myservo(p21);
Servo myservo2(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()
{
    while(1) 
    {
        wait(0.5);
        if(sw5==1) { //servo1 off
            lights=31;
            printf("light 5 is on\n\r");
        }
        else if(sw4==1) { //dc motor off
            lights=15;
            printf("light 4 is on\n\r");
            m.speed(0.0);
            }
        else if(sw3==1) { //servo2 on
            lights=7;
            printf("light 3 is on\n\r");
            }
        else if(sw2==1) { //dc motor on
            lights=3;
            printf("light 2 is on\n\r");
            m.speed(1.0);
            }
        else if(sw1==1) { //servo1 comes on
            lights=1;
             printf("light 1 is on\n\r");
            }
        else {
            lights=0; //no switches on = no lights or motors on
            m.speed(0.0);}
        
    }
}