![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
Ascensor: -ultrasonido -motorres
Dependencies: DebouncedIn HCSR04 mbed
Revision 0:4f72e674f36d, committed 2018-06-07
- Comitter:
- aftorob
- Date:
- Thu Jun 07 18:53:31 2018 +0000
- Commit message:
- v1
Changed in this revision
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/DebouncedIn.lib Thu Jun 07 18:53:31 2018 +0000 @@ -0,0 +1,1 @@ +http://os.mbed.com/users/jclondonol/code/DebouncedIn/#1ad8929cc2b4
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/HCSR04.lib Thu Jun 07 18:53:31 2018 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/prabhuvd/code/HCSR04/#71da0dbf4400
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Thu Jun 07 18:53:31 2018 +0000 @@ -0,0 +1,171 @@ +#include "mbed.h" +#include "DebouncedIn.h" +#include "hcsr04.h" + +DigitalIn B_stop(PTC8); //Boton de paro de emergencia +DigitalIn B_close(PTC9); //Boton “Cerrar” de la cabina +DigitalIn B_open(PTA13); //Boton “Abrir” de la cabina + +DigitalIn B_c1(PTB1); //Boton "1" de la cabina +DigitalIn B_c2(PTB0); //Boton "2" de la cabina +DigitalIn B_c3(PTA5); //Boton "3" de la cabina + +DigitalIn B_p1(PTB2); //Boton piso 1 +DigitalIn B_p3(PTC1); //Boton piso 3 +DigitalIn B_p2u(PTB3); //Boton piso 2 arriba +DigitalIn B_p2d(PTC2); //Boton piso 2 abajo + +PwmOut S_1(PTD2); //Servomotor piso 1 +PwmOut S_2(PTD0); //Servomotor piso 2 +PwmOut S_3(PTD5); //Servomotor piso 3 + +PwmOut Motor_en(PTA12); //Motor enable +DigitalOut Motor_up(PTD4); //Motor arriba +DigitalOut Motor_down(PTA4); //Motor abajo + +DigitalOut Trigger(PTD3); //Trigger Ultrasonido +DigitalIn Echo(PTD1); //Echo ultrasonido +DigitalOut myled(LED1); //monitor trigger +DigitalOut myled2(LED2); //monitor echo + +Serial pc(PTA2, PTA1); + +int distance = 0; +int correction = 0; +Timer sonar; + +int sensordist(void); +void comp(int dmeasured); + +int main(){ + sonar.reset(); + sonar.start(); + while(Echo == 2){}; + myled=0; + sonar.stop(); + correction = sonar.read_us(); + + while(true){ + + int d = sensordist(); + comp(d); + wait_ms(50); + + while((B_p2u == 0)){ + pc.printf("u"); + Motor_up = 1; + Motor_down = 0; + Motor_en.period_ms(50); + Motor_en.pulsewidth_us(4000); + } + while((B_p2d == 0)){ + pc.printf("d"); + Motor_up = 0; + Motor_down = 1; + Motor_en.period_ms(50); + Motor_en.pulsewidth_us(1000); + } + if ((B_p2u == 1) && (B_p2d == 1)){ + pc.printf("p"); + Motor_up = 0; + Motor_down = 0; + } + + wait_ms(500); + + /*if((B_p1 == 0) || (B_c1 == 0)){ + pc.printf("1"); + wait(1); + pc.printf("u"); + + + } + if((B_p2d == 0) || (B_c2 == 0) || (B_p2u == 0)){ + pc.printf("2"); + wait(1); + pc.printf("p"); + + + } + if((B_p3 == 0) || (B_c3 == 0)){ + pc.printf("3"); + wait(1); + pc.printf("d"); + + + } + if((B_open == 0)){ + pc.printf("4"); + wait(1); + } + if((B_close == 0)){ + pc.printf("5"); + wait(1); + } + if((B_stop == 0)){ + pc.printf("6"); + wait(1); + + } + */ + } + + + } + + + +int sensordist(void){ + Trigger = 1; + myled = 1; + myled2 = 0; + sonar.reset(); + wait_us(10.0); + Trigger = 0; + myled = 0; + while (Echo==0) {}; + myled2=Echo; + sonar.start(); + while (Echo==1) {}; + sonar.stop(); + distance = (sonar.read_us()-correction)/58.0; + myled2 = 0; + return distance; +} + +void comp(int dmeasured){ + if((dmeasured <= 5)){ + pc.printf("9"); + } + else if ((dmeasured > 5 && dmeasured <= 10)){ + pc.printf("8"); + } + else if ((dmeasured > 10 && dmeasured <= 15)){ + pc.printf("7"); + } + else if ((dmeasured > 15 && dmeasured <= 20)){ + pc.printf("6"); + } + else if ((dmeasured > 20 && dmeasured <= 25)){ + pc.printf("5"); + } + else if ((dmeasured > 25 && dmeasured <= 30)){ + pc.printf("4"); + } + else if ((dmeasured > 30 && dmeasured <= 35)){ + pc.printf("3"); + } + else if ((dmeasured > 35 && dmeasured <= 40)){ + pc.printf("2"); + } + else if ((dmeasured > 40 && dmeasured <= 46)){ + pc.printf("1"); + } + else{ + pc.printf("0"); + } + } + + + +
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/mbed.bld Thu Jun 07 18:53:31 2018 +0000 @@ -0,0 +1,1 @@ +https://os.mbed.com/users/mbed_official/code/mbed/builds/5aab5a7997ee \ No newline at end of file