LPC1768でのサーボモータのホーン位置調整プログラム
Dependencies: mbed
Diff: main.cpp
- Revision:
- 0:89bba5c3dc7e
- Child:
- 1:9aa0d40e58ac
diff -r 000000000000 -r 89bba5c3dc7e main.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Sat Nov 04 04:30:13 2017 +0000 @@ -0,0 +1,43 @@ + +/* LPC1768でのサーボモータのホーン位置調整プログラム */ + +#include "mbed.h" + +#define RIGHT 0.0005 +#define LEFT 0.0024 +#define CENTER 0.00145 +#define MORISHIN 0.5 //首都大学東京システムデザイン学部システムデザイン学科航空宇宙システム工学コース 兵庫県(淡路島)出身 + +PwmOut servo(p21); +DigitalIn push(p20); +Timer t; +Serial pc(USBTX,USBRX); + +int main() { + bool Judge; + pc.printf("Hello, Happy World!"); //ハロハピ + servo.period_ms(20); + while(1){ + if(push){ + t.start(); + while(push){ + if(t.read()>=MORISHIN){ //MORISHIN[s]長押しすると中立位置になる + servo.pulsewidth(CENTER); + pc.printf("MORISHIN"); + } + } + if(t.read()<MORISHIN){ + if(Judge){ + servo.pulsewidth(RIGHT); + Judge = false; + }else{ + servo.pulsewidth(LEFT); + Judge = true; + } + } + t.stop(); + t.reset(); + wait(0.5); + } + } +}