تعلّم

AccelStepper على Arduino: الدوال run() والتسارع والعودة للنقطة الصفرية وMultiStepper

متوسط

أو تصفّح كل الدروس.

  • 526قطعة على المنضدة
  • 46لوحة تعمل الآن
  • 1.00xزمن حقيقي، على كل لوحة
Arduino Uno: قرص دوّار بمحرك خطوي عبر AccelStepperمباشر0.000 s 0.00x
اضغط الزر
اضغط الزر. تقوم AccelStepper بتدوير المحرك 28BYJ-48 ثمن دورة في كل مرة، أي 512 خطوة نصفية في كل توقّف، مع منحدر تسارع عند كل طرف.

AccelStepper هي مكتبة المحركات الخطوية التي تنتهي إليها معظم مشاريع Arduino، لأنها تسرّع المحرك وتبطّئه، وهو ما لا تفعله مكتبة Stepper العادية، وتفعل ذلك بخطوة واحدة في كل استدعاء، فيبقى باقي الكود يعمل. في Mokxi هي مدمجة، ومعها MultiStepper.h.

الدائرة أعلاه قرص دوّار للتصوير: محرك 28BYJ-48 على لوحته ULN2003، ولوحة Uno، وزر تشغيل. اضغط الزر فيدور القرص دورة كاملة في ثماني توقفات من 512 خطوة نصفية، مع تسارع وتباطؤ في كل واحدة، بينما تحسب الشاشة التسلسلية عدد الصور.

كل رقم في هذه الصفحة طبعته شيفرة تعمل على محرك Mokxi، على محرك 28BYJ-48 أو على NEMA 17 خلف مشغّل A4988.

أنشئ محركًا: DRIVER لمشغّل A4988، وHALF4WIRE لمحرك 28BYJ-48

المُنشئ يحدد كيفية توصيل المحرك. AccelStepper stepper(AccelStepper::DRIVER, 3, 4); يعني لوحة مشغّل تستقبل STEP وDIR، مثل A4988 أو DRV8825، مع تسمية STEP أولًا. وAccelStepper stepper(AccelStepper::HALF4WIRE, 8, 10, 9, 11); يعني أربعة أطراف موصولة مباشرة بلوحة ULN2003 بخطوات نصفية، وFULL4WIRE هو الأطراف الأربعة نفسها بخطوات كاملة.

بعد ذلك كل رقم يكون بوحدة اختارها المُنشئ. المحرك 28BYJ-48 يكمل دورة في 4096 خطوة مع HALF4WIRE وفي 2048 خطوة مع FULL4WIRE. والمحرك NEMA 17 ذو الـ 200 خطوة يكمل دورة في 200 نبضة STEP عند الخطوة الكاملة وفي 3200 عند 1/16، لأنه في وضع DRIVER تعادل كل خطوة AccelStepper نبضة واحدة، والمشغّل هو الذي يحدد كم تقطع النبضة من مسافة.

الكود أدناه يحرك محرك 28BYJ-48 ربع دورة. وقد طبع "at 1024 after 3116 ms" وتوقف المحور عند 90.0 درجة.

محرك 28BYJ-48 على HALF4WIRE، ربع دورة
#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");
  }
}

افتح هذا الكود في المحررالكود وحده: يضع المحرر اللوحة والقطع التي يستطيع قراءتها من الكود.

لماذا تدخل أطراف 28BYJ-48 بالترتيب 8, 10, 9, 11

ترقّم AccelStepper أطرافها الأربعة لمحرك على جسرين H، حيث الطرفان الأولان لملف واحد والطرفان الأخيران للآخر. أما لوحة ULN2003 فترقّم ملفاتها الأربعة بالترتيب حول المحرك. تسليم الأطراف بالترتيب IN1, IN3, IN2, IN4 هو ما يجعل تسلسل المكتبة يدور على تلك الملفات واحدًا تلو الآخر.

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() و runToPosition()

run() تنفّذ خطوة واحدة على الأكثر في كل استدعاء، عند حلول موعدها، وتحسب سرعة الخطوة التالية من التسارع، فمكانها في loop() دون شيء بطيء بجانبها. وrunSpeed() تخطو بالسرعة الثابتة التي أعطتها إياها setSpeed()، بلا منحدر وبلا هدف. أما runToPosition() وrunToNewPosition() فتناديان run() حتى يصل المحرك، ولا يعمل أي شيء آخر حتى تعودا.

