M9 Biorobotics Group 8 / Mbed 2 deprecated servomotorcode

servo motor werkt eindelijk!!!! wiehoe!!!

Dependencies:   mbed QEI Servo HIDScope biquadFilter MODSERIAL FastPWM

main.cpp@2:f92eadfd1a27, 2019-10-29 (annotated)

Committer:
IsaRobin
Date:
Tue Oct 29 19:44:11 2019 +0000
Revision:
2:f92eadfd1a27
Parent:
1:1b33fd02e6b1
Child:
3:f30c2ded1a58
servo redelijk werkend 2.0;

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 2:f92eadfd1a27 19 myservo.Enable(1410,20000);
jasperkessels 0:009a005982e5 20
jasperkessels 0:009a005982e5 21 while(true) {
IsaRobin 2:f92eadfd1a27 22 pc.printf("starting.\r.\n");
IsaRobin 2:f92eadfd1a27 23
IsaRobin 2:f92eadfd1a27 24 for (int pos = 1410; pos < 1590; pos += 5) {
jasperkessels 0:009a005982e5 25 myservo.SetPosition(pos);
jasperkessels 0:009a005982e5 26 wait_ms(20);
jasperkessels 0:009a005982e5 27 }
IsaRobin 2:f92eadfd1a27 28 pc.printf("kant 1.\r.\n");
IsaRobin 2:f92eadfd1a27 29 for (int pos = 1590; pos > 1410; pos -= 5) {
jasperkessels 0:009a005982e5 30 myservo.SetPosition(pos);
jasperkessels 0:009a005982e5 31 wait_ms(20);
jasperkessels 0:009a005982e5 32 }
IsaRobin 2:f92eadfd1a27 33 pc.printf("kant 2.\r.\n");
jasperkessels 0:009a005982e5 34 }
jasperkessels 0:009a005982e5 35
jasperkessels 0:009a005982e5 36 }
jasperkessels 0:009a005982e5 37
jasperkessels 0:009a005982e5 38
jasperkessels 0:009a005982e5 39