// Programa : Driver motor de passo A4988
// Autor : Arduino e Cia
#include <AccelStepper.h>
int velocidade_motor = 100;
int aceleracao_motor = 100;
int sentido_horario = 0;
int sentido_antihorario = 0;
int numero = 0;
int pin_pulso = 35;
int encoder = 0;
int valor_sensor;
bool s_high;
// Definicao pino ENABLE
int pino_enable = 18;
// Definicao pinos STEP e DIR
AccelStepper motor1(1, 2, 15 );
void setup()
{
Serial.begin(9600);
pinMode(pin_pulso, INPUT_PULLDOWN);
pinMode(pino_enable, OUTPUT);
// Configuracoes iniciais motor de passo
motor1.setMaxSpeed(velocidade_motor);
motor1.setSpeed(velocidade_motor);
motor1.setAcceleration(aceleracao_motor);
Serial.println("Digite 1, 2 ou 3 e clique em ENVIAR...");
}
void loop()
{
valor_sensor = digitalRead(pin_pulso);
if (valor_sensor == 1) { // Algum objeto passou por ele
s_high = 1;
}
// Quando o sensor passar por ele conta +1
if (!valor_sensor && s_high) {
s_high = 0;
// Incrementa o valor do contador
encoder++;
Serial.println(encoder);
if (encoder >= 5) {
encoder = 0;
Serial.println("Numero 3 recebido - Parando motor...");
sentido_horario = 0;
sentido_antihorario = 0;
motor1.moveTo(0);
digitalWrite(pino_enable, HIGH);
}
}
// Aguarda os caracteres no serial monitor
if (Serial.available() > 0)
{
numero = Serial.read();
{
if (numero == '1')
{
Serial.println("Numero 1 recebido - Girando motor sentido horario.");
digitalWrite(pino_enable, LOW);
sentido_horario = 1;
sentido_antihorario = 0;
}
if (numero == '2')
{
Serial.println("Numero 2 recebido - Girando motor sentido anti-horario.");
digitalWrite(pino_enable, LOW);
sentido_horario = 0;
sentido_antihorario = 1;
}
if (numero == '3')
{
Serial.println("Numero 3 recebido - Parando motor...");
sentido_horario = 0;
sentido_antihorario = 0;
motor1.moveTo(0);
digitalWrite(pino_enable, HIGH);
}
}
}
// Move o motor no sentido horario
if (sentido_horario == 1)
{
motor1.moveTo(10000);
}
// Move o motor no sentido anti-horario
if (sentido_antihorario == 1)
{
motor1.moveTo(-10000);
}
// Comando para acionar o motor no sentido especificado
motor1.run();
}