pierre masala
/
Servo
nmbbghgj
Fork of Servo by
Diff: main.cpp
- Revision:
- 3:9640475cdfbe
- Parent:
- 2:49ad86fca628
- Child:
- 4:707923a648dc
--- a/main.cpp Wed Dec 06 16:51:21 2017 +0000 +++ b/main.cpp Thu Dec 07 15:01:47 2017 +0000 @@ -3,19 +3,60 @@ int main(int argc, char* argv[]) { Servo Servo1(PD_13); + Servo Servo2(PD_12); + Servo Servo3(PD_14); + Servo Servo4(PD_15); Servo1.Enable(1500,20000); + Servo2.Enable(1500,20000); + Servo3.Enable(1500,20000); + // Servo4.Enable(1500,20000); while(1) { - for (int pos = 1000; pos < 2000; pos += 25) + for (int pos = 500; pos < 2000; pos += 25) { Servo1.SetPosition(pos); wait_ms(20); } - for (int pos = 2000; pos > 1000; pos -= 25) { + for (int pos = 2000; pos > 500; pos -= 25) { Servo1.SetPosition(pos); wait_ms(20); } + + //================================ + for (int pos = 500; pos < 2000; pos += 25) + { + Servo2.SetPosition(pos); + wait_ms(20); + } + for (int pos = 2000; pos > 500; pos -= 25) { + Servo2.SetPosition(pos); + wait_ms(20); + } + + //============================ + for (int pos = 500; pos < 2000; pos += 25) + { + Servo3.SetPosition(pos); + wait_ms(20); + } + for (int pos = 2000; pos > 500; pos -= 25) { + Servo3.SetPosition(pos); + wait_ms(20); + } + + //============================ + for (int pos = 0; pos < 2600; pos += 25) + { + Servo4.SetPosition(pos); + wait_ms(20); + } + for (int pos = 2600; pos > 0; pos -= 25) { + Servo4.SetPosition(pos); + wait_ms(20); + } + + //=========================== } return 0; } \ No newline at end of file