servo

Dependencies:   Servo mbed

Committer:
dantg
Date:
Tue Oct 30 12:54:24 2018 +0000
Revision:
0:eb4e1282a821
Servo with Sensor;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
dantg 0:eb4e1282a821 1 #include "mbed.h"
dantg 0:eb4e1282a821 2 #include "Servo.h"
dantg 0:eb4e1282a821 3
dantg 0:eb4e1282a821 4 Serial pc(USBTX, USBRX); // USB serial interface
dantg 0:eb4e1282a821 5 Servo my_srv(p21); // continuous rotation hobby servo
dantg 0:eb4e1282a821 6 DigitalIn snsr30(p17);
dantg 0:eb4e1282a821 7 DigitalIn snsr150(p18);
dantg 0:eb4e1282a821 8 #define CR_SCALE 12.0
dantg 0:eb4e1282a821 9 int main() {
dantg 0:eb4e1282a821 10 // set the USB serial interface baud rate
dantg 0:eb4e1282a821 11 pc.baud(921600);
dantg 0:eb4e1282a821 12
dantg 0:eb4e1282a821 13 my_srv.calibrate(0.001,45);
dantg 0:eb4e1282a821 14 while(1) {
dantg 0:eb4e1282a821 15 if(snsr30 > 0.8) {
dantg 0:eb4e1282a821 16 my_srv.write(0.1666666);
dantg 0:eb4e1282a821 17 }
dantg 0:eb4e1282a821 18 wait(0.5);
dantg 0:eb4e1282a821 19 else {
dantg 0:eb4e1282a821 20 my_srv.write(0.5);
dantg 0:eb4e1282a821 21 }
dantg 0:eb4e1282a821 22 wait(0.5);
dantg 0:eb4e1282a821 23 if(snsr150 > 0.8) {
dantg 0:eb4e1282a821 24 my_srv.write(0.8333333);
dantg 0:eb4e1282a821 25 }
dantg 0:eb4e1282a821 26 wait(0.5);
dantg 0:eb4e1282a821 27 else {
dantg 0:eb4e1282a821 28 my_srv.write(0.5);
dantg 0:eb4e1282a821 29 }
dantg 0:eb4e1282a821 30 wait(0.5);
dantg 0:eb4e1282a821 31 }
dantg 0:eb4e1282a821 32 }
dantg 0:eb4e1282a821 33