in de avond na marnick1
Dependencies: mbed Servo MODSERIAL FXOS8700Q
main.cpp@0:009a005982e5, 2019-10-29 (annotated)
- Committer:
- jasperkessels
- Date:
- Tue Oct 29 19:12:00 2019 +0000
- Revision:
- 0:009a005982e5
servo_jasper_savonds;
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); |
jasperkessels | 0:009a005982e5 | 10 | Servo myservo(D3); |
jasperkessels | 0:009a005982e5 | 11 | |
jasperkessels | 0:009a005982e5 | 12 | |
jasperkessels | 0:009a005982e5 | 13 | int main() |
jasperkessels | 0:009a005982e5 | 14 | { |
jasperkessels | 0:009a005982e5 | 15 | myservo.Enable(1500,20000); |
jasperkessels | 0:009a005982e5 | 16 | |
jasperkessels | 0:009a005982e5 | 17 | while(true) { |
jasperkessels | 0:009a005982e5 | 18 | pc.printf("starting"); |
jasperkessels | 0:009a005982e5 | 19 | for (int pos = 1000; pos < 2000; pos += 25) { |
jasperkessels | 0:009a005982e5 | 20 | myservo.SetPosition(pos); |
jasperkessels | 0:009a005982e5 | 21 | wait_ms(20); |
jasperkessels | 0:009a005982e5 | 22 | } |
jasperkessels | 0:009a005982e5 | 23 | for (int pos = 2000; pos > 1000; pos -= 25) { |
jasperkessels | 0:009a005982e5 | 24 | myservo.SetPosition(pos); |
jasperkessels | 0:009a005982e5 | 25 | wait_ms(20); |
jasperkessels | 0:009a005982e5 | 26 | } |
jasperkessels | 0:009a005982e5 | 27 | } |
jasperkessels | 0:009a005982e5 | 28 | |
jasperkessels | 0:009a005982e5 | 29 | } |
jasperkessels | 0:009a005982e5 | 30 | |
jasperkessels | 0:009a005982e5 | 31 | |
jasperkessels | 0:009a005982e5 | 32 |