It begins

Dependencies:   SDFileSystem mbed-rtos mbed wave_player

Fork of BAT_senior_design by BAT

main.cpp

Committer:
nnguyen45
Date:
2017-10-04
Revision:
1:4347df0fafb1
Parent:
0:9eda4611081a
Child:
2:6836f515bb50

File content as of revision 1:4347df0fafb1:

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

PwmOut myservo(p21);
DigitalIn pb1 (p20);
//AnalogIn linpot(p20);
Serial pc(USBTX, USBRX);
DigitalOut myled(LED1);

int main()
{
    // button up: state = 0, button halfway: state = 1; button down: state = 2
    //int state = 0;
    //Nhi
    pc.printf("begin\n");
    int state = 2;
    pb1.mode(PullUp);
    wait(.001);
    for(int i=0; i<=3; i++) {
        myservo = i/100.0;
        wait(0.01);
    }
    while(1) {
        // Servo code
        if (pb1 == 1 && state == 2) {
            while(pb1 == 1)
                myled = 1;
            // rotate 90 degrees one way
            for(int i=3; i<=7; i++) {
                myservo = i/100.0;
                wait(0.01);
            }
            state = 1;
        }
        //wait(1.0);
        // rotate 90 degrees other way
        if (pb1 == 1 && state == 1) {
            while(pb1 == 1)
                myled = 0;
            for(int i=7; i>3; i--) {
                myservo = i/100.0;
                wait(0.01);
            }
            //wait(0.1);
            state = 2;
        }
        //wait(1.0);

        // read linear potentiometer
        //if (linpot < 0.5) {
        //float potval = linpot;
        //pc.printf("linear pot: %f\n", potval);
    }
}