Test code

Dependencies:   mbed Motor Servo

main.cpp

Committer:
m215910
Date:
2018-10-19
Revision:
4:b4e19be17235
Parent:
3:638dced18d87

File content as of revision 4:b4e19be17235:

//Maria Satre, Riki Gagnon, Theo Boskov, Janelle Stewart
//Project 2
//Goat Launcher

//Libraries and mechanical directives

#include "mbed.h"
#include "Motor.h" //must change line 31 in Motor.cpp according to Lab
#include "Servo.h" //need Servo library

Motor m(p26, p30, p29); //designates the pins used by the motor
//Servo servo1(p21);
//Servo servo2(p22);
DigitalIn sw1(p16); //switches or buttons
DigitalIn bu1(p21); //Army man
DigitalIn bu2(p22); //Army man
DigitalIn bu3(p23); //Army man
//DigitalIn bu4(p); //Motor clockwise
//DigitalIn bu5(p); //Motor CC
DigitalOut leds[3]={p10, p11, p12};
//float pos = rand()/(float)RAND_MAX; //allows the servo to start at a random position 
//float pos2 = rand()/(float)RAND_MAX;
int sw1state, bu1state, bu2state, bu3state, bu4state, bu5state; //the state of the switch
int s=0.6; //speed of motor rotation - fairly slow so as to be exact


int main() {
    //servo1.calibrate(0.0009, 90.0); //need to calibrate the servos so they don't freak out
    //servo2.calibrate(0.0009, 90.0);
    //servo1=pos; //used to help calibrate
    //servo2=pos2;
    
    while(1) { //do we need while?
        //sw1state=sw1.read(); //read in switch state
        //bu1state=bu1.read();
        //bu2state=bu2.read();
        //bu3state=bu3.read();
        //bu4state=bu4.read();
        //bu5state=bu5.read();
        //pos=0;
        //pos2=0;
        
        sw1state=sw1.read(); //read in switch state
        
        if (sw1state == 1) { //if bu4 is on rotate motor fwd
            m.speed(-s);
            s=1;
            printf("hi");}
            else { //if bu5 is on rotate motor rev
            m.speed(s);
            s=0;}
            
            
        bu1state=bu1.read();
        bu2state=bu2.read();
        bu3state=bu3.read();
        
         
        if (bu1state == 0) { //if ARMY button is off light up LEDS
            leds[0]=1;}
        if (bu1state == 1) {
            leds[0]=0;}
        if (bu2state == 0) { //if ARMY button is off light up LEDS
            leds[1]=1;}
        if (bu2state == 1) {
            leds[1]=0;}
        if (bu3state == 0) { //if ARMY button is off light up LEDS
            leds[2]=1;}
        if (bu3state == 1) {
            leds[2]=0;}
        
        
        //if((sw1state) == 1) { //if switch is on move servos quickly to other angle
        //    (pos && pos2) = 1;}
        //if((sw1state) == 1) { //if switch is off move back
        //    (pos && pos2) = 0;}
        
    } //end while
} //end main