nmbbghgj

Dependencies:   mbed

Fork of Servo by Jasper Denkers

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?

UserRevisionLine numberNew 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 }