Dependencies:   Motor mbed

main.cpp

Committer:
hankpkai
Date:
2017-03-11
Revision:
0:2c78f6dc3dea

File content as of revision 0:2c78f6dc3dea:

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

//DigitalOut led(LED1);
DigitalIn sw1(p5);
DigitalIn sw2(p6); 
BusOut led(LED1,LED2,LED3,LED4);
Motor m(p21, p11, p12); // pwm, fwd, rev

int main() {
    led = 0;
    m.speed(0);
    int count = 3;
    float speed = 0;
    while(1) {
    
        if(sw1 == 0 && count < 5)    
        {   
            count ++;
            speed +=0.5;
            m.speed(speed);
            if(count == 3)
                led =0;
            else if (count == 1)
                led = 0x1;
            else if (count == 2)
                led = 0x2;
            else if (count == 4)
                led = 0x4;
            else if (count == 5)
                led = 0x8;
            wait(1);
            
        }
        
        else if(sw2 == 0 && count>0  )
        {
            count --;
            speed -=0.5;
            m.speed(speed);
            if(count == 3)
                led =0;
            else if (count == 1)
                led = 0x1;
            else if (count == 2)
                led = 0x2;
            else if (count == 4)
                led = 0x4;
            else if (count == 5)
                led = 0x8;
            
            wait(1);
        }    
    }
}