LPC1768でのサーボモータのホーン位置調整プログラム

Dependencies:   mbed

main.cpp

Committer:
oichan
Date:
2017-11-04
Revision:
0:89bba5c3dc7e
Child:
1:9aa0d40e58ac

File content as of revision 0:89bba5c3dc7e:


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