Takeuchi Kouichi / Mbed 2 deprecated 20160301_Servo_Tester

サーボテスタ

Dependencies:   mbed

LPC１１１４FNを使ったサーボテスタです。ラジコン用サーボのニュートラル出しや調整に使うことができます。ラジコン用モータコントローラ（ESC）の調整に使うこともできます。

main.cpp@0:ab75773ee4f5, 2016-03-01 (annotated)

Committer:
takeuchi
Date:
Tue Mar 01 03:46:56 2016 +0000
Revision:
0:ab75773ee4f5
LPC????FN??????????????????????????????????????I2CLCD????????????

Who changed what in which revision?

UserRevisionLine numberNew contents of line
takeuchi 0:ab75773ee4f5 1 // Servo Tester
takeuchi 0:ab75773ee4f5 2
takeuchi 0:ab75773ee4f5 3 #include "mbed.h"
takeuchi 0:ab75773ee4f5 4 #include "I2cLCD.h"
takeuchi 0:ab75773ee4f5 5
takeuchi 0:ab75773ee4f5 6 I2cLCD lcd(dp5,dp27,dp26); //sda scl reset
takeuchi 0:ab75773ee4f5 7 PwmOut servo1(dp18);
takeuchi 0:ab75773ee4f5 8 AnalogIn vr1_adc(dp9);
takeuchi 0:ab75773ee4f5 9
takeuchi 0:ab75773ee4f5 10 double vr1,pduty1;
takeuchi 0:ab75773ee4f5 11
takeuchi 0:ab75773ee4f5 12 #define ON 1
takeuchi 0:ab75773ee4f5 13 #define OFF 0
takeuchi 0:ab75773ee4f5 14 #define XON 0
takeuchi 0:ab75773ee4f5 15 #define XOFF 1
takeuchi 0:ab75773ee4f5 16
takeuchi 0:ab75773ee4f5 17 int main() {
takeuchi 0:ab75773ee4f5 18
takeuchi 0:ab75773ee4f5 19 lcd.cls();
takeuchi 0:ab75773ee4f5 20 lcd.locate(0,0);
takeuchi 0:ab75773ee4f5 21 lcd.printf("ServoSet");
takeuchi 0:ab75773ee4f5 22 wait(0.1);
takeuchi 0:ab75773ee4f5 23
takeuchi 0:ab75773ee4f5 24 while(1){
takeuchi 0:ab75773ee4f5 25 vr1=vr1_adc.read();
takeuchi 0:ab75773ee4f5 26 pduty1=(vr1+1.0)/1000;
takeuchi 0:ab75773ee4f5 27 servo1.pulsewidth(pduty1);
takeuchi 0:ab75773ee4f5 28 lcd.locate(0,1);
takeuchi 0:ab75773ee4f5 29 lcd.printf("%4.2fms",pduty1*1000);
takeuchi 0:ab75773ee4f5 30 wait(0.1);
takeuchi 0:ab75773ee4f5 31 }//while
takeuchi 0:ab75773ee4f5 32 }//main
takeuchi 0:ab75773ee4f5 33
takeuchi 0:ab75773ee4f5 34