
Program to restrict the movement of servos by using ReedSwitch
main.cpp@0:73919552e1de, 2013-12-14 (annotated)
- Committer:
- gerardoeh
- Date:
- Sat Dec 14 18:01:16 2013 +0000
- Revision:
- 0:73919552e1de
For limit movement!! Go World
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
gerardoeh | 0:73919552e1de | 1 | #include "mbed.h" |
gerardoeh | 0:73919552e1de | 2 | #include "Servo.h" |
gerardoeh | 0:73919552e1de | 3 | |
gerardoeh | 0:73919552e1de | 4 | DigitalIn rSwitch(D10); |
gerardoeh | 0:73919552e1de | 5 | Servo servoRotado(D11); |
gerardoeh | 0:73919552e1de | 6 | |
gerardoeh | 0:73919552e1de | 7 | int valSwitch; |
gerardoeh | 0:73919552e1de | 8 | float pos=0; |
gerardoeh | 0:73919552e1de | 9 | |
gerardoeh | 0:73919552e1de | 10 | int main() { |
gerardoeh | 0:73919552e1de | 11 | rSwitch.mode(PullUp); |
gerardoeh | 0:73919552e1de | 12 | servoRotado.calibrate(0.001, 45.0); |
gerardoeh | 0:73919552e1de | 13 | while(1) { |
gerardoeh | 0:73919552e1de | 14 | valSwitch=rSwitch; |
gerardoeh | 0:73919552e1de | 15 | |
gerardoeh | 0:73919552e1de | 16 | while(pos<=1 and valSwitch==1){ |
gerardoeh | 0:73919552e1de | 17 | valSwitch=rSwitch; |
gerardoeh | 0:73919552e1de | 18 | pos=pos+0.05; |
gerardoeh | 0:73919552e1de | 19 | servoRotado=pos; |
gerardoeh | 0:73919552e1de | 20 | wait(0.3); |
gerardoeh | 0:73919552e1de | 21 | } |
gerardoeh | 0:73919552e1de | 22 | while(pos>=0){ |
gerardoeh | 0:73919552e1de | 23 | pos=pos-0.05; |
gerardoeh | 0:73919552e1de | 24 | servoRotado=pos; |
gerardoeh | 0:73919552e1de | 25 | wait(0.3); |
gerardoeh | 0:73919552e1de | 26 | } |
gerardoeh | 0:73919552e1de | 27 | |
gerardoeh | 0:73919552e1de | 28 | |
gerardoeh | 0:73919552e1de | 29 | |
gerardoeh | 0:73919552e1de | 30 | |
gerardoeh | 0:73919552e1de | 31 | } |
gerardoeh | 0:73919552e1de | 32 | } |