M9 Biorobotics Group 8 / Mbed 2 deprecated servomotorcode

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?

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