Programa Elevador
Enviado por Irbert • 14 de Enero de 2019 • Práctica o problema • 771 Palabras (4 Páginas) • 153 Visitas
//Definicion sensores
int sensor0=A0;
int sensor1=A1;
int sensor2=A2;
int sensor3=A3;
int sensor4=A4;
//Definicion botones de llamada
int boton0=2;
int boton1=3;
int boton2=4;
int boton3=5;
int boton4=6;
//Definicion motor
int e1=11,e2=10,enable=9;
void setup () {
Serial.begin(9600);
pinMode(sensor0,INPUT);
pinMode(sensor1,INPUT);
pinMode(sensor2,INPUT);
pinMode(sensor3,INPUT);
pinMode(sensor4,INPUT);
pinMode(boton0,INPUT);
pinMode(boton1,INPUT);
pinMode(boton2,INPUT);
pinMode(boton3,INPUT);
pinMode(boton4,INPUT);
pinMode(e1,OUTPUT);
pinMode(e2,OUTPUT);
pinMode(enable,OUTPUT);
//Al conectar mueve el ascensor a la planta baja como punto de
ai();
}
void loop () {
int s0, s1, s2, s3, s4, b0, b1, b2, b3, b4;
int pwmsubir=140,pwmbajar=65;
int posicion=0, posicion2;
while (1)
lecturasensores (&s0, &s1, &s2, &s3, &s4);
lecturabotones (&b0, &b1, &b2, &b3, &b4);
//Programa boton planta baja
if (b0==0) {
posicion2=0;
if (posicion>posicion2) {
while (s0!=1) {
lecturasensores (&s0, &s1, &s2, &s3, &s4);
bajar (pwmbajar);
delay(5);
}
parada ();
posicion=0;
}
}
//Programa boton planta 1
if (b1==0) {
posicion2=1;
if (posicion>posicion2) {
while (s1!=1) {
lecturasensores (&s0, &s1, &s2, &s3, &s4);
bajar (pwmbajar);
delay(5);
}
parada ();
posicion=1;
}
if (posicion
while (s1!=1) {
lecturasensores (&s0, &s1, &s2, &s3, &s4);
subir (pwmsubir);
delay(5);
}
parada ();
posicion=1;
}
}
//Programa boton planta 2
if (b2==0) {
posicion2=2;
if (posicion>posicion2) {
while (s2!=1) {
lecturasensores (&s0, &s1, &s2, &s3, &s4);
bajar (pwmbajar);
delay(5);
}
parada ();
posicion=2;
}
if (posicion
while (s2!=1) {
lecturasensores (&s0, &s1, &s2, &s3, &s4);
subir (pwmsubir);
delay(5);
}
parada ();
posicion=2;
}
}
//Programa boton planta 3
if (b3==0) {
posicion2=3;
if (posicion>posicion2) {
while (s3!=1) {
lecturasensores (&s0, &s1, &s2, &s3, &s4);
...