1

Dependencies:   Servo mbed

Committer:
yu10078999
Date:
Fri Sep 02 12:21:55 2016 +0000
Revision:
0:34ffab30ac74
0

Who changed what in which revision?

UserRevisionLine numberNew contents of line
yu10078999 0:34ffab30ac74 1 #include "mbed.h"
yu10078999 0:34ffab30ac74 2 #include "Servo.h"
yu10078999 0:34ffab30ac74 3
yu10078999 0:34ffab30ac74 4 Servo myservo(D9);
yu10078999 0:34ffab30ac74 5 Serial pc(USBTX, USBRX);
yu10078999 0:34ffab30ac74 6
yu10078999 0:34ffab30ac74 7 int main() {
yu10078999 0:34ffab30ac74 8 printf("Servo Calibration Controls:\n");
yu10078999 0:34ffab30ac74 9 printf("1,2,3 - Position Servo (full left, middle, full right)\n");
yu10078999 0:34ffab30ac74 10 printf("4,5 - Decrease or Increase range\n");
yu10078999 0:34ffab30ac74 11
yu10078999 0:34ffab30ac74 12 float range = 0.0005;
yu10078999 0:34ffab30ac74 13 float position = 0.5;
yu10078999 0:34ffab30ac74 14
yu10078999 0:34ffab30ac74 15 while(1) {
yu10078999 0:34ffab30ac74 16 switch(pc.getc()) {
yu10078999 0:34ffab30ac74 17 case '1': position = 0.0; break;
yu10078999 0:34ffab30ac74 18 case '2': position = 0.5; break;
yu10078999 0:34ffab30ac74 19 case '3': position = 1.0; break;
yu10078999 0:34ffab30ac74 20 case '4': range += 0.0001f; break;
yu10078999 0:34ffab30ac74 21 case '5': range -= 0.0001f; break;
yu10078999 0:34ffab30ac74 22 }
yu10078999 0:34ffab30ac74 23 printf("position = %.1f, range = +/-%0.4f\n", position, range);
yu10078999 0:34ffab30ac74 24 myservo.calibrate(range, 45.0);
yu10078999 0:34ffab30ac74 25 myservo = position;
yu10078999 0:34ffab30ac74 26 }
yu10078999 0:34ffab30ac74 27 }