Học

AccelStepper trên Arduino: run(), gia tốc, homing và MultiStepper

Trung bình

Hoặc xem mọi bài học.

  • 526linh kiện trên bàn làm mạch
  • 46bo mạch đang chạy
  • 1.00xthời gian thực, trên mọi bo mạch
Arduino Uno: bàn xoay AccelSteppertrực tiếp0.000 s 0.00x
Nhấn nút
Nhấn nút. AccelStepper quay 28BYJ-48 một phần tám vòng mỗi lần, mỗi chặng 512 half-step, với một đoạn tăng giảm tốc ở hai đầu.

AccelStepper là thư viện động cơ bước mà phần lớn dự án Arduino cuối cùng đều dùng tới, vì nó làm động cơ tăng tốc rồi giảm tốc, điều mà thư viện Stepper thông thường không làm được, và mỗi lần gọi nó chỉ đi một bước, nên phần còn lại của sketch vẫn chạy bình thường. Trong Mokxi thư viện này có sẵn, kèm theo MultiStepper.h.

Mạch ở trên là một bàn xoay để chụp ảnh: một động cơ 28BYJ-48 gắn trên bo ULN2003, một bo mạch Uno và một nút khởi động. Nhấn nút và đĩa xoay tròn một vòng trong tám chặng 512 half-step, tăng giảm êm ở đầu và cuối mỗi chặng, trong khi Serial Monitor đếm số ảnh.

Mọi con số trên trang này được in ra từ một sketch chạy trên engine của Mokxi, trên một 28BYJ-48 hoặc trên một NEMA 17 qua A4988.

Khai báo động cơ: DRIVER cho A4988, HALF4WIRE cho 28BYJ-48

Hàm khởi tạo cho biết động cơ được nối như thế nào. AccelStepper stepper(AccelStepper::DRIVER, 3, 4); là một bo driver nhận STEP và DIR, ví dụ A4988 hoặc DRV8825, với STEP được ghi trước. AccelStepper stepper(AccelStepper::HALF4WIRE, 8, 10, 9, 11); là bốn chân nối thẳng vào bo ULN2003, chế độ half-step, còn FULL4WIRE là cùng bốn chân đó nhưng ở chế độ full step.

Mọi con số sau đó đều theo đơn vị mà hàm khởi tạo đã chọn. Một 28BYJ-48 xoay tròn một vòng trong 4096 bước với HALF4WIRE và 2048 bước với FULL4WIRE. Một NEMA 17 200 bước xoay một vòng với 200 xung STEP ở full step và 3200 xung ở 1/16, vì ở chế độ DRIVER một bước của AccelStepper là một xung, và driver quyết định mỗi xung đi được bao xa.

Sketch dưới đây quay một 28BYJ-48 một phần tư vòng. Nó in ra "at 1024 after 3116 ms" và trục dừng ở 90.0 độ.

Một 28BYJ-48 ở HALF4WIRE, một phần tư vòng
#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");
  }
}

Mở sketch này trong trình soạn codeChỉ riêng phần code: trình soạn code sẽ tự đặt bo mạch và các linh kiện mà nó đọc được từ sketch.

Vì sao bốn chân của 28BYJ-48 cắm theo thứ tự 8, 10, 9, 11

AccelStepper đánh số bốn chân của nó theo kiểu động cơ nối vào hai cầu H, trong đó hai chân đầu là một cuộn dây và hai chân sau là cuộn kia. Bo ULN2003 lại đánh số bốn cuộn dây theo thứ tự quanh động cơ. Đưa các chân vào theo thứ tự IN1, IN3, IN2, IN4 là điều khiến chuỗi bước của thư viện lần lượt kích hoạt các cuộn dây quanh vòng.

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() và runToPosition()

run() đi nhiều nhất một bước mỗi lần gọi, khi đến giờ, và tính tốc độ bước tiếp theo từ gia tốc, nên nó thuộc về loop() và không để gì chậm bên cạnh. runSpeed() bước với tốc độ không đổi mà setSpeed() đã đặt, không tăng giảm tốc và không có vị trí đích. runToPosition() và runToNewPosition() gọi run() cho tới khi động cơ đến nơi, và không có gì khác chạy cho đến khi chúng kết thúc.

