Actuator-Aware Inverse Kinematics with Joint-Limit Admissibility for Torque-Controlled Redundant Robots

ملخص تقني: الكينماتيكا العكسية المدركة للمشغلات مع قابلية قبول حدود المفاصل للروبوتات الزائدة عن الحاجة والمتحكم بها عبر عزم الدوران

بيان المشكلة
تمتلك الروبوتات الزائدة عن الحاجة (Redundant robots) مفاصل مشغلة أكثر مما هو ضروري لتحقيق حركة معينة في حيز المهمة، مما يوفر درجات حرية إضافية لتحقيق أهداف ثانوية مثل تجنب حدود المفاصل. ومع ذلك، في البنى المتحكم بها عبر عزم الدوران (Torque-controlled)، لا يكون مخرج الكينماتيكا العكسية (IK) هو مدخل التحكم النهائي، بل هو مرجع سرعة يتم تزويده لمتحكم في مستوى عزم الدوران في مرحلة لاحقة (مثل التحكم في التفكيك الافتراضي - VDC). وبناءً على ذلك، فإن تقليل المتبقي الكينماتي للأمر وحده لا يضمن حركة فعلية جيدة. فإذا كان مرجع السرعة المفصلية المتولد غير متوافق مع ديناميكيات المتحكم في المستوى اللاحق أو مع حدود المشغلات، فقد يفشل النظام الفيزيائي في تتبع المهمة، لا سيما بالقرب من حدود المفاصل. غالبًا ما تحل طرق الكينماتيكا العكسية الموجودة مسألة الفائض بناءً على معايير كينماتية (مثل الحد الأدنى من النظم، أو إسقاط الفراغ الصفري) دون مراعاة صريحة لمدى توافق المرجع مع حلقة التحكم في مستوى عزم الدوران أو قيود قدرة المشغل.

المنهجية
تقترح الورقة صياغة كينماتيكا عكسية متوافقة مع المتحكم تولد سرعات مطلوبة على مستوى المفاصل ($\dot{q}_r$) عبر مسألة برمجة تربيعية (QP) محدبة. تم تصميم هذه الطريقة لتعمل كطبقة وسيطة بين مسار نقطة النهاية ومتحكم عزم الدوران للروبوت الزائد عن الحاجة.

1. هدف التوافق مع المتحكم: تعمل مسألة البرمجة التربيعية (QP) على تقليل دالة تكلفة توازن بين الحفاظ على المهمة والتوافق مع المتحكم. تتضمن مصفوفة الأوزان ($W_c$) ما يلي:

   • الأساس المتماثل (Isotropic Baseline): يضمن جودة التكييف (Well-conditioning).
   • اتساق الأمر السابق ($W_\Delta$): يعاقب التغيرات المفاجئة في السرعة المطلوبة بالنسبة للخطوة السابقة، مما يعزز السلاسة.
   • وزن قدرة عزم دوران المشغل ($W_\tau$): يعاقب استخدام المفاصل ذات قدرة عزم الدوران المنخفضة مقارنة بأقوى مفصل في النظام. ويتم اشتقاق هذا الوزن من حدود المشغل المعروفة، وليس من عزم الدوران المقاس.

2. قابلية قبول حدود المفاصل: بدلاً من القيود الصارمة التي قد تجعل مسألة البرمجة التربيعية غير قابلة للحل، تستخدم الطريقة متباينات مستوحاة من دالة حاجز التحكم (CBF) لتحديد مجموعة من السرعات المطلوبة المقبولة ($D_r(q)$). تضمن هذه الحدود أن السرعة المأمورة لا تدفع المفصل بسرعة كبيرة جدًا نحو حدوده الميكانيكية.

3. قيد المهمة المرن (Soft Task Constraint): للتعامل مع الحالات التي يكون فيها أمر المهمة غير متوافق مع مجموعة السرعة المقبولة، يتم التعامل مع معادلة المهمة ($J\dot{q}_r = V_r$) كقيد مرن باستخدام متغير متراخي (Slack variable) ($s$). يتم معاقبة متبقي المهمة في دالة التكلفة بدلاً من كونه الهدف الأساسي للتقليل، مما يسمح للمحلل بإعطاء الأولوية للتوافق مع المتحكم عند الضرورة.

