bubble blowing
/
Servo_with_IRSensor
servo
main.cpp@0:eb4e1282a821, 2018-10-30 (annotated)
- Committer:
- dantg
- Date:
- Tue Oct 30 12:54:24 2018 +0000
- Revision:
- 0:eb4e1282a821
Servo with Sensor;
Who changed what in which revision?
User | Revision | Line number | New 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 |