PangKai Sun
/
MercurySwitchMotorControl
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); } } }