#include <Wire.h>
#include <LiquidCrystal_I2C.h>
#include <AccelStepper.h>

#define ENA_PIN Q0_2
#define DIR_PIN Q0_1
#define PUL_PIN Q0_0

#define ArretRotation I0_6   //Sortie sécurité en cas d'arrêt de rotation arbre
#define Signal I0_5          //Entrée signal depart
#define CtrlRotation I0_4    //Entrée contrôle de rotation d'arbre
#define VitMoins I0_3        //Entrée diminution de la vitesse de rotation
#define VitPlus I0_2         //Entrée augmentation de la vitesse de rotation

AccelStepper stepper(AccelStepper::DRIVER, PUL_PIN, DIR_PIN);
LiquidCrystal_I2C lcd(0x27, 20, 4);   //Set the LCD Adress to 0x27 for a 16 chars and 2 line display

int Vitesse = 0;

void setup() {
  Wire.begin();
  Serial.begin(9600);

  lcd.begin(20, 4);
  lcd.backlight();

  pinMode(ENA_PIN, OUTPUT);
  pinMode(Signal, INPUT);
  pinMode(VitPlus, INPUT);
  pinMode(VitMoins, INPUT);
  pinMode(CtrlRotation, INPUT);
  pinMode(ArretRotation, OUTPUT);

  digitalWrite(ENA_PIN, LOW);  //Active le driver

  stepper.setAcceleration(500);
}

void loop() {

  if(digitalRead(VitPlus) == HIGH){
    Vitesse = Vitesse + 5;
    delay(15);
  }

  if(digitalRead(VitMoins) == HIGH){
    Vitesse = Vitesse - 5;
    delay(15);
  }

  stepper.setMaxSpeed(Vitesse);

  Serial.println(Vitesse);

  displayValues(Vitesse);

  if(digitalRead(Signal) == HIGH){
    Moteur();
  }
}

void Moteur(){

  stepper.move(5000);
  stepper.run();

  if(stepper.distanceToGo() == 0){
    digitalWrite(ENA_PIN, HIGH);
  }
  else {
    digitalWrite(ENA_PIN, LOW);
  }
}

void displayValues(int Vitesse) {
  lcd.clear();

  lcd.setCursor(7, 0);
  lcd.print("TEST");

  lcd.setCursor(1, 1);
  lcd.print("Reglage vitesse");

  lcd.setCursor(3, 3);
  lcd.print("Vitesse : ");
  lcd.print(Vitesse);

  delay(50);
}