AccelStepper di Arduino: run(), akselerasi, homing dan MultiStepper
Menengah
Atau lihat semua pelajaran.
- 526komponen di meja kerja
- 46board sedang berjalan
- 1.00xwaktu nyata, di semua board
AccelStepper adalah library stepper yang akhirnya dipakai hampir semua proyek Arduino, karena ia mempercepat dan memperlambat motor, yang tidak dilakukan library Stepper biasa, dan melakukannya satu langkah per pemanggilan, jadi bagian sketch lainnya tetap jalan. Di Mokxi library ini sudah bawaan, dengan MultiStepper.h di sebelahnya.
Rangkaian di atas adalah turntable foto: sebuah 28BYJ-48 dengan board ULN2003-nya, sebuah Uno, dan tombol start. Tekan tombolnya dan piringan berputar satu lingkaran penuh dalam delapan hentian 512 half-step, mulai dan berhenti dengan halus, sementara Serial Monitor menghitung jumlah foto.
Setiap angka di halaman ini dicetak oleh sketch yang dijalankan di engine Mokxi, pada 28BYJ-48 atau NEMA 17 dengan A4988.
Buat motornya: DRIVER untuk A4988, HALF4WIRE untuk 28BYJ-48
Konstruktornya menentukan bagaimana motor disambungkan. AccelStepper stepper(AccelStepper::DRIVER, 3, 4); adalah board driver yang menerima STEP dan DIR, misalnya A4988 atau DRV8825, dengan STEP ditulis lebih dulu. AccelStepper stepper(AccelStepper::HALF4WIRE, 8, 10, 9, 11); adalah empat pin langsung ke board ULN2003, dengan half-stepping, dan FULL4WIRE adalah empat pin yang sama dengan full step.
Setiap angka setelahnya memakai satuan yang dipilih konstruktor itu. 28BYJ-48 berputar sekali dalam 4096 langkah dengan HALF4WIRE dan dalam 2048 dengan FULL4WIRE. NEMA 17 200 langkah berputar sekali dalam 200 pulsa STEP pada full step dan dalam 3200 pada 1/16, karena di mode DRIVER satu langkah AccelStepper adalah satu pulsa dan driver yang menentukan seberapa jauh satu pulsa bergerak.
Sketch di bawah memutar 28BYJ-48 seperempat putaran. Ia mencetak "at 1024 after 3116 ms" dan meninggalkan poros di 90.0 derajat.
#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");
}
}Buka sketch ini di editorKodenya saja: editor menempatkan board dan komponen yang bisa dibacanya dari sketch.
Kenapa pin 28BYJ-48 disambungkan sebagai 8, 10, 9, 11
AccelStepper menomori empat pin-nya untuk motor pada dua H bridge, di mana dua pin pertama adalah satu kumparan dan dua pin terakhir kumparan lainnya. Board ULN2003 menomori empat kumparannya berurutan mengelilingi motor. Menyerahkan pin sebagai IN1, IN3, IN2, IN4 itulah yang membuat urutan library berjalan menyalakan kumparan-kumparan itu secara bergantian.
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() dan runToPosition()
run() membuat paling banyak satu langkah per panggilan, saat jatuh tempo, dan menghitung kecepatan langkah berikutnya dari akselerasi, jadi tempatnya di loop() tanpa apa pun yang lambat di sebelahnya. runSpeed() melangkah pada kecepatan konstan yang diberikan setSpeed(), tanpa ramp dan tanpa target. runToPosition() dan runToNewPosition() memanggil run() sampai motor tiba, dan tidak ada yang lain berjalan sampai keduanya selesai.
Ini run() pada NEMA 17 dengan A4988 di full step, dengan setMaxSpeed(500), setAcceleration(250) dan moveTo(1000), mencetak waktu, posisi dan kecepatan setiap setengah detik. Hasilnya "500 35 133", "1000 132 257", "1500 291 381" dan "2000 512 493", puncaknya, lalu "2500 727 369", "3000 880 245" dan "3500 971 121", dan "at 1000 after 3893 ms". Hitungannya menyebut empat detik: dua detik untuk mencapai 500 langkah per detik pada 250 langkah per detik kuadrat, menempuh 500 langkah, dan dua detik untuk berhenti.
Pergerakan yang sama dengan runToNewPosition(1000) mencetak "there after 3889 ms" dan pergerakan kembali "back after 7779 ms", tanpa apa pun di antaranya, karena loop() tidak pernah berjalan. runSpeed() dengan setSpeed(200) membuat 199 langkah pada detik pertamanya: kecepatan konstan sejak langkah pertama, dan tanpa ramp.
#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");
}
}Buka sketch ini di editorKodenya saja: editor menempatkan board dan komponen yang bisa dibacanya dari sketch.
setMaxSpeed() dan setAcceleration(): mengapa ramp penting
Datasheet 28BYJ-48 menyebut motor ini bisa mulai dari diam hingga 600 langkah per detik dan mengikuti lebih dari 1000 langkah per detik saat sudah berputar, dan model Mokxi memuat kedua angka itu.
Jadi kita memintanya 900 full step per detik, FULL4WIRE dan moveTo(2048), yaitu satu putaran. Dengan setAcceleration(500) hasilnya "at 2048 after 4054 ms" dan poros berputar sehingga selesai satu putaran. Dengan setAcceleration(100000), yang berarti tanpa ramp sama sekali, hasilnya "at 2048 after 2304 ms" dan poros berakhir 0,8 derajat dari titik awalnya: hampir setiap langkahnya hilang. Library melaporkan posisi yang sama pada kedua kasus.
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.
NEMA 17 buatan Mokxi mengikuti hingga 1000 full step per detik berapa pun akselerasinya. Motor aslinya kehilangan torsi saat makin cepat, yang tidak dimodelkan Mokxi, jadi di meja kerja nyata ramp lebih penting.
A4988 atau DRV8825: mode DRIVER dan pin enable
Pada mode DRIVER library menahan STEP high selama setMinPulseWidth() mikrodetik, defaultnya 1; DRV8825 butuh 1,9, jadi panggil setMinPulseWidth(2). Pada 1/16 step, semua kecepatan yang sudah pas di full step perlu dikalikan 16.
Pin EN pada A4988 aktif low. Serahkan dengan setEnablePin(8) dan setPinsInverted(false, false, true), lalu disableOutputs() membiarkan poros lepas setelah bergerak, yang menjaga suhu tetap dingin dengan mengorbankan holding torque.
Rutin homing dengan limit switch
Saat dinyalakan AccelStepper menganggap motor berada di 0. Homing memperbaikinya: merayap mendekati saklar sampai menutup, panggil setCurrentPosition(0), dan hitung dari sana.
Mokxi punya mekanisme untuk mencobanya: kabinet pada proyek arcade claw, yang gantry-nya adalah NEMA 17 dengan belt GT2, 0,2 mm per full step, dengan lever switch di ujung home yang ditekan carriage pada seperlima milimeter terakhir. Kita pasang sumbu X-nya pada A4988 di full step dan saklarnya di pin 2 dengan pull-up pin, lalu menjalankan sketch di bawah. Dengan carriage 120 mm keluar, hasilnya "switch closed after 601 steps, 3006 ms", lalu "at 500, switch 1": 100 mm keluar dan sudah lepas dari saklar lagi. Dari 60 mm butuh 301 langkah. Dengan kabel saklarnya dilepas, hasilnya "homing failed: no switch within 1200 steps", bukan mendorong carriage ke ujung selamanya, itulah baris yang dibutuhkan setiap rutin homing.
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() {}Buka sketch ini di editorKodenya saja: editor menempatkan board dan komponen yang bisa dibacanya dari sketch.
MultiStepper: dua motor yang tiba bersamaan
MultiStepper menggerakkan beberapa AccelStepper agar selesai pada saat yang sama, seperti yang dibutuhkan plotter untuk garis lurus. Ia mencari gerakan yang paling lama pada kecepatan maksimumnya sendiri dan memperlambat yang lain agar cocok, tanpa akselerasi.
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() {}Buka sketch ini di editorKodenya saja: editor menempatkan board dan komponen yang bisa dibacanya dari sketch.
AccelStepper pada ESP32
Pada ESP32 hanya pin dan level logikanya yang berubah: A4988 menghitung tegangan tinggi mulai dari 0,7 VDD-nya, 3,5 V pada 5 V, yang tidak pernah dicapai oleh pin 3,3 V. Kami menjalankan sketch di bawah pada ESP32-C3, STEP di GPIO 4 dan DIR di GPIO 5. Dengan VDD A4988 pada 5 V ia mencetak "done after 1869 ms" dan porosnya tidak bergerak sama sekali. Dengan VDD pada pin 3,3 V board ia berputar sekali. DRV8825 membaca 2,2 V sebagai tinggi, jadi tidak perlu perubahan.
#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");
}
}Buka sketch ini di editorKodenya saja: editor menempatkan board dan komponen yang bisa dibacanya dari sketch.
Kesalahan yang membuatnya tersendat: delay() di loop()
Karena run() membuat paling banyak satu langkah per pemanggilan, apa pun yang lambat di loop() membatasi kecepatannya. Gerakan 1000 langkah di atas memakan waktu 3893 ms. Dengan delay(10) ditambahkan ke loop() ia memakan waktu 10802 ms, karena motor paling banyak bisa membuat satu langkah setiap 10 milidetik, 100 per detik, apa pun kata setMaxSpeed(). Jaga loop() tetap singkat dan atur waktu kerja lain dengan millis().
Ada batas kecepatan walaupun tidak ada apa pun lain di loop(). Pada Uno di Mokxi, run() membuat sekitar 3900 langkah per detik paling banyak, setinggi apa pun setMaxSpeed() diatur, karena setelah setiap langkah ia menghitung interval berikutnya dalam bilangan pecahan, tiga pembagian dan beberapa perkalian, yang dikerjakan Uno dengan software. runSpeed(), yang tidak melakukan aritmetika per langkah, membuat 9281 langkah dalam satu detik pada setSpeed(10000). Dokumentasi library aslinya menyebut sekitar 4000 langkah per detik untuk Uno.
Buka rangkaian ini di editor. Arduino Uno: turntable AccelStepper, dirangkai seperti yang dijalankan di bagian atas halaman ini. Ubah komponen atau nilainya dan jalankan lagi.
Buka rangkaian iniPertanyaan
Apakah AccelStepper bawaan Mokxi?
Ya. AccelStepper.h dan MultiStepper.h adalah bawaan, ditulis dari panggilan dan profil kecepatan yang terdokumentasi pada library tersebut, jadi sketch yang menyertakannya bisa dikompilasi apa adanya.
Apa bedanya run() dan runSpeed()?
run() mempercepat menuju target yang diatur moveTo() dan melambat untuk berhenti tepat di sana. runSpeed() melangkah dengan kecepatan konstan yang diatur setSpeed(), tanpa akselerasi dan tanpa target. Keduanya membuat paling banyak satu langkah per pemanggilan, jadi panggil sesering mungkin.
Kenapa currentPosition() berubah padahal motorku tidak bergerak?
AccelStepper menghitung langkah yang dikirimnya, bukan langkah yang dibuat porosnya. Pada 28BYJ-48 penyebab yang paling umum adalah urutan pin: berikan pin sebagai IN1, IN3, IN2, IN4. Pada board driver, periksa EN, kabel dari RST ke SLP dan catu daya motornya.
Berapa langkah untuk satu putaran 28BYJ-48 di AccelStepper?
4096 dengan HALF4WIRE dan 2048 dengan FULL4WIRE, memakai rasio gearbox 64 banding 1 dari datasheet.
Lanjutkan
Rakit versi nyatanya
Buka editor, ubah sebuah nilai, dan lihat angkanya ikut berubah. Tidak ada yang perlu dipasang, dan tidak perlu akun.