Vous êtes sur la page 1sur 6

//4-B Mecatrnica Estacionamiento con arduino Equipo: Kappa

//Arduino ATmega2560-Driver ULN200

//Declaramos las variables


int pulsador = 0; //Estado del Boton de Entrada que accionara la pluma
int entrada = 2; //Pin del primer boton
int pulsador1 = 0;//Estado del Boton de Entrada que bajara la pluma
int entrada1 = 3; //Pin del segundo boton
int pulsador2 = 0;//Estado del Boton de Salida que accionara la pluma
int entrada2 = 4;//Pin del tercero boton
int pulsador3 = 0;//Estado del Boton de Salida que bajara la pluma
int entrada3 = 5;//Pin del segundo boton

int motorPin1 = 10;

// Pin 10 conectar a IN1 (A)

int motorPin2 = 11;

// Pin 11 conectar a IN2 (B)

int motorPin3 = 12; // Pin 12 conectar a IN3(C)


int motorPin4 = 13; // Pin 13 conectar a IN4(D)

int motorPin5 = 6;

// Pin 6 conectar a IN1 (A)

int motorPin6 = 7;

// Pin 7 conectar a IN2 (B)

int motorPin7 = 8; // Pin 8 conectar a IN3(C)


int motorPin8 = 9; // Pin 9 conectar a IN4(D)

int retardo = 5;

// Tiempo de retardo en milisegundos (Velocidad del Motor)

int pasos = 0;

// Cuenta inicial de los pasos recorridos

//Declaramos Entradas y Salidas


void setup() {
pinMode(2, INPUT); //Pin del primer boton
pinMode(3, INPUT); //Pin del segundo boton

pinMode(4, INPUT); //Pin del tercer boton


pinMode(5, INPUT); //Pin del cuarto boton

pinMode(motorPin1, OUTPUT); //(A1) Primer Motor


pinMode(motorPin2, OUTPUT); //(B1)
pinMode(motorPin3, OUTPUT); //(C1)
pinMode(motorPin4, OUTPUT); //(D1)

pinMode(motorPin5, OUTPUT); //(A2) Segundo Motor


pinMode(motorPin6, OUTPUT); //(B2)
pinMode(motorPin7, OUTPUT); //(C2)
pinMode(motorPin8, OUTPUT); //(D2)
}

void loop() {
pulsador = digitalRead(entrada);
if (pulsador == HIGH)
for (pasos = 0; pasos < 128; pasos++){
/* Aqui es donde se puede modificar la cantidad de
pASOS que se desean asignar al motor, por ejemplo:
(512 PASOS=360 GRADOS), en este caso ocupo que de
1/4 de vuelta, osea 512/4 =128*/

// Punto A (Primero)
digitalWrite(motorPin1, HIGH);
digitalWrite(motorPin2, LOW);
digitalWrite(motorPin3, LOW);
digitalWrite(motorPin4, HIGH);
delay(retardo); // tiempo de espera

// Punto B (Segundo)
digitalWrite(motorPin1, HIGH);
digitalWrite(motorPin2, HIGH);
digitalWrite(motorPin3, LOW);
digitalWrite(motorPin4, LOW);
delay(retardo);

// Punto C (Tercero)
digitalWrite(motorPin1, LOW);
digitalWrite(motorPin2, HIGH);
digitalWrite(motorPin3, HIGH);
digitalWrite(motorPin4, LOW);
delay(retardo);

// Punto D (Cuarto)
digitalWrite(motorPin1, LOW);
digitalWrite(motorPin2, LOW);
digitalWrite(motorPin3, HIGH);
digitalWrite(motorPin4, HIGH);
delay(retardo); }

pulsador1 = digitalRead(entrada1);
if (pulsador1 == HIGH)
for (pasos = 0; pasos < 128; pasos++){
// Punto D (Cuarto)
digitalWrite(motorPin1, LOW);
digitalWrite(motorPin2, LOW);
digitalWrite(motorPin3, HIGH);
digitalWrite(motorPin4, HIGH);
delay(retardo);

// Punto C (Tercero)
digitalWrite(motorPin1, LOW);
digitalWrite(motorPin2, HIGH);
digitalWrite(motorPin3, HIGH);
digitalWrite(motorPin4, LOW);
delay(retardo);

// Punto B (Segundo)
digitalWrite(motorPin1, HIGH);
digitalWrite(motorPin2, HIGH);
digitalWrite(motorPin3, LOW);
digitalWrite(motorPin4, LOW);
delay(retardo);

// Punto A (Primero)
digitalWrite(motorPin1, HIGH);
digitalWrite(motorPin2, LOW);
digitalWrite(motorPin3, LOW);
digitalWrite(motorPin4, HIGH);
delay(retardo); }

pulsador = digitalRead(entrada2);
if (pulsador2 == HIGH)
for (pasos = 0; pasos < 128; pasos++){

// Punto A (Primero)
digitalWrite(motorPin5, HIGH);
digitalWrite(motorPin6, LOW);
digitalWrite(motorPin7, LOW);

digitalWrite(motorPin8, HIGH);
delay(retardo); // tiempo de espera

// Punto B (Segundo)
digitalWrite(motorPin5, HIGH);
digitalWrite(motorPin6, HIGH);
digitalWrite(motorPin7, LOW);
digitalWrite(motorPin8, LOW);
delay(retardo);

// Punto C (Tercero)
digitalWrite(motorPin5, LOW);
digitalWrite(motorPin6, HIGH);
digitalWrite(motorPin7, HIGH);
digitalWrite(motorPin8, LOW);
delay(retardo);

// Punto D (Cuarto)
digitalWrite(motorPin5, LOW);
digitalWrite(motorPin6, LOW);
digitalWrite(motorPin7, HIGH);
digitalWrite(motorPin8, HIGH);
delay(retardo); }

pulsador1 = digitalRead(entrada3);
if (pulsador3 == HIGH)
for (pasos = 0; pasos < 128; pasos++){
// Punto D (Cuarto)
digitalWrite(motorPin5, LOW);
digitalWrite(motorPin6, LOW);

digitalWrite(motorPin7, HIGH);
digitalWrite(motorPin8, HIGH);
delay(retardo);

// Punto C (Tercero)
digitalWrite(motorPin5, LOW);
digitalWrite(motorPin6, HIGH);
digitalWrite(motorPin7, HIGH);
digitalWrite(motorPin8, LOW);
delay(retardo);

// Punto B (Segundo)
digitalWrite(motorPin5, HIGH);
digitalWrite(motorPin6, HIGH);
digitalWrite(motorPin7, LOW);
digitalWrite(motorPin8, LOW);
delay(retardo);

// Punto A (Primero)
digitalWrite(motorPin5, HIGH);
digitalWrite(motorPin6, LOW);
digitalWrite(motorPin7, LOW);
digitalWrite(motorPin8, HIGH);
delay(retardo); }

Vous aimerez peut-être aussi