サーボテスタ

Dependencies:   mbed

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