Elektro

• Riadenie krokového motora a indikácia rýchlosti •

Zadanie a cieľ riešenia

Cieľom mini-projektu bolo navrhnúť, zapojiť a naprogramovať riadiaci obvod pre krokový motor. Rýchlosť otáčania sa nastavuje analógovým potenciometrom a jej aktuálnu úroveň zobrazujú štyri LED diódy.

**Špecifikácia variantu:** Variant I — ovládanie motora a indikácia rýchlosti otáčania minimálne štyrmi LED diódami.

**Zvolený prístup:** Riadenie krokového motora NEMA 17 cez pulzný budič a snímanie polohy potenciometra pomocou Arduino Uno.

Zoznam komponentov a zapojenie

Zapojenie bolo zostavené na nepájivom poli. Arduino nastavuje smer otáčania, generuje krokové impulzy, ovláda LED diódy cez obmedzovacie rezistory a sníma polohu potenciometra.
Komponent Pripojenie k Arduinu Funkcia v zapojení Arduino Uno Riadiaca doska Vyhodnocuje analógový vstup a generuje krokové impulzy. Potenciometer A5 Manuálne nastavenie rýchlosti. Budič motora 6 (DIR), 7 (STEP) Spína výkonové fázy krokového motora. Krokový motor Výstupy budiča Bipolárny krokový motor s ozubeným kolesom. 4 LED diódy 8, 9, 10, 11 Červená, modrá, žltá a biela indikujú pásma rýchlosti.

Schéma zapojenia obvodu

Schéma zapojenia riadiaceho obvodu

Technická dokumentácia: schéma zapojenia mikrokontroléra, budiča a indikačných LED.

Princíp fungovania programu

Interval medzi krokmi program sleduje funkciou `micros()`. Funkciu `delayMicroseconds()` používa len na vytvorenie krátkeho impulzu pre budič. * **Ochranné pásmo zastavenia:** Pri hodnote potenciometra 20 alebo menej program zastaví krokovanie a vypne všetky LED. * **Postupná indikácia rýchlosti:** Červená LED svieti pri zadanom pohybe, modrá sa pridáva od hodnoty 347, žltá od 674 a biela od 1000. * **Výpočet periódy krokov:** Poloha potenciometra sa prepočíta na 50 až 1000 krokov za sekundu. Z tejto frekvencie sa určí interval medzi impulzmi.

Zdrojový kód (Arduino / C++)

// Motor a potenciometer
const byte smerPin = 6;
const byte krokPin = 7;
const byte potenciometerPin = A5;
// LED
const byte cervena = 8;
const byte modra   = 9;
const byte zlta    = 10;
const byte biela   = 11;
// Nastavenie rychlosti
const unsigned int minimalnaRychlost = 50;
const unsigned int maximalnaRychlost = 1000;
const int hranicaZastavenia = 20;
const int hranicaMaxima = 1000;
unsigned long poslednyKrok = 0;
void setup() {
  pinMode(smerPin, OUTPUT);
  pinMode(krokPin, OUTPUT);
  pinMode(cervena, OUTPUT);
  pinMode(modra, OUTPUT);
  pinMode(zlta, OUTPUT);
  pinMode(biela, OUTPUT);
  digitalWrite(smerPin, HIGH);
  digitalWrite(krokPin, LOW);
  digitalWrite(cervena, LOW);
  digitalWrite(modra, LOW);
  digitalWrite(zlta, LOW);
  digitalWrite(biela, LOW);
}
void loop() {
  int hodnotaPotenciometra = analogRead(potenciometerPin);
  // A. Zastavenie pri minime
  if (hodnotaPotenciometra <= hranicaZastavenia) {
    digitalWrite(cervena, LOW);
    digitalWrite(modra, LOW);
    digitalWrite(zlta, LOW);
    digitalWrite(biela, LOW);
    digitalWrite(krokPin, LOW);
    poslednyKrok = micros();
    return;
  }
  // B. Ohranicenie hodnoty potenciometra
  int hodnota = constrain(hodnotaPotenciometra,
    hranicaZastavenia + 1, hranicaMaxima);
  // C. Postupne rozsvecovanie LED
  digitalWrite(cervena, HIGH);
  if (hodnota >= 347) {
    digitalWrite(modra, HIGH);
  } else {
    digitalWrite(modra, LOW);
  }
  if (hodnota >= 674) {
    digitalWrite(zlta, HIGH);
  } else {
    digitalWrite(zlta, LOW);
  }
  if (hodnota >= hranicaMaxima) {
    digitalWrite(biela, HIGH);
  } else {
    digitalWrite(biela, LOW);
  }
  // D. Vypocet pozadovanej rychlosti
  unsigned int rychlost = map(hodnota, hranicaZastavenia + 1,
    hranicaMaxima, minimalnaRychlost, maximalnaRychlost);
  unsigned long intervalKrokov = 1000000UL / rychlost;
  // E. Vytvorenie impulzu pre motor
  unsigned long aktualnyCas = micros();
  if (aktualnyCas - poslednyKrok >= intervalKrokov) {
    poslednyKrok = aktualnyCas;
    digitalWrite(krokPin, HIGH);
    delayMicroseconds(5);
    digitalWrite(krokPin, LOW);
  }
}

Videodokumentácia funkčnosti

Na videu je zachytená reakcia pohonu na zmenu polohy potenciometra. Po opustení pásma zastavenia sa roztočí motor a rozsvieti červená dióda. Pri zvyšovaní rýchlosti sa postupne rozsvecujú ďalšie diódy až po maximálnu frekvenciu krokovania.

Praktické overenie funkčnosti zapojenia a postupného rozsvecovania LED diód.

**Zhodnotenie výstupu:** Požiadavky variantu