Arduino'da AccelStepper: run(), ivme, başlangıç konumu ve MultiStepper
Orta
Ya da tüm dersleri gör.
- 526parça tezgahta
- 46kart şu an çalışıyor
- 1.00xgerçek zamanlı, her kartta
AccelStepper, çoğu Arduino projesinin sonunda ulaştığı adım motoru kütüphanesidir, çünkü motoru hızlandırıp yavaşlatır; bunu düz Stepper kütüphanesi yapamaz ve her çağrıda bir adım atarak yapar, böylece kodun geri kalanı çalışmaya devam eder. Mokxi'de hazır olarak gelir, yanında MultiStepper.h ile.
Yukarıdaki devre bir fotoğraf tablası: ULN2003 kartındaki bir 28BYJ-48, bir Uno ve bir başlatma butonu. Butona basınca tabla, 512 yarım adımlık sekiz durakta tam bir tur atar, her durakta yumuşakça hızlanıp yavaşlarken seri monitör fotoğrafları sayar.
Bu sayfadaki her sayı, Mokxi'nin motorunda, bir 28BYJ-48'de veya A4988 arkasındaki bir NEMA 17'de çalıştırılan bir kod tarafından yazdırıldı.
Motor yap: A4988 için DRIVER, 28BYJ-48 için HALF4WIRE
Kurucu, motorun nasıl kablolandığını söyler. AccelStepper stepper(AccelStepper::DRIVER, 3, 4); STEP ve DIR alan bir sürücü kartıdır, örneğin bir A4988 veya DRV8825, önce STEP adıyla. AccelStepper stepper(AccelStepper::HALF4WIRE, 8, 10, 9, 11); dört pinin doğrudan bir ULN2003 kartına girmesidir, yarım adımlı, ve FULL4WIRE aynı dört pindir tam adımlı.
Ondan sonraki her sayı, kurucunun seçtiği birimdedir. Bir 28BYJ-48, HALF4WIRE ile 4096 adımda, FULL4WIRE ile 2048 adımda bir tur atar. 200 adımlık bir NEMA 17, tam adımda 200 STEP darbesinde, 1/16'da 3200 darbede bir tur atar, çünkü DRIVER modunda bir AccelStepper adımı bir darbedir ve bir darbenin ne kadar ileri götüreceğine sürücü karar verir.
Aşağıdaki kod bir 28BYJ-48'i çeyrek tur döndürür. "at 1024 after 3116 ms" yazdırdı ve mile 90.0 derecede bıraktı.
#include <AccelStepper.h>
// ULN2003 IN1, IN2, IN3, IN4 on pins 8, 9, 10, 11, given as IN1, IN3, IN2, IN4.
AccelStepper motor(AccelStepper::HALF4WIRE, 8, 10, 9, 11);
bool reported = false;
void setup() {
Serial.begin(115200);
motor.setMaxSpeed(800); // steps a second
motor.setAcceleration(400); // steps a second, every second
motor.moveTo(1024); // a quarter turn in half-steps
}
void loop() {
motor.run();
if (!reported && motor.distanceToGo() == 0) {
reported = true;
Serial.print("at ");
Serial.print(motor.currentPosition());
Serial.print(" after ");
Serial.print(millis());
Serial.println(" ms");
}
}Bu kodu düzenleyicide açSadece kod: düzenleyici, kartı ve koddan okuyabildiği parçaları yerleştirir.
28BYJ-48'in pinleri neden 8, 10, 9, 11 olarak giriyor
AccelStepper, iki H köprüsündeki bir motor için dört pinini numaralandırır; ilk iki pin bir bobin, son iki diğeri olur. Bir ULN2003 kartı ise dört bobinini motorun çevresinde sırayla numaralandırır. Pinleri IN1, IN3, IN2, IN4 olarak vermek, kütüphanenin dizisinin o bobinleri sırayla gezdirmesini sağlar.
Give it 8, 9, 10, 11 and the same sketch still printed "at 1024 after 3116 ms", but the shaft never left 0 degrees. In that order the sequence switches on opposite coils together, whose pulls cancel, and the field never walks around in one direction, so the rotor is tugged back and forth on the spot. That is the motor that hums and does not move, and the library cannot tell: currentPosition() counts the steps it sent, not the steps the shaft made.
run(), runSpeed() ve runToPosition()
run() çağrı başına en fazla bir adım atar, sırası geldiğinde, ve sonraki adımın hızını ivmeden hesaplar, yani yanında yavaş bir şey olmadan loop() içine aittir. runSpeed() setSpeed() ile verilen sabit hızda adım atar, rampa ve hedef yoktur. runToPosition() ve runToNewPosition(), motor varana kadar run() çağırır ve bunlar dönene kadar başka hiçbir şey çalışmaz.
İşte tam adımda bir A4988 arkasındaki NEMA 17'de run(), setMaxSpeed(500), setAcceleration(250) ve moveTo(1000) ile, her yarım saniyede zamanı, konumu ve hızı yazdırarak. "500 35 133", "1000 132 257", "1500 291 381" ve "2000 512 493" yazdırdı, tepe noktası, sonra "2500 727 369", "3000 880 245" ve "3500 971 121", ve "at 1000 after 3893 ms". Aritmetik dört saniye der: saniyede 250 artışla saniyede 500 adıma ulaşmak için iki saniye, 500 adım katederek, ve durmak için iki saniye.
Aynı hareket runToNewPosition(1000) ile "there after 3889 ms" ve geri dönüş "back after 7779 ms" yazdırdı, arada hiçbir şey yok, çünkü loop() hiç çalışmadı. runSpeed() setSpeed(200) ile ilk saniyesinde 199 adım attı: ilk adımdan itibaren sabit hız ve rampsız.
#include <AccelStepper.h>
AccelStepper stepper(AccelStepper::DRIVER, 3, 4); // STEP, DIR
unsigned long lastPrint = 0;
bool reported = false;
void setup() {
Serial.begin(115200);
stepper.setMaxSpeed(500); // steps a second
stepper.setAcceleration(250); // steps a second, every second
stepper.moveTo(1000);
}
void loop() {
stepper.run();
if (millis() - lastPrint >= 500) {
lastPrint += 500;
Serial.print(millis());
Serial.print(" ");
Serial.print(stepper.currentPosition());
Serial.print(" ");
Serial.println((long)stepper.speed());
}
if (!reported && stepper.distanceToGo() == 0) {
reported = true;
Serial.print("at ");
Serial.print(stepper.currentPosition());
Serial.print(" after ");
Serial.print(millis());
Serial.println(" ms");
}
}Bu kodu düzenleyicide açSadece kod: düzenleyici, kartı ve koddan okuyabildiği parçaları yerleştirir.
setMaxSpeed() ve setAcceleration(): rampa neden önemli
28BYJ-48'in veri sayfası, duruşta saniyede 600 adıma kadar başlayıp dönmeye başlayınca 1000'den fazlasına yetiştiğini söyler ve Mokxi'nin modeli her iki değeri de içerir.
Ondan saniyede 900 tam adım istedik, FULL4WIRE ve moveTo(2048), yani bir tur. setAcceleration(500) ile "at 2048 after 4054 ms" yazdırdı ve mil turun tamamını tamamladı. setAcceleration(100000) ile, yani hiç rampa olmadan, "at 2048 after 2304 ms" yazdırdı ve mil başlangıç noktasından 0.8 derece uzakta kaldı: adımların neredeyse tamamını kaçırdı. Kütüphane her iki seferde de aynı konumu bildirdi.
Half-steps move the field half as far, and Mokxi’s 28BYJ-48 follows them from rest up to one a millisecond, so HALF4WIRE at 800 steps a second is safe with any ramp. At 1200 half-steps a second with no ramp, a half turn ended 0.9 degrees from the start.
Mokxi'nin NEMA 17'si ivme ne olursa olsun saniyede 1000 tam adıma kadar izler. Gerçeği hızlandıkça tork kaybeder, Mokxi bunu modellemez, yani gerçek bir tezgahta rampa daha da önemlidir.
Bir A4988 veya DRV8825: DRIVER modu ve enable pini
DRIVER modunda kütüphane STEP'i setMinPulseWidth() mikrosaniye boyunca yüksek tutar, varsayılan 1; DRV8825 1.9 ister, yani setMinPulseWidth(2) çağır. 1/16 adımda, tam adımda doğru olan her hız 16 ile çarpılmalıdır.
A4988'in EN pini aktif düşüktür. setEnablePin(8) ve setPinsInverted(false, false, true) ile ver, ve disableOutputs() bir hareketten sonra mile serbestlik verir, bu da tutma torkundan vazgeçip soğuk kalmayı sağlar.
Sınır anahtarlı bir sıfırlama yordamı
Güç verildiğinde AccelStepper motorun 0'da olduğuna inanır. Sıfırlama bunu düzeltir: bir anahtar kapanana ona doğru sürün, setCurrentPosition(0) çağır ve oradan say.
Mokxi'de bunu denemek için bir mekanizma var: lunapark pençe projesindeki kabin; arabası bir NEMA 17 ve GT2 kayış, tam adımda 0.2 mm, baş ucunda, arabanın son beşte bir milimetrede bastığı bir kolu anahtar. X eksenini tam adımda bir A4988'e, anahtarı pin'in çekme direnciyle pin 2'ye bağladık ve aşağıdaki kodu çalıştırdık. Araba 120 mm dışarıdayken "switch closed after 601 steps, 3006 ms" yazdırdı, sonra "at 500, switch 1": 100 mm dışarıda ve anahtardan yine uzakta. 60 mm'den 301 adım sürdü. Anahtarın kablosu çıkarıldığında, arabayı sonsuza dek uca sürüklemek yerine "homing failed: no switch within 1200 steps" yazdırdı; her sıfırlama yordamının ihtiyaç duyduğu satır budur.
The search uses runSpeed(), so it is steady and stops on the step the switch closes, and setCurrentPosition() also zeroes the speed. A printer then backs off and touches the switch again, slower, as the stepper homing project does. If your axis heads away from its switch, flip the sign of the speed.
#include <AccelStepper.h>
const int HOME_PIN = 2; // the switch: COM to GND, NO to pin 2
AccelStepper axis(AccelStepper::DRIVER, 3, 4); // STEP 3, DIR 4
bool home() {
axis.setSpeed(-200); // toward the switch, 200 steps a second
unsigned long start = millis();
while (digitalRead(HOME_PIN) == HIGH) {
axis.runSpeed();
if (axis.currentPosition() < -1200) {
Serial.println("homing failed: no switch within 1200 steps");
return false;
}
}
Serial.print("switch closed after ");
Serial.print(-axis.currentPosition());
Serial.print(" steps, ");
Serial.print(millis() - start);
Serial.println(" ms");
axis.setCurrentPosition(0); // this is zero now
return true;
}
void setup() {
Serial.begin(115200);
pinMode(HOME_PIN, INPUT_PULLUP);
axis.setMaxSpeed(400);
axis.setAcceleration(800);
if (home()) {
axis.runToNewPosition(500); // 100 mm out, at 0.2 mm a step
Serial.print("at ");
Serial.print(axis.currentPosition());
Serial.print(", switch ");
Serial.println(digitalRead(HOME_PIN));
}
}
void loop() {}Bu kodu düzenleyicide açSadece kod: düzenleyici, kartı ve koddan okuyabildiği parçaları yerleştirir.
MultiStepper: birlikte varan iki motor
MultiStepper, bir çizici için düz bir çizgide gerektiği gibi, birkaç AccelStepper'ı aynı anda bitecek şekilde hareket ettirir. En uzun süren hareketi kendi azami hızında bulur ve diğerlerini eşleşecek şekilde yavaşlatır, ivme kullanmaz.
On two NEMA 17s behind two A4988s, both at setMaxSpeed(400), targets of 800 and 200 arrived together and the sketch printed "800 200 2018 ms": two seconds is 800 steps at 400 a second, so the second motor ran at a quarter of that.
#include <AccelStepper.h>
#include <MultiStepper.h>
AccelStepper x(AccelStepper::DRIVER, 3, 4); // STEP, DIR
AccelStepper y(AccelStepper::DRIVER, 5, 6);
MultiStepper both;
void setup() {
Serial.begin(115200);
x.setMaxSpeed(400);
y.setMaxSpeed(400);
both.addStepper(x);
both.addStepper(y);
long targets[2] = {800, 200};
both.moveTo(targets);
unsigned long start = millis();
both.runSpeedToPosition(); // blocks until both are there
Serial.print(x.currentPosition());
Serial.print(" ");
Serial.print(y.currentPosition());
Serial.print(" ");
Serial.print(millis() - start);
Serial.println(" ms");
}
void loop() {}Bu kodu düzenleyicide açSadece kod: düzenleyici, kartı ve koddan okuyabildiği parçaları yerleştirir.
ESP32'de AccelStepper
ESP32'de yalnızca pinler ve mantık seviyesi değişir: bir A4988, VDD'sinin 0.7'ini, yani 5 V'da 3,5 V'u yüksek sayar ve 3,3 V'luk bir pin buna asla ulaşamaz. Alttaki kodu bir ESP32-C3'te çalıştırdık, STEP GPIO 4'te ve DIR GPIO 5'te. A4988'in VDD'si 5 V'dayken "done after 1869 ms" yazdı ve şaft hiç dönmedi. VDD kartın 3,3 V pinine bağlandığında bir kez döndü. Bir DRV8825, 2,2 V'u yüksek olarak okur, yani değişiklik gerektirmez.
#include <AccelStepper.h>
// STEP on GPIO 4, DIR on GPIO 5; the A4988's VDD on the board's 3.3 V.
AccelStepper stepper(AccelStepper::DRIVER, 4, 5);
bool reported = false;
void setup() {
Serial.begin(115200);
stepper.setMaxSpeed(400);
stepper.setAcceleration(200);
stepper.moveTo(200); // one turn of a 200-step motor at full step
}
void loop() {
stepper.run();
if (!reported && stepper.distanceToGo() == 0) {
reported = true;
Serial.print("done after ");
Serial.print(millis());
Serial.println(" ms");
}
}Bu kodu düzenleyicide açSadece kod: düzenleyici, kartı ve koddan okuyabildiği parçaları yerleştirir.
Teklemeye neden olan hata: loop() içinde delay()
run() çağrı başına en çok bir adım attığından, loop() içindeki her yavaş şey hızı sınırlar. Yukarıdaki 1000 adımlık hareket 3893 ms sürdü. delay(10) loop()'e eklendiğinde 10802 ms sürdü, çünkü motor setMaxSpeed() ne derse desin, her 10 milisaniyede en fazla bir adım atabiliyordu, yani saniyede 100 adım. loop()'i kısa tut ve diğer işleri millis() ile zamanla.
loop() içinde başka hiçbir şey olmasa bile bir tavan vardır. Mokxi'deki bir Uno'da run(), setMaxSpeed() ne kadar yüksek ayarlanırsa ayarlansın saniyede en fazla yaklaşık 3900 adım attı, çünkü her adımdan sonra sonraki aralığı kayan noktalı hesaplar, üç bölme ve birkaç çarpma, ki Uno bunları yazılımla yapar. Adım başına aritmetik yapmayan runSpeed(), setSpeed(10000) ile bir saniyede 9281 adım attı. Özgün kütüphanenin belgeleri bir Uno için saniyede yaklaşık 4000 adım verir.
Bu devreyi düzenleyicide aç. Arduino Uno: bu sayfanın üstünde çalıştığı haliyle kablolanmış, AccelStepper'lı bir döner tabla. Bir parçayı veya değeri değiştir ve yeniden çalıştır.
Devreyi açSorular
AccelStepper Mokxi'ye hazır mı?
Evet. AccelStepper.h ve MultiStepper.h hazırdır, kütüphanenin belgelenmiş çağrıları ve hız profiliyle yazılmışlardır, yani onları içeren kod olduğu gibi derlenir.
run() ile runSpeed() arasındaki fark nedir?
run(), moveTo()'nun belirlediği hedefe doğru ivmelenir ve üzerinde yavaşlayarak durur. runSpeed(), setSpeed()'in belirlediği sabit hızda adım atar, ivme yoktur ve hedef yoktur. İkisi de çağrı başına en fazla bir adım atar, o yüzden onları olabildiğince sık çağır.
Motorum dönmediği halde currentPosition() neden değişir?
AccelStepper gönderdiği adımları sayar, şaftın attığı adımları değil. Bir 28BYJ-48'de yaygın neden pin sırasıdır: pinleri IN1, IN3, IN2, IN4 olarak ver. Bir sürücü kartında EN'yi, RST'den SLP'ye bağı ve motor beslemesini kontrol et.
AccelStepper'da bir 28BYJ-48'nin bir dönüşü kaç adımdır?
Veri sayfasındaki 64'e 1 dişli kutusuyla HALF4WIRE'da 4096 ve FULL4WIRE'da 2048.
Devam et
Bu sayfadaki bilgiler nereden geliyor
Bunu gerçekten kur
Düzenleyiciyi aç, bir değeri değiştir ve sayının onunla birlikte değiştiğini izle. Kurulacak bir şey yok, hesaba da gerek yok.