Voor Maarten

Dependencies:   MODSERIAL Servo mbed

Committer:
Jannes
Date:
Fri Oct 20 10:12:45 2017 +0000
Revision:
0:c41f256db1d4
Standard Servo Test

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Jannes 0:c41f256db1d4 1 // Continuously sweep the servo through it's full range
Jannes 0:c41f256db1d4 2 #include "mbed.h"
Jannes 0:c41f256db1d4 3 #include "Servo.h"
Jannes 0:c41f256db1d4 4 #include "MODSERIAL.h"
Jannes 0:c41f256db1d4 5
Jannes 0:c41f256db1d4 6 InterruptIn button3(D10);
Jannes 0:c41f256db1d4 7 Servo myservo(D9);
Jannes 0:c41f256db1d4 8 int k=0;
Jannes 0:c41f256db1d4 9
Jannes 0:c41f256db1d4 10 //Other
Jannes 0:c41f256db1d4 11 MODSERIAL pc(USBTX, USBRX);
Jannes 0:c41f256db1d4 12
Jannes 0:c41f256db1d4 13 int main() {
Jannes 0:c41f256db1d4 14 myservo.calibrate(0.005,60);
Jannes 0:c41f256db1d4 15 pc.baud(115200);
Jannes 0:c41f256db1d4 16 while(1) {
Jannes 0:c41f256db1d4 17 for(int i=0; i<100; i++) {
Jannes 0:c41f256db1d4 18 myservo = i/100;
Jannes 0:c41f256db1d4 19 wait(0.1);
Jannes 0:c41f256db1d4 20 float Posi = myservo.read();
Jannes 0:c41f256db1d4 21 pc.printf("\r Position = %.4f \n",Posi);
Jannes 0:c41f256db1d4 22 }
Jannes 0:c41f256db1d4 23 for(int i=100; i>0; i--) {
Jannes 0:c41f256db1d4 24 myservo = i/100;
Jannes 0:c41f256db1d4 25 wait(0.1);
Jannes 0:c41f256db1d4 26 float Posi = myservo.read();
Jannes 0:c41f256db1d4 27 pc.printf("\r Position = %.4f \n",Posi);
Jannes 0:c41f256db1d4 28 }
Jannes 0:c41f256db1d4 29 }
Jannes 0:c41f256db1d4 30 }