Virtual Constraint for a Quadrotor UAV Enforcing a Body-Axis Pointing Direction

إليك ملخص تقني مفصل للورقة البحثية بعنوان "القيد الافتراضي لطائرة كوادروتور (UAV) لفرض اتجاه محور الجسم".

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

تُستخدم طائرات الكوادروتور (الدرونز رباعية المراوح) بشكل متكرر في مهام يكون فيها توجيه محور معين ثابت بالنسبة للجسم (مثل كاميرا أو مستشعر) أمراً بالغ الأهمية، وغالباً ما يكون أكثر أهمية من وضعية المركبة الكاملة. تشمل الأمثلة ذلك التحكم في الرؤية عبر التوجيه (vision-based servoing)، والتصوير الجوي، ومهام الفحص التي تتطلب استشعاراً اتجاهياً.

التحدي:

• قيود الوضعية الجزئية: تتطلب أساليب التحكم التقليدية غالباً بناء مسار مرجعي كامل $(p_d(t), R_d(t)) \in \mathbb{R}^3 \times SO(3)$. ومع ذلك، فإن العديد من المهام تفرض قيوداً على جزء فقط من الوضعية (على سبيل المثال، محاذاة أحد محاور الجسم مع خط الرؤية) مع ترك درجات حرية أخرى (مثل الانعراج/الـ yaw) حرة أو مقترنة.
• مشكلات الاقتران: إن إكمال وضعية مرجعية كاملة لتلبية قيد جزئي قد يؤدي إلى إدخال اقترانات غير مرغوب فيها (على سبيل المثال، تسرب أخطاء الانعراج إلى اتجاه الدفع) أو يحجب المسائل المتعلقة بجدوى التنفيذ.
• محدودية الحوامل الدورانية (Gimbals): بينما يمكن للحوامل الدورانية فصل التوجيه عن وضعية المركبة، إلا أنها ليست متاحة دائماً، ولها حدود في عرض النطاق الترددي، ولا تحل المهام التي يجب أن تحقق فيها بنية المركبة نفسها قيوداً هندسية (مثل الأدوات المحاذية لمحور الدفع).

الهدف:
تطوير إطار عمل للتحكم الهندسي على $SE(3)$ يفرض مهام التوجيه (قفل محور جسم على اتجاه معين) والقيود الهندسية الأخرى (مثل الارتفاع الثابت) دون الحاجة إلى إكمال مرجع وضعية كامل.

oli 2. المنهجية

يقترح المؤلفون إطار عمل يعتمد على القيود غير الهولونومية الافتراضية (Virtual Nonholonomic Constraints). بدلاً من تتبع مسار محسوب مسبقاً، يتم ترميز المهمة ككائن هندسي ثابت (متعدد طيات المهمة وتوزيع مرتبط به للسرعات المسموح بها).

أ. الصياغة الهندسية

• فضاء الحالة: يعمل النظام على $SE(3) = SO(3) \times \mathbb{R}^3$، مع التكوين $g = (R, p)$.
• القيود الافتراضية: تُعرف المهمة كمتعدد طيات فرعي $D \subset TSE(3)$ (الحزمة المماسية) يمثل السرعات المسموح بها. يتم تعريفها عبر قيود خطية على سرعة الجسم $\xi = (\Omega, v)$:
  $$\mu_a(g, \Omega, v) = 0, \quad a = 1, \dots, m$$
• الثبات (Invariance): الهدف هو إيجاد قانون تحكم $u = (f, \tau)$ بحيث يكون التوزيع $D$ ثابتاً تحت ديناميكيات الحلقة المغلقة. يضمن هذا أنه إذا بدأ النظام على متعدد الطيات بسرعات متوافقة، فسيظل هناك.

ب. تخليق التحكم

1. الاشتقاق: يتم اشتقاق معادلات القيود على طول ديناميكيات النظام لفرض $\dot{\mu}_a = 0$.
2. النظام الخطي: ينتج عن ذلك نظام خطي من معادلات المدخلات التحكمية (الدفع $f$ وعزوم الدوران المختارة $\tau$).
3. شرط التباين (Transversality Condition): يوجد حل فريد إذا كان توزيع المهمة $D$ متبايناً (مكملاً) لتوزيع التفعيل الفعال $F_I$ (الفضاء الذي تشغله اتجاهات التحكم).
   • إذا تحقق التباين، فإن المصفوفة التي تربط الضوابط بمشتقات القيود تكون غير منفردة، مما يسمح بحل بنائي وصريح للمدخلات.

ج. دراسة حالة: توجيه محور الجسم مع ارتفاع ثابت

تطبق الورقة هذا على سيناريو محدد:

• القيد 1 (التوجيه): يجب أن يشير المحور الأول للجسم $b_1$ إلى الاتجاه الشعاعي السالب نحو الهدف ($b_1 = -\hat{p}$).
• القيد 2 (الارتفاع): يجب أن تحافظ الطائرة على ارتفاع ثابت ($e_3^T p = z_0$).
• التفعيل: يفترض النظام أن $\tau_1 = 0$ (لا يوجد عزم حول محور الدفع)، باستخدام الدفع $f$ والعزوم $\tau_2, \tau_3$.

