![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
test Start!
main.cpp
- Committer:
- gaejun2
- Date:
- 2014-05-16
- Revision:
- 0:471306b12ae0
File content as of revision 0:471306b12ae0:
#include "mbed.h" #include "Servo.h" DigitalOut ledRed(LED_RED); DigitalOut ledBlue(LED_BLUE); DigitalOut ledGreen(LED_GREEN); Servo myservo(PTD4); //Serial pc(USBTX, USBRX); int main() { // printf("Servo Calibration Controls:\n"); // printf("1,2,3 - Position Servo (full left, middle, full right)\n"); // printf("4,5 - Decrease or Increase range\n"); float range = 0.0005; float position = 0.5; ledRed = 1; ledBlue = 1; ledGreen = 1; while(1) { /* switch(pc.getc()) { case '1': position = 0.0; break; case '2': position = 0.5; break; case '3': position = 1.0; break; case '4': range += 0.0001; break; case '5': range -= 0.0001; break; } printf("position = %.1f, range = +/-%0.4f\n", position, range);*/ ledRed = 0; position = 0.0; myservo.calibrate(range, 45.0); myservo = position; wait(2); ledRed = 1; ledBlue = 0; position = 0.5; myservo.calibrate(range, 45.0); myservo = position; wait(2); ledBlue = 1; ledGreen = 0; position = 1.0; myservo.calibrate(range, 45.0); myservo = position; wait(2); ledGreen = 1; } }