![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
test Start!
main.cpp@0:471306b12ae0, 2014-05-16 (annotated)
- 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?
User | Revision | Line number | New 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 |