هذه run() على محرك NEMA 17 خلف A4988 بخطوة كاملة، مع setMaxSpeed(500) وsetAcceleration(250) وmoveTo(1000)، وتطبع الوقت والموضع والسرعة كل نصف ثانية. وقد طبعت "500 35 133" ثم "1000 132 257" ثم "1500 291 381" ثم "2000 512 493" وهي القمة، ثم "2500 727 369" و"3000 880 245" و"3500 971 121"، ثم "at 1000 after 3893 ms". الحساب يقول أربع ثوانٍ: ثانيتان للوصول إلى 500 خطوة في الثانية بتسارع 250 في الثانية المربعة، قطعت فيهما 500 خطوة، وثانيتان للتوقف.

الحركة نفسها مع runToNewPosition(1000) طبعت "there after 3889 ms" وحركة العودة طبعت "back after 7779 ms"، ولا شيء بينهما، لأن loop() لم تعمل قط. وrunSpeed() مع setSpeed(200) قطعت 199 خطوة في ثانيتها الأولى: سرعة ثابتة من الخطوة الأولى، وبلا منحدر.

‎run()‎ على A4988، مع طباعة المنحدر
#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");
  }
}

افتح هذا الكود في المحررالكود وحده: يضع المحرر اللوحة والقطع التي يستطيع قراءتها من الكود.

‎setMaxSpeed()‎ و‎setAcceleration()‎: لماذا يهم المنحدر

تقول صحيفة بيانات 28BYJ-48 إنه ينطلق من السكون حتى 600 خطوة في الثانية ويواكب أكثر من 1000 بعد أن يدور، ونموذج Mokxi يحتوي الرقمين معًا.

فطلبنا منه 900 خطوة كاملة في الثانية، مع FULL4WIRE وmoveTo(2048)، أي دورة واحدة. مع setAcceleration(500) طبع "at 2048 after 4054 ms" ودار المحور دورة كاملة. ومع setAcceleration(100000)، أي بلا منحدر إطلاقًا، طبع "at 2048 after 2304 ms" وانتهى المحور على بعد 0.8 درجة من نقطة البداية: فقد ما يقارب كل خطوة. وقد أبلغت المكتبة عن الموضع نفسه في المرتين.

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 في Mokxi يواكب حتى 1000 خطوة كاملة في الثانية مهما كان التسارع. المحرك الحقيقي يفقد عزمه مع زيادة السرعة، وهو ما لا يحاكيه Mokxi، فعلى المنضدة الحقيقية يصبح المنحدر أهم.

A4988 أو DRV8825: وضع DRIVER وطرف التمكين

في وضع DRIVER تُبقي المكتبة STEP مرتفعًا لمدة setMinPulseWidth() ميكروثانية، و1 هي القيمة الافتراضية؛ وDRV8825 يحتاج 1.9، فنادِ setMinPulseWidth(2). وعند خطوة 1/16 تُضرب كل سرعة كانت صحيحة عند الخطوة الكاملة في 16.

طرف EN في A4988 فعّال عند المستوى المنخفض. سلّمه مع setEnablePin(8) وsetPinsInverted(false, false, true)، وdisableOutputs() تترك المحور حرًا بعد الحركة، وهذا يبقي الأمور باردة مقابل فقدان عزم التثبيت.

إجراء العودة إلى نقطة البداية بمفتاح نهاية

عند التشغيل تعتقد AccelStepper أن المحرك عند 0. العودة إلى نقطة البداية تصحح ذلك: تقدّم ببطء نحو مفتاح حتى ينغلق، نادِ setCurrentPosition(0)، ثم عدّ من هناك.

في Mokxi آلية لتجربة ذلك: الخزانة في مشروع ماكينة الألعاب ذات المخلب، التي يقود محورها محرك NEMA 17 بحزام GT2، 0.2 mm للخطوة الكاملة، مع مفتاح ذراعي عند طرف البداية يضغطه العربة في آخر خُمس الملليمتر. وضعنا محور X على A4988 بخطوة كاملة، والمفتاح على الطرف 2 مع مقاومة الرفع الداخلية للطرف، وشغّلنا الكود أدناه. مع العربة على بعد 120 mm طبع "switch closed after 601 steps, 3006 ms" ثم "at 500, switch 1": على بعد 100 mm وخارج المفتاح مجددًا. ومن 60 mm استغرق 301 خطوة. وعند نزع سلك المفتاح طبع "homing failed: no switch within 1200 steps" بدلًا من دفع العربة إلى النهاية إلى الأبد، وهذا هو السطر الذي يحتاجه كل إجراء عودة إلى نقطة البداية.

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() {}

افتح هذا الكود في المحررالكود وحده: يضع المحرر اللوحة والقطع التي يستطيع قراءتها من الكود.

MultiStepper: محركان يصلان معًا

