خوارزمية تجنب التصادم بين الرافعة العلوية وAGV

في سيناريوهات التشغيل المشترك متعدد المعدات للرافعات العلوية والمركبات الموجهة الآلية (AGV/RGV)، تحدد خوارزميات تجنب الاصطدام سلامة وكفاءة العمل التعاوني. وعلى عكس التعشيق المتبادل الآمن ذي الحدود الثابتة، تقوم خوارزميات تجنب الاصطدام بحساب معاملات الحركة المثلى لكل معدّة في الوقت الفعلي لتجنب التصادم بشكل استباقي. تقارن هذه المقالة ثلاث خوارزميات رئيسية: DWA وVO وAPF، وتقدم توصية بالخوارزمية الهجينة.

التنفيذ الهندسي لخوارزمية النافذة الديناميكية DWA

الفكرة الأساسية لخوارزمية النافذة الديناميكية (DWA) هي أخذ عينات من فضاء السرعة (v,w) للرافعة العلوية أو المركبة الموجهة الآلية، وحساب دالة التقييم لكل مجموعة سرعات مُختارة، ثم اختيار (v,w) الأعلى تقييماً كأمر حركة للدورة التالية. فضاء السرعة v∈[0,v_max]، w∈[-w_max,w_max]، ودقة أخذ العينات النموذجية: 30 تقسيمًا للسرعة الخطية و30 تقسيمًا للسرعة الزاوية، بإجمالي 900 مجموعة (v,w) لكل دورة أخذ عينات.

دالة التقييم G(v,w)=a·heading(v,w)+b·dist(v,w)+c·vel(v,w). يقيس معامل الاتجاه (heading) انحراف الزاوية بين اتجاه الحركة والاتجاه المستهدف (كلما قل الانحراف كان أفضل)، ويقيس معامل المسافة (dist) المسافة على طول المسار إلى أقرب عائق (كلما زادت المسافة كان أكثر أمانًا)، ويقيس معامل السرعة (vel) مقدار السرعة الخطية (السرعة العالية تعني كفاءة أعلى لكن قدرة أقل على تجنب العوائق). تُطبَّع المعاملات الثلاثة إلى الفترة [0,1] ثم تُجمَع بترجيح مرجّح. زمن التنفيذ الفعلي لخوارزمية DWA على معالج NVIDIA Jetson Orin NX يبلغ حوالي 120~180ms (شامل قراءة البيانات + أخذ عينات السرعة + حساب التقييم + إخراج الأوامر)، وهو ما يفي بمتطلبات دورة 200ms. خوارزمية DWA التي تنشرها كيلود للصناعات الثقيلة على معالج Jetson مطبَّقة بلغة C++، وتستخدم CUDA لتسريع حسابات أخذ العينات بالتوازي، حيث يستغرق التقييم المتوازي لـ 90 مجموعة (v,w) 8ms فقط.

تحسين تكييف DWA لسيناريو الرافعة العلوية: تمتلك الرافعة العلوية درجة حرية واحدة فقط (على طول اتجاه السكة X)، لذلك يُبسَّط فضاء سرعة DWA إلى أخذ عينات أحادي البعد v_x∈[0,v_max] (السرعة الزاوية w تساوي صفرًا دائمًا)، وينخفض عدد مجموعات أخذ العينات من 900 إلى 30 مجموعة، ويمكن تقصير دورة الحساب إلى 30~50ms. من ناحية أخرى، مسافة الكبح للرافعة العلوية أطول من مسافة كبح المركبة الموجهة الآلية (حوالي 0.5m عند سرعة 1m/s)، لذلك يجب زيادة وزن معامل المسافة في دالة التقييم إلى b=0.5 (بينما b=0.3 في سيناريو AGV)، لضمان وجود مسافة أمان كافية للكبح. المعاملات القياسية لخوارزمية DWA للرافعة العلوية لدى كيلود للصناعات الثقيلة هي: a=0.3, b=0.5, c=0.2، وقد تم التحقق من فعاليتها في 6 مشاريع.

مقارنة هندسية لثلاث خوارزميات لتجنب الاصطدام

