Wansik Choi
/
linear_motor
linear motor code for ksk
Diff: main.cpp
- Revision:
- 2:81a944155520
- Parent:
- 1:ff295adcca59
--- a/main.cpp Fri Feb 24 16:06:21 2017 +0000 +++ b/main.cpp Sat Feb 25 08:14:13 2017 +0000 @@ -15,9 +15,19 @@ void move(double dis, double spd); void init(void); +void pause(void); +InterruptIn psw(PA_8); +DigitalIn psw_(PA_8); int main() { + + psw_.mode(PullUp); + pc.baud(230400); + if(psw_.read()) pc.printf("\n\rPause.... "); + while(psw_.read()); + pc.printf("Start"); + wait_ms(20); - pc.baud(230400); + psw.rise(&pause); lm.st=1; wait_ms(500); init(); @@ -89,4 +99,13 @@ i++; } pc.printf("Complete\n\r"); +} + +void pause(void){ + psw.disable_irq(); + wait_ms(20); + pc.printf("\n\rPause...."); + while(psw_.read()); + pc.printf(" Resume\n\r"); + psw.enable_irq(); } \ No newline at end of file