تحرّك MultiStepper عدة محركات AccelStepper بحيث تنتهي جميعها في اللحظة نفسها، كما تحتاج آلة الرسم لخط مستقيم. يجد الحركة التي تستغرق أطول وقت عند سرعتها القصوى ويُبطئ البقية لتطابقها، دون أي تسارع.

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() {}

افتح هذا الكود في المحررالكود وحده: يضع المحرر اللوحة والقطع التي يستطيع قراءتها من الكود.

AccelStepper على ESP32

على ESP32 لا يتغير سوى الأطراف ومستوى المنطق: تعتبر دائرة A4988 الإشارة مرتفعة عند 0.7 من جهد VDD، أي 3.5 فولت عند 5 فولت، وهو ما لا يصل إليه طرف بجهد 3.3 فولت أبدًا. شغّلنا الكود أدناه على ESP32-C3، مع STEP على GPIO 4 وDIR على GPIO 5. مع توصيل VDD لدائرة A4988 بـ5 فولت طُبع "done after 1869 ms" ولم يتحرك العمود إطلاقًا. ومع توصيل VDD بطرف 3.3 فولت على اللوحة دار دورة واحدة. أما DRV8825 فيقرأ 2.2 فولت كإشارة مرتفعة، فلا يحتاج إلى أي تغيير.

AccelStepper على ESP32-C3 ودائرة 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");
  }
}

افتح هذا الكود في المحررالكود وحده: يضع المحرر اللوحة والقطع التي يستطيع قراءتها من الكود.

الخطأ الذي يجعله يتحرك بتقطّع: delay() في loop()

لأن run() ينجز خطوة واحدة على الأكثر في كل استدعاء، فإن أي شيء بطيء داخل loop() يحدّ من السرعة. استغرقت حركة الـ1000 خطوة أعلاه 3893 ms. وبعد إضافة delay(10) إلى loop() استغرقت 10802 ms، لأن المحرك لم يستطع أداء أكثر من خطوة واحدة كل 10 ميلي ثانية، أي 100 في الثانية، مهما قالت setMaxSpeed(). أبقِ loop() قصيرًا وحدّد توقيت الأعمال الأخرى بـmillis().

هناك حد أقصى حتى مع عدم وجود شيء آخر في loop(). على لوحة Uno في Mokxi، أنجز run() نحو 3900 خطوة في الثانية كحد أقصى، مهما رُفع setMaxSpeed()، لأنه بعد كل خطوة يحسب الفاصل التالي بالفاصلة العائمة: ثلاث عمليات قسمة وعدد من عمليات الضرب، تنجزها Uno برمجيًا. أما runSpeed()، الذي لا يجري أي حسابات لكل خطوة، فقد أنجز 9281 خطوة في ثانية واحدة عند setSpeed(10000). تذكر وثائق المكتبة الأصلية نحو 4000 خطوة في الثانية على Uno.

افتح هذه الدائرة في المحرر. Arduino Uno: قرص دوّار بمحرك AccelStepper، موصول كما يعمل في أعلى هذه الصفحة. غيّر قطعة أو قيمة وشغّله مرة أخرى.

افتح الدائرة

الأسئلة

هل مكتبة AccelStepper مدمجة في Mokxi؟

نعم. الملفان AccelStepper.h وMultiStepper.h مدمجان، كُتبا من الاستدعاءات الموثقة للمكتبة ومن منحنى السرعة الخاص بها، لذا فأي كود يتضمنهما تتم ترجمته كما هو.

ما الفرق بين run() وrunSpeed()؟

run() يتسارع نحو الهدف الذي حدده moveTo() ويتباطأ ليتوقف عنده. أما runSpeed() فيخطو بالسرعة الثابتة التي حددها setSpeed()، دون تسارع ودون هدف. كلاهما ينجز خطوة واحدة على الأكثر في كل استدعاء، فاستدعهما بأكبر قدر ممكن.

لماذا يتغير currentPosition() بينما محركي لا يتحرك؟

يعدّ AccelStepper الخطوات التي يرسلها، لا الخطوات التي يؤديها العمود. على محرك 28BYJ-48 يكون السبب المعتاد هو ترتيب الأطراف: أعطِ الأطراف بالترتيب IN1 وIN3 وIN2 وIN4. وعلى لوحة التشغيل، تحقق من EN ومن الوصلة بين RST وSLP ومن تغذية المحرك.

كم خطوة في دورة واحدة لمحرك 28BYJ-48 في AccelStepper؟

4096 مع HALF4WIRE و2048 مع FULL4WIRE، باستخدام علبة التروس 64 إلى 1 الموثقة في ورقة البيانات.

ابنِ هذا على أرض الواقع

افتح المحرر وغيّر قيمة وشاهد الرقم يتحرك معها. لا شيء لتثبّته ولا حاجة إلى حساب.