تختلف قابلية تطبيق الخوارزميات الثلاث بشكل ملحوظ في سيناريو التشغيل المشترك للرافعة العلوية والمركبة الموجهة الآلية. تتفوق DWA في البيئات الديناميكية غير المعروفة (دالة تقييم تجمع أهداف الاتجاه/المسافة/السرعة)، وتتميز VO بأعلى دقة في التنسيق متعدد المعدات للسرعة (الاشتقاق الهندسي لمخروط السرعة)، بينما تمتلك APF أقل تكلفة حسابية وأسرع استجابة في تخطيط المسار الثابت المعروف. فيما يلي مقارنة منهجية من خمسة أبعاد: الأساس الرياضي، دورة الحساب، متطلبات الأجهزة، القدرة على التكيف الديناميكي، وصعوبة التنفيذ، لمساعدة المهندسين على اختيار الخوارزمية المثلى وفقًا لظروف الموقع.

التنفيذ الهندسي لمنطقة سرعة العوائق (VO) في نظام الإرسال

يعتمد جوهر خوارزمية VO (Velocity Obstacle) على تحديد منطقة السرعات في فضاء السرعة التي قد تؤدي إلى تصادم. التعريف: منطقة سرعة العوائق للجهاز A بالنسبة للجهاز B هي VO(A,B)=v_A|(p_B-p_A)/t ينتمي إلى D(p_B-p_A,r_A+r_B)، حيث p_A/p_B هما متجها موقع الجهازين، r_A/r_B هما نصفا قطر الدائرتين المحيطتين، وt هو زمن التنبؤ. للتبسيط: إذا تحرك الجهاز A بسرعة v_A والجهاز B بسرعة v_B، فإن السرعة النسبية من A نحو B هي v_rel=v_A-v_B، وعندما تقع هذه السرعة داخل منطقة VO فسيحدث تصادم خلال t ثانية.

تنفيذ VO في PLC: يستخدم PLC من نوع S7-1500 لغة SCL لتنفيذ خوارزمية VO بحوالي 150 سطرًا من الكود. في كل دورة حسابية (100ms) يتم حساب مناطق VO لجميع أزواج الأجهزة (إجمالي N×(N-1)/2 زوجًا)، ويتم التحقق من سرعة كل جهاز حاليًا ما إذا كانت تقع داخل أي منطقة VO. إذا كانت داخل منطقة VO، يتم حساب سرعة التملص (أقرب سرعة آمنة لحدود VO) وإرسالها كأمر تحديد سرعة إلى ذلك الجهاز. مع 6 أجهزة، يكون الحساب حوالي 15 زوجًا × حوالي 50 تعليمة لكل زوج = 750 تعليمة، وزمن تنفيذ S7-1500 حوالي 2~3ms. عند تشغيل DWA+VO معًا، يتولى PLC جزء VO (2~3ms) بينما يتولى Jetson جزء DWA (120~180ms)، ويتم تبادل البيانات عبر Profinet.

قيود VO وتحسيناته: تفترض VO أن الجهاز الآخر يتحرك بسرعة ثابتة في خط مستقيم — وعندما يتسارع أو يتباطأ أو يغير اتجاهه فجأة، يفشل تنبؤ VO. طريقتان للتحسين: ① إضافة قيد التسارع — مراعاة أقصى مدى تسارع للجهاز الآخر عند حساب VO، وتوسيع مخروط السرعة إلى مخروط تسارع (Accelerated VO)؛ ② تقصير زمن التنبؤ t — من t=5 ثوانٍ في سيناريو الرافعة العلوية إلى t=2 ثانية، مقابل دقة تنبؤ أعلى؛ عند t=2 ثانية تبلغ دقة تنبؤ التصادم لـ VO حوالي 92%، بينما تنخفض إلى 78% عند t=5 ثوانٍ. توصي كيلود للصناعات الثقيلة بقيمة افتراضية t=3 ثوانٍ، بدقة إجمالية حوالي 88%.

حالة هندسية للخوارزمية الهجينة في التجميع النهائي

مشروع الإرسال المنسق في ورشة التجميع النهائي لأحد مصانع السيارات يشمل 6 رافعات علوية و12 مركبة AGV و4 مركبات RGV، ويغطي كامل عملية مناولة المواد من إنزال أجزاء الختم حتى ورشة اللحام. تخطيط خط الإنتاج: امتداد الرافعة العلوية 28~31.5m، ممر حركة AGV بعرض 2.5~3m، 6 محطات تبادل بين الرافعة وAGV و4 نقاط تبادل بين AGV وRGV. في ساعات الذروة حوالي 280 عملية مناولة في الساعة (بمتوسط 12.8 ثانية/عملية). تتولى الرافعات العلوية الرفع عبر الامتدادات، وAGV النقل الأرضي، وRGV النقل الطويل على السكة. إجمالي نقاط تقاطع مسارات الأجهزة الثلاثة 18 نقطة، مما يجعل التحكم في مخاطر التصادم صعبًا.