المساهمات الرئيسية

• الصياغة: صياغة جديدة للكينماتيكا العكسية قائمة على البرمجة التربيعية (QP) تدمج صراحةً قدرة عزم دوران المشغل واتساق الأمر السابق في حل مسألة الفائض للروبوتات المتحكم بها عبر عزم الدوران.
• سلامة مستوى المرجع: تقديم حدود مستوحاة من دالة حاجز التحكم (CBF) على السرعة المطلوبة (مخرج الكينماتيكا العكسية) بدلاً من مدخل النبات (Plant input)، مما يوفر قبولًا لحدود المفاصل على مستوى المرجع دون تعديل متحكم عزم الدوران في المرحلة اللاحقة.
• مقايضة قابلية المهمة: آلية لموازنة الحفاظ على المهمة والتوافق مع المتحكم باستخدام متغير متراخي لمعادلة المهمة، مما يمنع متبقي المهمة من تجاوز الحاجة إلى مراجع قابلة للتنفيذ وسلسة.

النتائج التجريبية
تم تقييم الطريقة على هيكل خارجي للطرف العلوي مكون من 7 درجات حرية باستخدام إطار عمل التحكم في التفكيك الافتراضي (VDC). تمت مقارنتها مع أربعة نماذج أساسية: شبه المعكوس (PINV)، المربعات الصغرى المخمدة (DLS)، تجنب حدود المفاصل في الفراغ الصفري (NS-JLA)، والبرمجة التربيعية الحافظة للمهمة (TP-QP) التي تستخدم نفس قيود القبول ولكنها تفتقر إلى هدف التوافق مع المتحكم.

• الأداء الفعلي: حققت الطريقة المقترحة أدنى أخطاء جذر متوسط المربع (RMS) للموضع والاتجاه، وكذلك أدنى متبقيات سرعة المهمة الفعلية، متفوقة على جميع النماذج الأساسية. ومن الملاحظ أنها قللت خطأ RMS الموضعي بنسبة 29.6% وخطأ RMS الاتجاه بنسبة 20.2% مقارنة بنموذج TP-QP.
• سلوك الحدود: أظهرت الطönt المقترحة انخفاضًا كبيرًا في مؤشر "دفع الحدود" (الذي يوجه الحركة نحو الحدود)، حيث قللته بنسبة تصل إلى 96% مقارنة بالطرق الأخرى.
• كفاءة عزم الدوران: أدت إلى أدنى قيمة لمتوسط جذر مربعات معيار عزم الدوران (RMS torque norm)، مما يشير إلى استخدام أكثر كفاءة لموارد المشغل.
• القابلية للقبول: حافظت الطريقة على صفر انتهاكات لحدود السرعة المطلوبة المقبولة، بينما تجاوزت النماذج الكينماتية (PINV, DLS, NS-JLA) هذه الحدود بشكل متكرر.

الأهمية والادعاءات
تزعم الورقة أنه بالنسبة للروبوتات الزائدة عن الحاجة والمتحكم بها عبر عزم الدوران، لا ينبغي للكينماتيكا العكسية أن تكتفي فقط بتقليل الخطأ الكينماتي، بل يجب أن تولد مراجع على مستوى المفاصل تتوافق مع المتحكم في المرحلة اللاحقة وقدرات المشغل. تشير النتائج إلى أن الصياغة المقترحة تحقق توازنًا متفوقًا بين الحفاظ على المهمة والقابلية للقبول. ومن خلال توليد مراجع تحترم قدرات المشغل وتتجنب الدفع العدواني نحو الحدود، تعمل الطريقة على تحسين سلوك المهمة الفعلي دون الحاجة إلى إعادة تصميم متحكم عزم الدوران في المرحلة اللاحلة. يضع المؤلفون نتائجهم بتواضع كـ "وعي بحدود المفاصل على مستوى المرجع" و"حل الفائض المتوافق مع المتحكم"، بدلاً من كونها إثباتًا رسميًا لسلامة مستوى النبات. وقد تم تحديد العمل المستقبلي في استقصاء صياغات القيود المقترنة بين الكينماتيكا العكسية وتحكم عزم الدوران، والتحليل الرسمي للقيود في الحلقة المغلقة.