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);
}
}
}