#include <Stepper.h>
int minimotijeras = -100;
int maximotijera = 100;
int contadorbrazo = 0;
int contadortijeras = 0;
const int intercambiador = A6;
int estadointercambiador = 0;
int valorintercambiador = 0;
//stepper brazo
const int pasosparavuelta2 = 200; // change this to fit the number of steps per revolution
const int vueltaporminuto2 = 15;
const int x_pin = A5; // analog pin connected to X output
Stepper motorbrazo (pasosparavuelta2, 6, 7, 8, 9);
//Stepper plataforma tijeras
const int pasosparavuelta = 200; // change this to fit the number of steps per revolution
const int vueltaporminuto = 10;
const int y_pin = A4; // analog pin connected to X output
Stepper plataformatijeras(pasosparavuelta, 10, 11, 12, 13);
void setup() {
plataformatijeras.setSpeed(vueltaporminuto);
motorbrazo.setSpeed(vueltaporminuto2);
pinMode(y_pin, INPUT);
pinMode(x_pin, INPUT);
pinMode(intercambiador, INPUT);
Serial.begin (9600);
}
void loop() {
int horizontal = analogRead(x_pin);
int vertical = analogRead(y_pin);
if (contadortijeras > minimotijeras && contadortijeras < maximotijera){
if (vertical < 300) {
plataformatijeras.step(-1);
contadortijeras--;
Serial.println (contadortijeras);
}
if (vertical > 700) {
plataformatijeras.step(1);
contadortijeras++;
}
}
if (horizontal > 700) {
motorbrazo.step(-1);
}
if (horizontal < 300) {
motorbrazo.step(1);
}
if (digitalRead(intercambiador) == LOW) {
}
}