pierre masala
/
Servo
nmbbghgj
Fork of Servo by
main.cpp@3:9640475cdfbe, 2017-12-07 (annotated)
- Committer:
- pierre11
- Date:
- Thu Dec 07 15:01:47 2017 +0000
- Revision:
- 3:9640475cdfbe
- Parent:
- 2:49ad86fca628
- Child:
- 4:707923a648dc
oui;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
pierre11 | 2:49ad86fca628 | 1 | #include "mbed.h" |
pierre11 | 2:49ad86fca628 | 2 | #include "Servo.h" |
pierre11 | 2:49ad86fca628 | 3 | int main(int argc, char* argv[]) |
pierre11 | 2:49ad86fca628 | 4 | { |
pierre11 | 2:49ad86fca628 | 5 | Servo Servo1(PD_13); |
pierre11 | 3:9640475cdfbe | 6 | Servo Servo2(PD_12); |
pierre11 | 3:9640475cdfbe | 7 | Servo Servo3(PD_14); |
pierre11 | 3:9640475cdfbe | 8 | Servo Servo4(PD_15); |
pierre11 | 2:49ad86fca628 | 9 | |
pierre11 | 2:49ad86fca628 | 10 | Servo1.Enable(1500,20000); |
pierre11 | 3:9640475cdfbe | 11 | Servo2.Enable(1500,20000); |
pierre11 | 3:9640475cdfbe | 12 | Servo3.Enable(1500,20000); |
pierre11 | 3:9640475cdfbe | 13 | // Servo4.Enable(1500,20000); |
pierre11 | 2:49ad86fca628 | 14 | |
pierre11 | 2:49ad86fca628 | 15 | while(1) { |
pierre11 | 3:9640475cdfbe | 16 | for (int pos = 500; pos < 2000; pos += 25) |
pierre11 | 2:49ad86fca628 | 17 | { |
pierre11 | 2:49ad86fca628 | 18 | Servo1.SetPosition(pos); |
pierre11 | 2:49ad86fca628 | 19 | wait_ms(20); |
pierre11 | 2:49ad86fca628 | 20 | } |
pierre11 | 3:9640475cdfbe | 21 | for (int pos = 2000; pos > 500; pos -= 25) { |
pierre11 | 2:49ad86fca628 | 22 | Servo1.SetPosition(pos); |
pierre11 | 2:49ad86fca628 | 23 | wait_ms(20); |
pierre11 | 2:49ad86fca628 | 24 | } |
pierre11 | 3:9640475cdfbe | 25 | |
pierre11 | 3:9640475cdfbe | 26 | //================================ |
pierre11 | 3:9640475cdfbe | 27 | for (int pos = 500; pos < 2000; pos += 25) |
pierre11 | 3:9640475cdfbe | 28 | { |
pierre11 | 3:9640475cdfbe | 29 | Servo2.SetPosition(pos); |
pierre11 | 3:9640475cdfbe | 30 | wait_ms(20); |
pierre11 | 3:9640475cdfbe | 31 | } |
pierre11 | 3:9640475cdfbe | 32 | for (int pos = 2000; pos > 500; pos -= 25) { |
pierre11 | 3:9640475cdfbe | 33 | Servo2.SetPosition(pos); |
pierre11 | 3:9640475cdfbe | 34 | wait_ms(20); |
pierre11 | 3:9640475cdfbe | 35 | } |
pierre11 | 3:9640475cdfbe | 36 | |
pierre11 | 3:9640475cdfbe | 37 | //============================ |
pierre11 | 3:9640475cdfbe | 38 | for (int pos = 500; pos < 2000; pos += 25) |
pierre11 | 3:9640475cdfbe | 39 | { |
pierre11 | 3:9640475cdfbe | 40 | Servo3.SetPosition(pos); |
pierre11 | 3:9640475cdfbe | 41 | wait_ms(20); |
pierre11 | 3:9640475cdfbe | 42 | } |
pierre11 | 3:9640475cdfbe | 43 | for (int pos = 2000; pos > 500; pos -= 25) { |
pierre11 | 3:9640475cdfbe | 44 | Servo3.SetPosition(pos); |
pierre11 | 3:9640475cdfbe | 45 | wait_ms(20); |
pierre11 | 3:9640475cdfbe | 46 | } |
pierre11 | 3:9640475cdfbe | 47 | |
pierre11 | 3:9640475cdfbe | 48 | //============================ |
pierre11 | 3:9640475cdfbe | 49 | for (int pos = 0; pos < 2600; pos += 25) |
pierre11 | 3:9640475cdfbe | 50 | { |
pierre11 | 3:9640475cdfbe | 51 | Servo4.SetPosition(pos); |
pierre11 | 3:9640475cdfbe | 52 | wait_ms(20); |
pierre11 | 3:9640475cdfbe | 53 | } |
pierre11 | 3:9640475cdfbe | 54 | for (int pos = 2600; pos > 0; pos -= 25) { |
pierre11 | 3:9640475cdfbe | 55 | Servo4.SetPosition(pos); |
pierre11 | 3:9640475cdfbe | 56 | wait_ms(20); |
pierre11 | 3:9640475cdfbe | 57 | } |
pierre11 | 3:9640475cdfbe | 58 | |
pierre11 | 3:9640475cdfbe | 59 | //=========================== |
pierre11 | 2:49ad86fca628 | 60 | } |
pierre11 | 2:49ad86fca628 | 61 | return 0; |
pierre11 | 2:49ad86fca628 | 62 | } |