test Start!

Dependencies:   Servo mbed

Committer:
gaejun2
Date:
Fri May 16 15:47:52 2014 +0000
Revision:
0:471306b12ae0
test Success! pulse control OK! T = 20ms

Who changed what in which revision?

UserRevisionLine numberNew contents of line
gaejun2 0:471306b12ae0 1 #include "mbed.h"
gaejun2 0:471306b12ae0 2 #include "Servo.h"
gaejun2 0:471306b12ae0 3
gaejun2 0:471306b12ae0 4 DigitalOut ledRed(LED_RED);
gaejun2 0:471306b12ae0 5 DigitalOut ledBlue(LED_BLUE);
gaejun2 0:471306b12ae0 6 DigitalOut ledGreen(LED_GREEN);
gaejun2 0:471306b12ae0 7
gaejun2 0:471306b12ae0 8 Servo myservo(PTD4);
gaejun2 0:471306b12ae0 9 //Serial pc(USBTX, USBRX);
gaejun2 0:471306b12ae0 10
gaejun2 0:471306b12ae0 11 int main() {
gaejun2 0:471306b12ae0 12 // printf("Servo Calibration Controls:\n");
gaejun2 0:471306b12ae0 13 // printf("1,2,3 - Position Servo (full left, middle, full right)\n");
gaejun2 0:471306b12ae0 14 // printf("4,5 - Decrease or Increase range\n");
gaejun2 0:471306b12ae0 15
gaejun2 0:471306b12ae0 16 float range = 0.0005;
gaejun2 0:471306b12ae0 17 float position = 0.5;
gaejun2 0:471306b12ae0 18
gaejun2 0:471306b12ae0 19 ledRed = 1;
gaejun2 0:471306b12ae0 20 ledBlue = 1;
gaejun2 0:471306b12ae0 21 ledGreen = 1;
gaejun2 0:471306b12ae0 22
gaejun2 0:471306b12ae0 23 while(1) {
gaejun2 0:471306b12ae0 24 /* switch(pc.getc()) {
gaejun2 0:471306b12ae0 25 case '1': position = 0.0; break;
gaejun2 0:471306b12ae0 26 case '2': position = 0.5; break;
gaejun2 0:471306b12ae0 27 case '3': position = 1.0; break;
gaejun2 0:471306b12ae0 28 case '4': range += 0.0001; break;
gaejun2 0:471306b12ae0 29 case '5': range -= 0.0001; break;
gaejun2 0:471306b12ae0 30 }
gaejun2 0:471306b12ae0 31 printf("position = %.1f, range = +/-%0.4f\n", position, range);*/
gaejun2 0:471306b12ae0 32 ledRed = 0;
gaejun2 0:471306b12ae0 33 position = 0.0;
gaejun2 0:471306b12ae0 34 myservo.calibrate(range, 45.0);
gaejun2 0:471306b12ae0 35 myservo = position;
gaejun2 0:471306b12ae0 36 wait(2);
gaejun2 0:471306b12ae0 37 ledRed = 1;
gaejun2 0:471306b12ae0 38
gaejun2 0:471306b12ae0 39 ledBlue = 0;
gaejun2 0:471306b12ae0 40 position = 0.5;
gaejun2 0:471306b12ae0 41 myservo.calibrate(range, 45.0);
gaejun2 0:471306b12ae0 42 myservo = position;
gaejun2 0:471306b12ae0 43 wait(2);
gaejun2 0:471306b12ae0 44 ledBlue = 1;
gaejun2 0:471306b12ae0 45
gaejun2 0:471306b12ae0 46 ledGreen = 0;
gaejun2 0:471306b12ae0 47 position = 1.0;
gaejun2 0:471306b12ae0 48 myservo.calibrate(range, 45.0);
gaejun2 0:471306b12ae0 49 myservo = position;
gaejun2 0:471306b12ae0 50 wait(2);
gaejun2 0:471306b12ae0 51 ledGreen = 1;
gaejun2 0:471306b12ae0 52
gaejun2 0:471306b12ae0 53 }
gaejun2 0:471306b12ae0 54 }
gaejun2 0:471306b12ae0 55