サーボテスタ

Dependencies:   mbed

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers main.cpp Source File

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