Full-Body Dynamic Safety for Robot Manipulators: 3D Poisson Safety Functions for CBF-Based Safety Filters

ملخص تقني لورقة بحثية بعنوان: "السلامة الديناميكية لكامل جسم الملاعب الروبوتية: دوال السلامة لـ Poisson ثلاثية الأبعاد لمرشحات السلامة القائمة على دالة الحاجز للتحكم (CBF)."

1. بيان المشكلة

تواجه الملاعب الروبوتية (Robotic manipulators) التي تعمل في بيئات غير منظمة وديناميكية تحديًا حرجًا: ضمان تجنب الاصطدام لكامل الجسم. وبينما أثبتت دوال الحاجز للتحكم (CBFs) فعاليتها في تحقيق السلامة، فإن تطبيقها على التلاعب بكامل الجسم يفرض عقبتين رئيسيتين:

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

2. المنهجية

يقترح المؤلفون إطار عمل موحد يجمع بين دوال سلامة Poisson ثلاثية الأبعاد (PSFs) مع استراتيجية أخذ العينات والتحصين (sampling-and-buffering) لتحقيق سلامة كامل الجسم بشكل مثبت في الوقت الفعلي.

أ. دوال سلامة Poisson (PSFs)

بدلاً من استخدام دوال SDF أو التقريبات الأولية، تقوم الطريقة ببناء دالة سلامة عن طريق حل معادلة Poisson (وهي معادلة تفاضلية جزئية إهليلجية) في الفضاء الحر المحدد بواسطة خريطة الإشغال.

• الصياغة: بالنظر إلى مجال الفضاء الحر $\Omega$ بحدود $\partial\Omega$ (أسطح العوائق)، فإن دالة السلامة $h_0$ هي الحل الفريد لـ:
  $$\nabla^2 h_0(y) = f(y) \quad \text{لـ } y \in \Omega, \quad h_0(y) = 0 \quad \text{لـ } y \in \partial\Omega$$
  حيث أن $f(y) < 0$ هي دالة قوة.
• المزايا:
  • النعومة العالمية: بفضل الانتظام الإهليليجي، يكون الحل $h_0$ ناعمًا بشكل لانهائي ($C^\infty$) في الداخل، مما يضمن وجود مشتقات معرفة جيدًا لـ CBF-QP.
  • الهندسة التعسفية: تتعامل الطريقة مع أشكال العوائق المعقدة وغير المحدبة دون الحاجة لتقريب زائد.
  • دالة واحدة: حل واحد للمعادلة التفاضلية الجزئية (PDE) يولد دالة سلامة عالمية واحدة لكامل البيئة، مما يتجنب الحاجة لبناء حواجض متعددة.

ب. أخذ العينات والتحصين لسلامة كامل الجسم

لسد الفجوة بين أخذ العينات المنفصل وسلامة السطح المستمر، قدم المؤلفون برهانًا هندسيًا يعتمد على فرق بونترياغين (Pontryagin difference).

1. أخذ العينات: يتم تقريب سطح الروبوت بمجموعة من نقاط العينات $N$ حيث $Y = \{y_1, \dots, y_N\}$ بحيث تكون كل نقطة على السطح المستمر ضمن مسافة $\epsilon$ من نقطة عينة (شرط التغطية).
2. التحصين (Buffering): يتم تقليص المنطقة الآمنة $C$ (الفضاء الحر) بمقدار $\epsilon$ باستخدام فرق بونترياغين: $C_\epsilon = C \ominus B_\epsilon$.
3. النظرية: إذا تم الحفاظ على جميع نقاط العينات $y_i$ داخل المنطقة المحصنة $C_\epsilon$، فسيتم ضمان بقاء كامل سطح الروبوت المستمر $S(q)$ داخل المنطقة الآمنة الحقيقية $C$.
   • المنطق: إذا كانت نقطة العينة تبعد مسافة $\epsilon$ على الأقل عن حدود العائق، فإن الكرة ذات نصف القطر $\epsilon$ حولها (التي تغطي مساحة السطح غير المأخوذة كعينة) لا يمكن أن تتقاطع مع العائق.

