forum.hwkitchen.cz

Kód: Vybrat vše

// Definice pinů
int IN1 = 8;
int IN2 = 9;
int ENA = 10;

void setup() {
  pinMode(IN1, OUTPUT);
  pinMode(IN2, OUTPUT);
  pinMode(ENA, OUTPUT);
}

void loop() {
  // Rotace vlevo
  digitalWrite(IN1, HIGH);
  digitalWrite(IN2, LOW);
  analogWrite(ENA, 255); // plná rychlost
  delay(3000); // 3 sekundy = cca 3 otáčky při 60rpm
  
  // Stop
  digitalWrite(ENA, LOW);
  delay(500); // pauza
  
  // Rotace vpravo
  digitalWrite(IN1, LOW);
  digitalWrite(IN2, HIGH);
  analogWrite(ENA, 255);
  delay(3000);
  
  // Stop
  digitalWrite(ENA, LOW);
  delay(500);
}

Kód: Vybrat vše

// Definice pinů pro H-můstek
int IN1 = 8;
int IN2 = 9;
int ENA = 10;

// Definice pinů pro enkodér
int encoderPinA = 2;  // interrupt pin
int encoderPinB = 3;  // interrupt pin (pro směr)

// Proměnné
volatile long pulseCount = 0;
int pulsesPerRevolution = 20;  // závisí na vašem enkodéru
int targetRevolutions = 3;
int targetPulses = targetRevolutions * pulsesPerRevolution;

bool motorDirection = true;  // true = vlevo, false = vpravo

void setup() {
  // Nastavení pinů H-můstku
  pinMode(IN1, OUTPUT);
  pinMode(IN2, OUTPUT);
  pinMode(ENA, OUTPUT);
  
  // Nastavení enkodéru
  pinMode(encoderPinA, INPUT_PULLUP);
  pinMode(encoderPinB, INPUT_PULLUP);
  
  // Přerušení pro čtení enkodéru
  attachInterrupt(digitalPinToInterrupt(encoderPinA), countPulse, RISING);
  
  Serial.begin(9600);  // pro ladění
}

void loop() {
  // Reset počítadla
  pulseCount = 0;
  
  if (motorDirection) {
    // Rotace vlevo
    Serial.println("Rotace vlevo - start");
    digitalWrite(IN1, HIGH);
    digitalWrite(IN2, LOW);
    analogWrite(ENA, 200);  // můžete upravit rychlost (0-255)
    
    // Čekání na dokončení 3 otáček
    while (abs(pulseCount) < targetPulses) {
      // Motor běží, Arduino čeká na impulzy
      delay(10);
    }
    
  } else {
    // Rotace vpravo
    Serial.println("Rotace vpravo - start");
    digitalWrite(IN1, LOW);
    digitalWrite(IN2, HIGH);
    analogWrite(ENA, 200);
    
    // Čekání na dokončení 3 otáček
    while (abs(pulseCount) < targetPulses) {
      delay(10);
    }
  }
  
  // Stop motoru
  digitalWrite(ENA, LOW);
  Serial.print("Dokonceno. Impulzy: ");
  Serial.println(pulseCount);
  
  // Pauza mezi cykly
  delay(500);
  
  // Změna směru pro další cyklus
  motorDirection = !motorDirection;
}

// Funkce pro přerušení - počítání impulsů
void countPulse() {
  // Jednoduchá verze - jen počítání
  pulseCount++;
  
  // Pro detekci směru (s B kanálem):
  // if (digitalRead(encoderPinB) == HIGH) {
  //   pulseCount++;
  // } else {
  //   pulseCount--;
  // }
}