Takeuchi Kouichi
/
20160301_Servo_Tester
サーボテスタ
Embed:
(wiki syntax)
Show/hide line numbers
main.cpp
00001 // Servo Tester 00002 00003 #include "mbed.h" 00004 #include "I2cLCD.h" 00005 00006 I2cLCD lcd(dp5,dp27,dp26); //sda scl reset 00007 PwmOut servo1(dp18); 00008 AnalogIn vr1_adc(dp9); 00009 00010 double vr1,pduty1; 00011 00012 #define ON 1 00013 #define OFF 0 00014 #define XON 0 00015 #define XOFF 1 00016 00017 int main() { 00018 00019 lcd.cls(); 00020 lcd.locate(0,0); 00021 lcd.printf("ServoSet"); 00022 wait(0.1); 00023 00024 while(1){ 00025 vr1=vr1_adc.read(); 00026 pduty1=(vr1+1.0)/1000; 00027 servo1.pulsewidth(pduty1); 00028 lcd.locate(0,1); 00029 lcd.printf("%4.2fms",pduty1*1000); 00030 wait(0.1); 00031 }//while 00032 }//main 00033 00034
Generated on Tue Jul 19 2022 06:10:58 by 1.7.2