Compliant Explicit Reference Governor for Contact Friendly Robotic Manipulators

ملخص تقني: حاكم المرجع المتوافق للمناولات الروبوتية الصديقة للاتصال

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

1. القيود الصارمة (Hard Constraints): حدود غير قابلة للتفاوض مثل نطاقات المفاصل، وحدود عزم الدوران، والأسطح المحظورة.
2. القيود المرنة (Soft Constraints): ظروف يكون فيها الاتصال مسموحاً به ولكن يجب التعامل معه بأمان. وتخلق هذه القيود شروط "أو" (OR) غير محدبة للغاية: إما أن يتجنب الروبوت الاتصال تماماً أو يعمل تحت قيود محددة آمنة للاتصال.

غالباً ما تتطلب استراتيجيات التحسين الموجودة (مثل التحكم التنبئي بالنماذج MPC) إعادة تصميم كاملة لقوانين التحكم وتقريبات معقدة متغيرة زمنياً لديناميكيات الاتصال، وهو أمر غير جذاب للممارسين الذين يستخدمون متحكمات قديمة. ومن ناحية أخرى، فإن النهج الهرمي مثل دالات الحاجز للتحكم (Control Barrier Functions) أو الامتثال القائم على الطاقة يفتقر غالباً إلى ضمانات القيود الصارمة أو الاستقرار التقاربي. يقدم "حاكم المرجع الصريح" (Explicit Reference Governor - ERG) مرشح سلامة هرمي يعدل المراجع دون تغيير المتحكم الأساسي، إلا أن التطبيقات السابقة عاملت الاتصال كأمر غير مرغوب فيه، مما يؤدي إلى إيقاف الحركة عند حدوث الاتصال. تعالج هذه الورقة الحاجة إلى إطار عمل يسمح بالتشغيل المستمر والآمن أثناء الاتصال دون تعديل المتحكم منخفض المستوى.

المنهجية: حاكم المرجع المتوافق (CERG)
يقترح المؤلفون "حكم المرجع المتوافق" (CERG)، وهو نظام إدارة مرجع معياري يوضع بين المخطط عالي المستوى والمتحكم منخفض المستوى. يفرض CERG القيود التشغيلية ويمكّن الانتقالات السلسة بين حركة الحركة الحرة وعمليات الاتصال من خلال التلاعب بإشارة المرجع $v(t)$ المرسلة إلى متحكم مستقر مسبقاً.

تعتمد المنهجية على ثلاثة مكونات رئيسية:

1. طبقة الاستقرار المسبق (Pre-stabilization Layer): يقوم متحكم PD قياسي مع تعويض الجاذبية بتوجيه الروبوت نحو تكوين مرجعي $v$. يتم تعريف الطاقة الكلية للنظام (الحركية + الجهد الافتراضي) بواسطة دالة ليابونوف $V(x, v)$، والتي تتناقص رتيباً عندما يكون $v$ ثابتاً.
2. هامش السلامة الديناميكي المتوافق (Compliant Dynamic Safety Margin - DSM): الابتكار الجوهري هو هامش DSM، المصمم للتعامل مع الطبيعة التخييرية (أو - OR) لقيود الاتصال. تمت صياغة شرط السلامة كالتالي:
   $$s(q(t)) < 0 \quad \lor \quad V(x(t), v(t)) \le E_{\max}$$
   حيث يمثل $s(q) < 0$ الحركة الحرة، ويمثل $V \le E_{\max}$ الاتصال الآمن مع طاقة محدودة. يقوم CERG ببناء هامش DSM مركب:
   $$\Delta(x, v) = \min(\Delta_h, \max(\Delta_s, \Delta_E))$$
   • $\Delta_h$: يفرض القيود الصارمة (حدود المفاصل، إلخ).
   • $\Delta_s$: هامش قائم على المسار لسطح القيد المرن $s(q)$.
   • $\Delta_E$: هامش قائم على الطاقة محدد بـ $\kappa_E(E_{\max} - V(x, v))$.
     يضمن هذا الهيكل أنه إذا كان الروبوت في حالة حركة حرة، يتم تخفيف قيد الطاقة؛ وإذا حدث اتصال، يتم حصر الطاقة الكلية للنظام بصرامة ضمن $E_{\max}$.
