エレキジャックweb mbed入門 サーボモータ 課題1です。サーボを左右に動かします。

Dependencies:   mbed

main.cpp

Committer:
takeuchi
Date:
2011-08-18
Revision:
0:3aa8ec194a4e

File content as of revision 0:3aa8ec194a4e:

//Servo test01
// Servo basic test
#include "mbed.h"
#include "TextLCD0420.h"

#define ON 1
#define OFF 0

DigitalOut mled0(LED1);
DigitalOut mled1(LED2);
AnalogIn vr_adc(p15);
PwmOut servo1(p21);

TextLCD lcd(p24, p25, p26, p27, p28, p29, p30,20,4); // rs, rw, e, d0, d1, d2, d3

int main() {
  float pwidth;
  lcd.cls();
  lcd.locate(0,0);
  lcd.printf("*** Servo test ****\n");         
  servo1.period_ms(20);// pulse cycle = 20ms

  while(1){   
    for(pwidth=0.001; pwidth<=0.002; pwidth+=0.0001) { // 1ms ~ 2ms
      servo1.pulsewidth(pwidth); // pulse servo out
      lcd.locate(0,1);
      lcd.printf("PulseWidth:%2.5f%",pwidth);
      wait(0.25);
    }
  }//while    
}//main