Blog

#define dirPin 2  
#define stepPin 3 
#define boutonhoraire 4
#define boutonantihoraire 5
#define enabledmotor 6 
#define capteurinit 7
int vitessemoteurinit = 4000; //Vitesse du moteur pendant initialisation
int vitessemoteur = 4000; //Vitesse du moteur
int angle = 15; //Angle de rotation souhaité par impulsion sur le bouton
int positioncible = (3200/(360/angle)); // Calcul du nombre d'impulsion à effectuer par rapport à l'angle demandé sachant que 3200 = 1 tour


void setup() {
  Serial.begin(9600);
  pinMode(stepPin, OUTPUT);
  pinMode(dirPin, OUTPUT);
  pinMode(enabledmotor, OUTPUT);
  pinMode(boutonhoraire, INPUT_PULLUP);
  pinMode(boutonantihoraire, INPUT_PULLUP);
  pinMode(capteurinit, INPUT_PULLUP);
  positioninit();
}

void loop() {
  int etatboutonhoraire = digitalRead(boutonhoraire);
  if (etatboutonhoraire == LOW){
    digitalWrite(dirPin, LOW);
    digitalWrite(enabledmotor, LOW);
    for (int rotation=0; rotation <= positioncible; rotation++){ 
      digitalWrite(stepPin, HIGH);
      delayMicroseconds(vitessemoteur);
      digitalWrite(stepPin, LOW);
      delayMicroseconds(vitessemoteur);
    }
    etatboutonhoraire = digitalRead(boutonhoraire);
    while(etatboutonhoraire == LOW){
        etatboutonhoraire = digitalRead(boutonhoraire);
    }
    digitalWrite(enabledmotor, HIGH);
  }
  
  int etatboutonantihoraire = digitalRead(boutonantihoraire);
  if (etatboutonantihoraire == LOW){
    digitalWrite(dirPin, HIGH);
    digitalWrite(enabledmotor, LOW);
    for (int rotation=0; rotation <= positioncible; rotation++){ 
      digitalWrite(stepPin, HIGH);
      delayMicroseconds(vitessemoteur);
      digitalWrite(stepPin, LOW);
      delayMicroseconds(vitessemoteur);
    }
    etatboutonantihoraire = digitalRead(boutonantihoraire);
    while(etatboutonantihoraire == LOW){
        etatboutonantihoraire = digitalRead(boutonantihoraire);
    }
    digitalWrite(enabledmotor, HIGH);
  }
}

void positioninit(){
  int etatcapteurinit = digitalRead(capteurinit);
  digitalWrite(dirPin, HIGH);
  digitalWrite(enabledmotor, LOW);
  while (etatcapteurinit == HIGH){ 
    digitalWrite(stepPin, HIGH);
    delayMicroseconds(vitessemoteurinit);
    digitalWrite(stepPin, LOW);
    delayMicroseconds(vitessemoteurinit);
    etatcapteurinit = digitalRead(capteurinit);
  }  
  digitalWrite(enabledmotor, HIGH);
}