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
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