Takeuchi Kouichi
/
20160301_Servo_Tester
サーボテスタ
LPC1114FNを使ったサーボテスタです。ラジコン用サーボのニュートラル出しや調整に使うことができます。ラジコン用モータコントローラ(ESC)の調整に使うこともできます。
main.cpp
- Committer:
- takeuchi
- Date:
- 2016-03-01
- Revision:
- 0:ab75773ee4f5
File content as of revision 0:ab75773ee4f5:
// Servo Tester #include "mbed.h" #include "I2cLCD.h" I2cLCD lcd(dp5,dp27,dp26); //sda scl reset PwmOut servo1(dp18); AnalogIn vr1_adc(dp9); double vr1,pduty1; #define ON 1 #define OFF 0 #define XON 0 #define XOFF 1 int main() { lcd.cls(); lcd.locate(0,0); lcd.printf("ServoSet"); wait(0.1); while(1){ vr1=vr1_adc.read(); pduty1=(vr1+1.0)/1000; servo1.pulsewidth(pduty1); lcd.locate(0,1); lcd.printf("%4.2fms",pduty1*1000); wait(0.1); }//while }//main