servo motor werkt eindelijk!!!! wiehoe!!!
Dependencies: mbed QEI Servo HIDScope biquadFilter MODSERIAL FastPWM
main.cpp@1:1b33fd02e6b1, 2019-10-29 (annotated)
- Committer:
- IsaRobin
- Date:
- Tue Oct 29 19:29:45 2019 +0000
- Revision:
- 1:1b33fd02e6b1
- Parent:
- 0:009a005982e5
- Child:
- 2:f92eadfd1a27
servo motor redelijk werkend;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
jasperkessels | 0:009a005982e5 | 1 | /* servo motor program - biorbotics groep 8 */ |
jasperkessels | 0:009a005982e5 | 2 | |
jasperkessels | 0:009a005982e5 | 3 | #include <Servo.h> |
jasperkessels | 0:009a005982e5 | 4 | #include <mbed.h> |
jasperkessels | 0:009a005982e5 | 5 | #include <math.h> /* cos */ |
jasperkessels | 0:009a005982e5 | 6 | #include <MODSERIAL.h> |
jasperkessels | 0:009a005982e5 | 7 | |
jasperkessels | 0:009a005982e5 | 8 | |
jasperkessels | 0:009a005982e5 | 9 | MODSERIAL pc(USBTX, USBRX); |
IsaRobin | 1:1b33fd02e6b1 | 10 | |
IsaRobin | 1:1b33fd02e6b1 | 11 | |
jasperkessels | 0:009a005982e5 | 12 | Servo myservo(D3); |
jasperkessels | 0:009a005982e5 | 13 | |
jasperkessels | 0:009a005982e5 | 14 | |
jasperkessels | 0:009a005982e5 | 15 | int main() |
jasperkessels | 0:009a005982e5 | 16 | { |
IsaRobin | 1:1b33fd02e6b1 | 17 | pc.baud(115200); |
IsaRobin | 1:1b33fd02e6b1 | 18 | pc.printf("starting main .\r.\n"); |
IsaRobin | 1:1b33fd02e6b1 | 19 | myservo.Enable(1500,20000); |
jasperkessels | 0:009a005982e5 | 20 | |
jasperkessels | 0:009a005982e5 | 21 | while(true) { |
jasperkessels | 0:009a005982e5 | 22 | pc.printf("starting"); |
IsaRobin | 1:1b33fd02e6b1 | 23 | for (int pos = 1000; pos < 2000; pos += 10) { |
jasperkessels | 0:009a005982e5 | 24 | myservo.SetPosition(pos); |
jasperkessels | 0:009a005982e5 | 25 | wait_ms(20); |
jasperkessels | 0:009a005982e5 | 26 | } |
IsaRobin | 1:1b33fd02e6b1 | 27 | for (int pos = 2000; pos > 1000; pos -= 10) { |
jasperkessels | 0:009a005982e5 | 28 | myservo.SetPosition(pos); |
jasperkessels | 0:009a005982e5 | 29 | wait_ms(20); |
jasperkessels | 0:009a005982e5 | 30 | } |
jasperkessels | 0:009a005982e5 | 31 | } |
jasperkessels | 0:009a005982e5 | 32 | |
jasperkessels | 0:009a005982e5 | 33 | } |
jasperkessels | 0:009a005982e5 | 34 | |
jasperkessels | 0:009a005982e5 | 35 | |
jasperkessels | 0:009a005982e5 | 36 |