Program to restrict the movement of servos by using ReedSwitch

Dependencies:   Servo mbed

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?

UserRevisionLine numberNew 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 }