in de avond na marnick1

Dependencies:   mbed Servo MODSERIAL FXOS8700Q

Committer:
jasperkessels
Date:
Tue Oct 29 19:12:00 2019 +0000
Revision:
0:009a005982e5
servo_jasper_savonds;

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);
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