M9 Biorobotics Group 8 / Mbed 2 deprecated Servomotor

servo motor

Dependencies:   mbed QEI Servo HIDScope MODSERIAL FXOS8700Q FastPWM

main.cpp@0:fd4dd111fbd9, 2019-10-29 (annotated)

Committer:
IsaRobin
Date:
Tue Oct 29 13:36:02 2019 +0000
Revision:
0:fd4dd111fbd9
ServoMotor

Who changed what in which revision?

UserRevisionLine numberNew contents of line
IsaRobin 0:fd4dd111fbd9 1 #include "Servo.h"
IsaRobin 0:fd4dd111fbd9 2 #include "mbed.h"
IsaRobin 0:fd4dd111fbd9 3 #include "MODSERIAL.h"
IsaRobin 0:fd4dd111fbd9 4 #include "FastPWM.h"
IsaRobin 0:fd4dd111fbd9 5
IsaRobin 0:fd4dd111fbd9 6 // PC connection
IsaRobin 0:fd4dd111fbd9 7 MODSERIAL pc(USBTX, USBRX);
IsaRobin 0:fd4dd111fbd9 8
IsaRobin 0:fd4dd111fbd9 9 int main()
IsaRobin 0:fd4dd111fbd9 10 {
IsaRobin 0:fd4dd111fbd9 11 pc.baud(115200);
IsaRobin 0:fd4dd111fbd9 12 pc.printf("starting 1");
IsaRobin 0:fd4dd111fbd9 13 Servo myservo(D3);
IsaRobin 0:fd4dd111fbd9 14 int pos1 = 1000;
IsaRobin 0:fd4dd111fbd9 15 int posperiod = 20000;
IsaRobin 0:fd4dd111fbd9 16 myservo.Enable(pos1,posperiod);
IsaRobin 0:fd4dd111fbd9 17
IsaRobin 0:fd4dd111fbd9 18 while(true) {
IsaRobin 0:fd4dd111fbd9 19 pc.printf("starting");
IsaRobin 0:fd4dd111fbd9 20 for (int pos = 1000; pos < 2000; pos += 25) {
IsaRobin 0:fd4dd111fbd9 21 myservo.SetPosition(pos);
IsaRobin 0:fd4dd111fbd9 22 wait_ms(20);
IsaRobin 0:fd4dd111fbd9 23 }
IsaRobin 0:fd4dd111fbd9 24 for (int pos = 2000; pos > 1000; pos -= 25) {
IsaRobin 0:fd4dd111fbd9 25 myservo.SetPosition(pos);
IsaRobin 0:fd4dd111fbd9 26 wait_ms(20);
IsaRobin 0:fd4dd111fbd9 27 }
IsaRobin 0:fd4dd111fbd9 28 }
IsaRobin 0:fd4dd111fbd9 29 }