الاشتقاق:

• تم اشتقاق قيود مستوى السرعة كالتالي:
  • $\Omega_3 = v_2 / \rho$
  • $\Omega_2 = -v_3 / \rho$
  • $e_3^T v = 0$
• من خلال اشتقاق هذه القيم وتعويض الديناميكيات، يستنتج المؤلفون تعبيرات ذات صيغة مغلقة لـ $f, \tau_2,$ و $\tau_3$ التي تفرض هذه القيود بدقة.

د. الاستقرار خارج متعدد الطيات (Off-Manifold Stabilization)

للتعامل مع أخطاء التهيئة أو الانجراف العددي، يستنتج المؤلفون توسيعاً للاستقرار:

• يحددون البواقي $\mu_i$ التي تمثل انتهاك قيود السرعة.
• يصممون قانون تغذية راجعة يدفع هذه البواقي إلى الصفر بشكل أسي ($\dot{\mu}_i = -k_i \mu_i$).
• ينتج عن ذلك قانون تحكم معدل يتضمن حدود تصحيح بناءً على البواقي، مما يضمن تقارب النظام نحو المتعدد الثابت حتى لو بدأ بعيداً عنه قليلاً.

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

1. صياغة القيد الافتراضي: إطار عمل هندسي مبتكر لمهام الكوادروتور يقوم بترميز المهام كأدوات توزيع سرعة ثابتة على $SE(3)$، مما يتجنب الحاجة إلى إكمال مرجع وضعية كامل.
2. قانون تحكم بنائي: اشتقاق قانون تغذية راجعة فريد يتم الحصول عليه عبر حل نظام خطي مشتق من اشتقاق القيود. الحل صريح وذو صيغة مغلقة لمهمة التوجيه المحددة.
3. تحليل التباين: تحديد الشرط الهندسي (التباين بين توزيع المهمة وتوزيع التفعيل) المطلوب ليكون قانون التحكم جيد التوصيف. هذا يحدد بوضوح "المجموعة الممكنة" (على سبيل المثال، لا يمكن أن يكون محور الدفع متعامداً مع المحور الرأسي).
4. توسيع الاستقرار: آلية استقرار محلية خارج متعدد الطيات تضمن الاضمحلال الأسي لبواقي قيود مستوى السرعة، مما يعالج المشكلات العملية مثل الانجراف في التكامل العددي.
5. حل ذو صيغة مغلقة: تطبيق على مهمة توجيه محور الجسم مع ارتفاع ثابت، مما يعطي صيغاً صريحة للدفع وعزم الدوران تكشف عن الاقتران بين الترجمة والدوران.

4. النتائج

أُجريت عمليات محاكاة عددية باستخدام نموذج قياسي لكوادروتور ($m=1, g=9.8, J=\text{diag}(2,2,6)$).

• الأداء داخل متعدد الطيات: عند التهيئة تماماً على متعدد الطيات، يحافظ قانون الحفاظ على القيود عليها. ومع ذلك، يتسبب التكامل العددي القياسي (Runge-Kutta) في انجراف طفيف في قيود السرعة بمرور الوقت، مما يؤدي إلى أخطاء تدريجية في التكوين.
• الاستقرار خارج متعدد الطيات:
  • تم اختبار تهيئة "هيكلية خارج متعدد الطيات" حيث تم تغيير باقٍ السرعة الرأسية ($\mu_3$) فقط.
  • المقارنة: سمح قانون الحفاظ الصرف ($k_i=0$) لخطأ الارتفاع بالانجراف. بينما نجح القانون المستقر ($k_3=5$) في دفع الباقي الرأسي إلى الصفر بشكل أسي.
  • جهد التحكم: حافظ المتحكم المستقر على مدخلات دفع وعزم دوران محدودة ومقاربة لحالة الحفاظ الصرفة، مما يثبت أن الاستقرار لا يتطلب جهداً تحكمياً مفرطاً.
• الانتظام (Regularity): أكدت عمليات المحاكاة أن المسارات ظلت ضمن نطاق الانتظام (حيث $e_3^T b_3 \neq 0$)، مما يضمن عدم تلاشي المقامات في قوانين التحكم.

5. الأهمية والعمل المستقبلي

الأهمية:

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

الاتجاهات المستقبلية:

• تحليل تأثير مكاسب الاستقرار على السلوك العابر والمتانة.
• توسيع إطار العمل ليشمل مهام توجيه أكثر تعقيداً ومنصات أخرى غير مقيدة بالكامل.
• التحقق التجريبي على طائرات كوادروتور حقيقية لاختبار الأداء تحت ضجيج المستشعرات وحدود المشغلات.
• استقصاء السيناريوهات التي تحتوي على مشغلات توجيه إضافية (حوامل دورانية) لتحديد متى يكون فرض الهندسة على مستوى المركبة متفوقاً على التحكم على مستوى الحمولة.