Takeuchi Kouichi
/
20160301_Servo_Tester
サーボテスタ
LPC1114FNを使ったサーボテスタです。ラジコン用サーボのニュートラル出しや調整に使うことができます。ラジコン用モータコントローラ(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?
User | Revision | Line number | New 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 |