ج. مرشح السلامة في الوقت الفعلي

يقوم النظام بتوليد دالة PSF متغيرة زمنيًا $h_\epsilon(y, t)$ للبيئات الديناميكية. يتم تقييم هذه الدالة عند نقاط العينات $N$ لتوليد برمجة تربيعية متعددة القيود (Multi-Constraint CBF-QP):

• الهدف: تقليل الانحراف عن أمر السرعة الاسمي ($v_{nom}$).
• القيود: فرض $\dot{h}_\epsilon(y_i, t, v) \geq -\alpha(h_\epsilon(y_i, t))$ لجميع نقاط العينات $N$ في آن واحد.
• المتانة: تمت إضافة حد متانة تكيفي للتعامل مع تأخير الاستشعار وأخطاء الترميز (Input-to-State Safe CBF).

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

1. مرشح PSF-Based CBF: تقديم دالة سلامة عالمية وناعمة مشتقة من معادلة Poisson، مما يلغي الحاجة إلى الأشكال الهندسية الأولية ويضمن القابلية للاشتقاق لمحللات الـ QP.
2. ضمان رسمي لكامل الجسم: تقديم برهان رياضي يوضح أن أخذ العينات المنفصل + التحصين كافٍ لضمان السلامة المستمرة، مما يزيل "الفجوة" الموجودة في طرق CBF متعددة القيود الحالية.
3. التحقق من الأجهزة: تنفيذ ناجح على مناعب Franka Emika FR3 بـ 7 درجات حرية في كل من البيئات الثابتة والديناميكية، مما أظهر أداءً في الوقت الفعلي (50-100 هرتز).

4. النتائج التجريبية

تم التحقق من إطار العمل على روبوت بـ 7 درجات حرية وكانت النتائج كالتالية:

• البيئات الثابتة: نجح مرشح السلامة في توجيه الروبوت عبر بيئات مزدحمة مع أوامر عدائية (محاولات تصادم متعمدة). منع المرشح الاصطدام مع الحفاظ على دقة حركة عالية (غير متحفظ بشكل مفرط).
• البيئات الديناميكية:
  • قام روبوت ثانٍ (UR10e) يحمل عائقًا كرويًا بالتحكم عن بعد داخل مساحة عمل FR3.
  • تم تحديث شبكة الإشغال في الوقت الفعلي (100 هرتز)، وتمت إعادة حساب PSF عبر الإنترنت.
  • نجح FR3 في تجنب الاصطدام بالعائق المتحرك، حتى عندما كانت حركة العائق غير متوقعة وغير مخططة.
• مقاييس الأداء:
  • وقت حل PDE: حوالي 0.002 ثانية (باستخدام Successive Over-Relaxation).
  • وقت حل QP: حوالي 0.003 ثانية.
  • دقة أخذ العينات: أدت دقة $\epsilon = 0.1$ إلى حوالي 30 نقطة عينة، مما وازن بين السلامة والحمل الحسابي.
  • المتانة: حافظ النظام على قيم دالة سلامة موجبة تمامًا ($h > 0$) عبر جميع نقاط العينات طوال التجارب.

5. الأهمية

يعالج هذا العمل حلاً جوهريًا لمحدودية السلامة في الروبوتات: المقايضة بين القدرة الحسابية والسلامة المثبتة لكامل الجسم.

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

باختدال، تقدم الورقة إطار عمل قويًا، ومؤسسًا رياضيًا، وفعالًا حسابيًا يُمكّن الملاعب الروبوتية من العمل بأمان في بيئات ثلاثية الأبعاد معقدة وديناميكية دون التضحية بالأداء أو ضمانات السلامة.