Đây là run() trên một NEMA 17 qua A4988 ở full step, với setMaxSpeed(500), setAcceleration(250) và moveTo(1000), in thời gian, vị trí và tốc độ mỗi nửa giây. Nó in "500 35 133", "1000 132 257", "1500 291 381" và "2000 512 493", điểm cao nhất, rồi "2500 727 369", "3000 880 245" và "3500 971 121", rồi "at 1000 after 3893 ms". Tính toán cho ra bốn giây: hai giây để đạt 500 bước một giây với gia tốc 250 bước mỗi giây bình phương, đi được 500 bước, và hai giây để dừng.

Cú di chuyển tương tự với runToNewPosition(1000) in "there after 3889 ms" và lượt quay về in "back after 7779 ms", không có gì ở giữa, vì loop() không hề chạy. runSpeed() với setSpeed(200) đi được 199 bước trong giây đầu: tốc độ không đổi ngay từ bước đầu, và không tăng giảm.

run() trên A4988, in ra đường tăng giảm tốc
#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");
  }
}

Mở sketch này trong trình soạn codeChỉ riêng phần code: trình soạn code sẽ tự đặt bo mạch và các linh kiện mà nó đọc được từ sketch.

setMaxSpeed() và setAcceleration(): vì sao đường tăng giảm tốc quan trọng

Datasheet của 28BYJ-48 cho biết nó khởi động từ lúc đứng yên tới 600 bước một giây và theo nổi hơn 1000 khi đã quay, và mô hình của Mokxi có cả hai con số đó.

Vậy mình yêu cầu nó 900 full step một giây, FULL4WIRE và moveTo(2048), tức một vòng. Với setAcceleration(500) nó in "at 2048 after 4054 ms" và trục quay trọn một vòng. Với setAcceleration(100000), tức không tăng giảm tốc chút nào, nó in "at 2048 after 2304 ms" và trục dừng cách điểm xuất phát 0.8 độ: nó mất gần như mọi bước. Cả hai lần thư viện đều báo cùng một vị trí.

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 của Mokxi theo nổi tới 1000 full step một giây bất kể gia tốc. Động cơ thật mất mô men khi quay nhanh, điều Mokxi không mô phỏng, nên ngoài đời thực đường tăng giảm tốc còn quan trọng hơn.

A4988 hoặc DRV8825: chế độ DRIVER và chân enable

Ở chế độ DRIVER thư viện giữ STEP ở mức cao trong setMinPulseWidth() micro giây, mặc định là 1; DRV8825 cần 1.9, nên hãy gọi setMinPulseWidth(2). Ở 1/16 step, mọi tốc độ đúng ở full step đều phải nhân với 16.

Chân EN của A4988 hoạt động ở mức thấp. Đưa nó vào với setEnablePin(8) và setPinsInverted(false, false, true), rồi disableOutputs() nhả trục sau mỗi lần di chuyển, giúp mát hơn với cái giá là mất mô men giữ.

Một thủ tục homing với công tắc giới hạn

Khi mới lên nguồn AccelStepper tin rằng động cơ đang ở 0. Homing khắc phục điều đó: tiến chậm về phía công tắc cho tới khi nó đóng, gọi setCurrentPosition(0), rồi đếm từ đó.

Mokxi có một cơ chế để thử: tủ máy trong dự án máy gắp đồ, với giàn X là một NEMA 17 chạy đai GT2, 0.2 mm mỗi full step, có công tắc cần gạt ở đầu home mà xe chạy đè vào trong phần năm milimet cuối. Mình đặt trục X của nó lên A4988 ở full step, công tắc vào chân 2 với pull-up của chân, rồi chạy sketch dưới đây. Với xe cách 120 mm, nó in "switch closed after 601 steps, 3006 ms", rồi "at 500, switch 1": cách 100 mm và ra khỏi công tắc. Từ 60 mm nó mất 301 bước. Tháo dây công tắc ra thì nó in "homing failed: no switch within 1200 steps" thay vì cứ lao xe mãi vào điểm cuối, đó là dòng lệnh mà mọi thủ tục homing đều cần.

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.

Đưa trục về điểm gốc bằng công tắc
#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() {}

Mở sketch này trong trình soạn codeChỉ riêng phần code: trình soạn code sẽ tự đặt bo mạch và các linh kiện mà nó đọc được từ sketch.

MultiStepper: hai động cơ đến đích cùng lúc

MultiStepper điều khiển nhiều AccelStepper để chúng kết thúc cùng một thời điểm, như máy vẽ cần cho một đường thẳng. Nó tìm bước di chuyển lâu nhất ở tốc độ tối đa của chính nó và làm chậm các động cơ khác cho khớp, không có gia tốc.

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.