3. مجال الملاحة الناعم (Soft Navigation Field - NF): على عكس القيود الصارمة التي تنفر المرجع، يستخدم CERG مجال تنافر "ناعم" $\rho_s(v)$ يسمح للمرجع $v$ باختراق حدود القيد حتى حد معين $\delta_s$. هذا الاختراق ضروري لتوليد القوة المطلوبة للاتصال المتوافق. يجمع مجال الملاحة الإجمالي بين الجذب نحو الهدف، والتنافر من القيود الصارمة، وهذا التنافر الناعم.

المساهمات الرئيسية
تدعي الورقة ثلاث مساهمات رئيسية:

• ترشيح المرجع المعياري: إطار عمل ينتقل بسلاسة بين الحركة الخالية من الاتصال والحركة الغنية بالاتصال مع احترام قيود زاوية المفصل، والسرعة، وعزم الدوران، دون الحاجة لإعادة تصميم المتحكم.
• التعامل مع القيود التخييرية: آلية سلامة مصممة خصيصاً لقيود النوع "أو" (OR-type)، مما يضمن الوفاء المثبت إما بتجنب الاتصال أو الحفاظ على طاقة محدودة أثناء الاتصال.
• دليل السلامة القائم على الطاقة: مقياس سلامة يعتمد على الطاقة الميكانيكية الكلية (الجهد + الحركية) للنظام مغلق الحلقة. هذا المقياس ثابت الإطار، ويرتبط مباشرة بضمانات الاستقرار، ويسهل تفسيره.

النتائج والتحقق
تم التحقق من صحة CERG عددياً وتجريبياً على أنظمة تزداد تعقيداً:

• ذراع مستوية ثنائية الوصلات (محاكاة): تم اختبار CERG مع متحكمات فضاء المفاصل وفضاء نهاية المفعول. أظهرت النتائج أن CERG نجح في تقليل قوى التفاعل مقارنة بالعمل بدونه واحترم حدود الطاقة. أشارت الدراسة إلى أنه بينما يقلل صياغة فضاء نهاية المفعول من خطأ كارتيزي، فإن صياغة فضاء المفاصل هي المفضلة للهياكل الهرمية.
• محاكاة Franka Emika Panda (في بيئة Drake): باستخدام نموذج اتصال متوافق مع الاحتكاك والتبدد، تم اختبار CERG في مهمة تتطلب انزلاق الذراع على جدار. أكدت المحاكاة أن CERG التزم بحد $E_{\max}$ أثناء الاتصال، بينما فشل كل من ERG القياسي (الذي يتوقف عند الاتصال) والنظام غير المعدل في إدارة انتقال الطاقة بفعالية.
• تجارب العالم الحقيقي (Franka Emika Panda): تم تنفيذ مهمتين:
  1. مسح السبورة: مهمة ليست حساسة جداً للطاقة. أتم كل من CERG وERG والتحكم بالمعاوقة (Impedance control) المهمة، ولكن CERH وحده فرض القيود الصارمة (لمنع انتهاكات سرعة المفاصل) وحدود الطاقة أثناء الاتصال.
  2. دفع برج جينجا (Jenga): مهمة حساسة للغاية للطاقة. فشل متحكم المعاوقة بسبب انتهاك حدود المفاصل أو قلب البرج. فشل ERG القياسي في منع قلب البرج بسبب طاقة الاتصال المفرطة. فقط CERG نجح في دفع البرج دون قلبه من خلال فرض $E_{\max}$ بصرامة أثناء الاتصال مع السماح بطاقة أعلى في الحركة الحرة.

الأهمية والادعاءات
تؤكد الورقة أن CERG يوفر حلاً عملياً للمناولة الغنية بالاتصال من خلال العمل كمرشح سلامة "جاهز للتركيب" (plug-and-play). تكمن أهميته في تمكين الروبوتات من معاملة الاتصال كمورد بدلاً من كونه خطراً، دون العبء الحسابي لإعادة تصميم MPC كامل أو مخاطر عدم الاستقرار للمتحكمات غير المعدلة. يضمن إطار العمل السلامة من خلال قيود مثبتة على إجمالي طاقة النظام، مما يسمح بانتقالات مرحلية سلسة بين الحركة الحرة والاتصال. ويخلص المؤلفون إلى أن هذا النهج قابل للتطبيق وفعال، مع التخطيط لأعمال مستقبلية لربط CERG بالمخططات الموجهة نحو المهام.