ملخص تقني: ContactIPM
بيان المشكلة
يسعى تحسين المسار بالتلامس الضمني (Contact-implicit trajectory optimization - CITO) إلى تحسين حالات الروبوت، والمدخلات، وقوى التلامس، وأنماط التلامس في آن واحد دون تحديد تسلسل تلامس مسبق. توفر هذه المرونة إدخال البرامج الرياضية ذات قيود التكامل (MPCCs)، حيث يتم نمذجة التلامس أحادي الجانب والاحتكاك عبر شروط التكامل (على سبيل المثال، 0≤a⊥b≥0).
تفرض هذه المشكلات تحديًا عدديًا جوهريًا: عند نقاط الـ MPCC الممكنة، تكون تدرجات قيود عدم السلبية والقيود الحاصلة على الضرب مرتبطة بنيويًا، مما يؤدي إلى فشل معايير الجودة القياسية للقيود (مثل LICQ). هذا التدهور يجعل حلول البرمجة غير الخطية التقليدية (Primal–dual) غير موثوقة، مما يؤدي غالبًا إلى أنظمة KKT مفردة أو سيئة التكييف.
تعالج النهج الحالية مشكلة المتانة هذه من خلال التخلي عن خطوة "نيوتن" للثنائي-الأولي (Primal–dual Newton step) المترابطة بالكامل. فأساليب مثل CRISP تعمل فقط على تحسين المسار الأولي عبر مسائل فرعية محدبة، بينما يستخدم IMPACT حلقة خارجية من "لاغرانج المعزز" (Augmented-Lagrangian) مع خوارزمية التدرج الإحداثي الكتلوي. ومن ناحيد آخر، تستخدم حلول التحكم الأمثل المستغلة للبنية (مثل acados) تكرارات ريكاتي (Riccati recursions) من أجل الكفاءة، لكنها غالبًا ما تفشل في توليد تلامس مفيد إذا فُرض التكامل الدقيق دون معالجة خاصة. لا تزال هناك فجوة بين متانة الـ MPCC الخاصة وبين كفاءة حلول التحكم الأمثل (OCP) المستغلة للبنية.
المنهجية: ContactIPM
يقترح ContactIPM طريقة داخلية (Interior-point method) موحدة للثنائي-الأولي تحافظ على بنية الـ OCP ذات النطاق الحزامي (Block-banded) المطلوبة لتكرار ريكاتي مع التعامل مع قيود التكامل بمتانة.
1. الاسترخاء الداخلي المرن المرتبط بالحاجز
بدلاً من استخدام أوزان الجزاء أو لاغرانج المعزز، يقدم ContactIPM استرخاءً داخليًا مرنًا محليًا لكل مرحلة لكل زوج تكامل محدد (a,b):
- متغيرات الفائض (Slack Variables): يتم إدخال فواضد الجانب الموجب (sa,sb) وفائض حاصل الضرب (sc).
- الرفع المرن (Elastic Lift): يتم تحويل شرط التكامل إلى نظام من المعادلات:
ga+sa=0,gb+sb=0,gagb−θ(μ)+sc=0
حيث يربط θ(μ)=γmpccμ تشديد التكامل مباشرة بمعامل الحاجز μ.
- الانتظام (Regularity): يضمن هذا البناء أن مصفوفة جاكوبي للقيود المرفوعة تحتوي على كتلة وحدة بالنسبة للفواضد. وبناءً عليه، يحقق المسألة المسترخية شرط استقلال القيود الخطي (LICQ) عند كل نقطة داخلية، مما يضمن مضاعفات فريدة ونظامًا منتظمًا للثنائي-الأولي.
- لا يوجد جزاء مستقل: على عكس طرق الجزاء، يتم التحكم في تشديد التكامل بواسطة نفس معامل الحاجز μ الذي يحدد المسار المركزي، مما يلغي الحاجة إلى معاملات جزاء يتم ضبطها بشكل مستقل.
2. الحذف الثنائي-الأولي لكل مرحلة وتكرار ريكاتي
يحافظ الحل على الاتساق الثنائي-الأولي، حيث يقوم بتحديث المسار، ومضاعفات الديناميكيات، ومضاعفات المتباينة، والفواضد كأجزاء من نظام KKT مضطرب واحد.
- الحذف المحلي: نظرًا لأن أزواج التكامل ومتغيراتها المرنة محلية لكل مرحلة، يقوم الحل بحذف متغيرات الفائض المحلي (Δsk) والمضاعفات المحلية (Δλk) لكل مرحلة.
- النظام المختزل: يعدل هذا الحذف فقط مصفوفة هسيان المرحلة المحلية (H~k) والتدرج (q~k). تظل الديناميكيات هي الرابط الوحيد بين المراحل المتجاورة، مما يحافظ على البنية الحزامية الكتلية.
- الحل الفعال: يتم حل النظام المختزل باستخدام تكرار ريكاتي خلفي يليه تعويض أمامي، مما يحقق تعقيدًا خطيًا O(N) بالنسبة لطول الأفق.
3. استعادة الـ MPCC متعددة المراحل
للتعامل مع الفروع المستقرة المتعددة المرتبطة بأنماط التلامس المختلفة، يستخدم ContactIPM جدول استعادة ثابت يتضمن:
- الاستمرار (Continuation): تشديد معامل الحاجز تدريجيًا مع محاولة البقاء في حوض نمط التلامس الحالي.
- إعادة التشغيل (Restart): إذا فشل الاستمرار (على سبيل المثال، بسبب فقدان التكييف)، يستعيد الحل التخمين الأولي الأصلي ويعيد التشغيل بمعامل حاجز أكبر وانحناء "غاوس-نيوتن" لاستكشاف أحواض مختلفة.
- الإنهاء (Termination): ينتهي الحل فقط عندما يقل باقي التكامل الفيزيائي غير المسترخى (rphys=max∣akbk∣) عن حد معين، مما يضمن أن المسار النهائي يحقق نموذج التلامس الفيزيائي، وليس فقط الصيغة المسترخاة.
4. القياس والتعميم (Scaling and Globalization)
يطبق الأسلوب قياس إحداثيات قطري متسق مع الأفق مشتق من مقادير مشتقات المرحلة. ويتم تحقيق التعميم عبر بحث خطي مرشح (Filter line search) يوازن بين تقليل الهدف وانتهاك القيود، مع قاعدة "جزء من المسافة إلى الحدود" للحفاظ على إيجابية الفواضد.
المساهمات الرئيسية
- صيغة موحدة: صياغة لكل مرحلة تحول أزواج التكامل المحددة إلى صفوف حاصل ضرب مرنة مرتبطة بالحاجز ضمن إطار عمل الديناميكيات غير الخطية، والتكلفة، والمتباينات.
- طريقة نيوتن ثنائية-أولية مدركة للـ MPCC: طريقة تحافظ على بنية KKT المضطربة المترابطة مع استخدام الحذف المحلي للفائض/المضاعفات وتكرار ريكاتي. وهي تتضمن مسبقًا لدرجة مقياس المسار وسياسة استعادة متعددة المراحل.
- تقييم قابل للتكرار: مجموعة تجريبية شاملة تقارن ContactIPM بكل من CRISP وIMPACT وخط أساس acados ذو بنية OCP (مع التكامل الدقيق)، بما في ذلك 50 عملية تشغيل مغلقة الحلقة تحت ظروف اضطرابات متنوعة.
النتائج التجريبية
الأداء مقابل CRISP
- السرعة: في أربع حالات اختبار ثابتة (Cartpole, Push Box, Transport, Push T)، كان ContactIPM أسرع بمقدار 2.17 إلى 8.87 مرة من CRISP عبر 20 تكرارًا زمنيًا مزدوجًا.
- المتانة: يطابق ContactIPM نتائج CRISP في Cartpole وTransport، لكنه ينجح في 5 حالات إضافية من Push Box (24/25 مقابل 19/25). وفي مجموعة Push T، نجح ContactIPM في جميع الحالات الـ 50، بينما نجح CRISP في 27/50 حالة فقط عند فرض التكامل الفيزيائي الصارم.
الأداء مقابل IMPACT
- السرعة: ContactIPM أسرع بمقدار 2.96 مرة في Push T و4.91 مرة في Cart Transport. ومع ذلك، فإن IMPACT أسرع بمقدار 4.46 مرة في Push Box.
- المتانة: نجح ContactIPM في 150/150 حالة عبر ثلاث مجموعات من 50 حالة (Push Box, Push T, Cart Transport)، مقارنة بـ 147/150 لـ IMPACT.
المقارنة مع خط الأساس ذي بنية OCP (acados)
- عندما تم تكوين acados مع التكامل الدقيق (بدون استرخاء مرن)، فإنه غالبًا ما يفشل في توليد تلامس مفيد. على سبيل المثال، في اختبار Push Box، اجتاز acados فحوصات الجدوى الفيزيائية في جميع الحالات الـ 25، لكن 0/25 منها وصلت إلى الهدف النهائي، وغالبًا ما تنتهي عند مسار تلامس صفري.
- عبر 165 حالة غنية بالتلامس (CRISP Transport, CRISP Push T, IMPACT Push T, و IMPACT Cart Transport)، أنتج acados مسارًا مقبولًا واحدًا فقط، بينما نجح ContactIPM في 158. وهذا يثبت أن استغلال بنية OCP وحدها غير كافٍ للتغلب على تدهور الـ MPCC.
التحقق من الحلقة المغلقة (Closed-Loop Validation)
- في 50 عملية تشغيل مغلقة الحلقة لـ Push Box تتضمن عدم تطابق النموذج، والضجيج، وإعادة تعيين الحالة، نجح ContactIPM في جميع الحالات الـ 50.
- الكمون (Latency): كان متوسط وقت الحل 2.08 مللي ثانية، مع استيفاء 99.37% من الحلول للموعد النهائي للتحكم البالغ 100 مللي ثانية.
- الجدوى: حافظت التغذية الراجعة في الحلقة المغلقة على الجدوى الأولية والتكامل الفيزيائي، حيث ظل الحد الأقصى لمنتجات التكامل الفيزيائي أقل من 1.01×10−6.
الأهمية والادعاءات
يزعم البحث أن متانة الـ MPCC، والاتساق الثنائي-الأولي، وبنية التحكم الأمثل يمكن أن تتعايش في حل واحد. يثبت ContactIPM أن فصل معالجة التكامل عن خطوة نيوتن الثنائية-الأولية (كما هو الحال في CRISP وIMPACT) ليس تكلفة لا مفر منها للتعامل مع تكامل التلامس. من خلال الجمع بين الاسترخاء الداخلي المرن والحذف لكل مرحلة وتكرار ريكاتي، يحقق الحل كلاً من المتانة العددية المطلوبة لمشكلات التلامس الضمني وكفاءة التحكم الأمثل المستغل للبنية. تشير النتائج إلى أن المعالجة المتخصصة للـ MPCC ضرورية حتى عند استخدام تقنيات الجبر الخطي المتقدمة لـ OCP.