MultiStepper with two A4988s
#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() {}

Mở sketch này trong trình soạn codeChỉ riêng phần code: trình soạn code sẽ tự đặt bo mạch và các linh kiện mà nó đọc được từ sketch.

AccelStepper trên ESP32

Trên ESP32 chỉ các chân và mức logic thay đổi: A4988 tính một mức cao từ 0.7 VDD của nó, tức 3.5 V khi cấp 5 V, mức mà chân 3.3 V không bao giờ đạt được. Chúng tôi đã chạy sketch dưới đây trên ESP32-C3, STEP ở chân GPIO 4 và DIR ở chân GPIO 5. Với VDD của A4988 ở 5 V, nó in ra "done after 1869 ms" và trục không hề quay. Với VDD ở chân 3.3 V của bo mạch, nó quay được một vòng. DRV8825 coi 2.2 V là mức cao nên không cần thay đổi gì.

AccelStepper trên ESP32-C3 và A4988
#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");
  }
}

Mở sketch này trong trình soạn codeChỉ riêng phần code: trình soạn code sẽ tự đặt bo mạch và các linh kiện mà nó đọc được từ sketch.

Lỗi làm động cơ giật cục: delay() trong loop()

Vì run() thực hiện nhiều nhất một bước mỗi lần gọi, bất cứ thứ gì chậm trong loop() đều giới hạn tốc độ. Bước di chuyển 1000 bước ở trên mất 3893 ms. Khi thêm delay(10) vào loop() thì mất 10802 ms, vì động cơ chỉ có thể thực hiện nhiều nhất một bước mỗi 10 mili giây, tức 100 bước mỗi giây, bất kể setMaxSpeed() đặt là bao nhiêu. Hãy giữ loop() ngắn gọn và dùng millis() để định thời cho việc khác.

Ngay cả khi không có gì khác trong loop() vẫn có giới hạn. Trên một bo Uno trong Mokxi, run() đạt tối đa khoảng 3900 bước mỗi giây, dù setMaxSpeed() đặt cao đến đâu, vì sau mỗi bước nó tính khoảng thời gian tiếp theo bằng số thực dấu phẩy động, ba phép chia và vài phép nhân, thứ mà Uno thực hiện bằng phần mềm. runSpeed(), không làm phép tính nào mỗi bước, đã thực hiện 9281 bước trong một giây với setSpeed(10000). Tài liệu của thư viện gốc ghi khoảng 4000 bước mỗi giây trên một Uno.

Mở mạch này trong trình soạn thảo. Arduino Uno: một bàn xoay AccelStepper, được nối dây như khi nó chạy ở đầu trang này. Hãy thay đổi một linh kiện hoặc một giá trị rồi chạy lại.

Mở mạch

Câu hỏi

AccelStepper có được tích hợp sẵn trong Mokxi không?

Có. AccelStepper.h và MultiStepper.h được tích hợp sẵn, viết theo các lệnh và đường cong tốc độ được tài liệu hóa của thư viện, nên sketch có include chúng sẽ biên dịch được ngay.

Sự khác biệt giữa run() và runSpeed() là gì?

run() tăng tốc về mục tiêu mà moveTo() đặt và giảm tốc để dừng đúng ở đó. runSpeed() bước với tốc độ không đổi mà setSpeed() đặt, không có gia tốc và không có mục tiêu. Cả hai đều thực hiện nhiều nhất một bước mỗi lần gọi, nên hãy gọi chúng càng thường xuyên càng tốt.

Tại sao currentPosition() thay đổi khi động cơ của tôi không quay?

AccelStepper đếm các bước nó gửi đi, chứ không phải các bước mà trục thực hiện. Trên 28BYJ-48, nguyên nhân thường gặp là thứ tự chân: hãy đưa các chân theo thứ tự IN1, IN3, IN2, IN4. Trên bo driver, hãy kiểm tra EN, dây nối từ RST sang SLP và nguồn cấp cho động cơ.

Một vòng quay của 28BYJ-48 trong AccelStepper là bao nhiêu bước?

4096 với HALF4WIRE và 2048 với FULL4WIRE, theo hộp số tỉ số 64:1 trong datasheet.

Lắp mạch này ngoài đời

Mở trình soạn thảo, đổi một giá trị và xem con số thay đổi theo. Không cần cài gì, không cần tài khoản.