إعداد الخوارزمية: يعمل Jetson Orin NX (100TOPS) بتشغيل DWA (التخطيط المحلي لمسار AGV/دورة 200ms)، وS7-1500 PLC بتشغيل VO (تنسيق سرعات المركبات/دورة 100ms)، وAPF للتوجيه العام للمسار (حساب مرة واحدة عند إرسال المهمة/حوالي 10ms). التنسيق بين الخوارزميات الثلاث: APF يولد المسار العام ← VO يكتشف التصادم ويولد قيود السرعة ← DWA يختار أفضل (v,w) ضمن القيود. الاتصال بين PLC وJetson عبر Profinet IRT (دورة 2ms)، وزمن استجابة الارتباط المقاس حوالي 280ms.

نتائج التسليم: بعد التشغيل، 12 شهرًا متتاليًا بدون أي حادث تصادم. انخفض متوسط انتظار المهام من 25 ثانية في الإرسال اليدوي إلى 12 ثانية (انخفاض 52%)، وانخفض معدل خمول الرافعة العلوية من 41% إلى 23%، ومعدل خمول AGV من 38% إلى 19%، وارتفعت كفاءة تدفق المواد في خط الإنتاج بنسبة 37%. تقدم كيلود للصناعات الثقيلة خدمات تطوير خوارزميات مخصصة، تشمل المسح/المحاكاة/اختيار الخوارزمية/نشر Jetson/تطوير PLC/الاختبار والقبول على أربع مراحل.

إجراءات اختبار المحاكاة والتحقق من الخوارزمية

يجب أن تجتاز خوارزمية تجنب التصادم اختبارات المحاكاة على أربع مراحل قبل التشغيل الفعلي.

المرحلة الأولى: محاكاة برمجية خالصة (Gazebo+Rviz): بناء نماذج محاكاة ثلاثية الأبعاد للرافعة العلوية وAGV في بيئة ROS 2، واستيراد تخطيط خط الإنتاج الفعلي (بما في ذلك إحداثيات السكة/المسار/محطات التبادل)، وتشغيل 200 مهمة نقل عشوائية (بما فيها 5% مهام عاجلة و3% سيناريوهات أعطال)، وحساب عدد التصادمات وكفاءة المسار. معيار النجاح: صفر تصادم + متوسط كفاءة مسار ≥ 85% من الإرسال اليدوي.

المرحلة الثانية: محاكاة الأجهزة في الحلقة (HIL): توصيل صندوق Jetson الحوافي وPLC اللذين يعملان بالخوارزمية الفعلية ببيئة المحاكاة، حيث يستقبل Jetson رسائل حالة الأجهزة المحاكاة من PLC (عبر Profinet)، ويشغل خوارزمية DWA+VO ثم يرسل أوامر السرعة إلى الأجهزة الافتراضية. تركيز الاختبار: التحقق من أن زمن استجابة اتصال Profinet يلبي متطلبات دورة 100ms، وأن زمن تنفيذ الخوارزمية على الأجهزة الفعلية لا يتجاوز ميزانية الدورة (DWA≤200ms، VO≤100ms).

المرحلة الثالثة: اختبار المركبات الفعلية بدون حمولة: تشغيل الرافعة العلوية وAGV بدون حمولة على خط الإنتاج الفعلي لمدة 48 ساعة، مع مراقبة مستمرة من مسؤولي السلامة، وحساب معدل التنبيهات الخاطئة وعدد السلوكيات غير الطبيعية.

المرحلة الرابعة: تشغيل تجريبي بحمولة: زيادة السرعة تدريجيًا إلى القيمة الاسمية، والتشغيل لمدة 168 ساعة (7 أيام)، واستخدام مؤشرات KPI المدمجة في نظام الإرسال لحساب متوسط وقت انتظار المهام ومعدل التعارض ومعدل الالتزام بالمواعيد، مع مقارنة أسبوع قبل وبعد التشغيل. تقدم كيلود للصناعات الثقيلة خدمات اختبار شاملة على المراحل الأربع، مع تقرير اختبار لكل مرحلة.

الأسئلة الشائعة حول خوارزميات تجنب التصادم

• معيار ISO 4301 / FEM 1.001: تفسير الأحكام الأساسية لمواصفة تصميم الرافعات – أنظمة الحمولة والهيكل والآلية والكهرباء والسلامة