Coordinated Trajectory Control Algorithm for Quadcopter Motion along a Smooth Spatial Trajectory

ملخص تقني: خوارزمية التحكم المنسق في المسار لطائرة كوادكوبتر (رباعية المراوح) على طول مسار مكاني سلس

بيان المشكلة
تتناول الورقة البحثية تحدي التحكم في طائرة كوادكوبتر للتحرك على طول مسار مكاني ثلاثي الأبعاد سلس. يميز المؤلفون بين نموذجين أساسيين للتحكم: "التحكم في التتبع" (tracking control)، حيث تحاول الروبوت الوصول إلى موضع محدد في وقت محدد (مما يؤدي غالباً إلى حلول المسار الأقصر التي قد تفشل في البيئات الغنية بالعوائق)، و"التحكم المنسق" (coordinated control). في التحكم المنسق، يتم تحديد المسار وملف السرعة (speed profile) على طول ذلك المنحنى مسبقاً. ويتمثل هدف التحكم في تقليل الانحراف عن المسار، بدلاً من تقليل المسافة إلى نقطة زمنية محددة، مما يسمح للمركبة بالمناورة حول العوائق عبر تعديل سرعتها على طول المنحنى.

تتضمن المشكلة المحددة هنا نموذجاً ديناميكياً غير خطي لطائرة كوادكوبتر حيث تكون الدرجة النسبية (relative degree) لقنوات التحكم غير متطابقة، مما يعقد عملية تفكيك النموذج. علاوة على ذلك، يجب أن يعتمد الحل المقترح حصرياً على قياسات المخرجات (الإحداثيات الخطية $x, y, z$ وزاوية الانعراج $\psi$) بدلاً من قياسات متجه الحالة الكامل، وهو ما يعد قيداً كبيراً مقارنة بنهج التغذية الراجعة للحالة الموجودة حالياً.

المنهجية
يطور المؤلفون تخليقاً للتحكم يعتمد على نهج هندسي وتغذية راجعة للمخرجات قوية:

1. النمذجة الديناميكية وتعريف الانحراف:
   يتم وضع نموذج كامل غير خطي للكوادكوبتر يأخذ في الاعما حساب الإحداثيات الخطية والتوجه (الانعراج، الميل، والتدحرج). يتم تعريف الانحراف عن المسار المرغوب $S$ باستخدام تحويل إحداثي، ويتضمن ذلك:

• إحداثي مسار $s$ يمثل أقرب نقطة على المنحنى.
• إحداثيا خطأ خطيان ($e_1, e_2$) يمثلان المسافة إلى مستويين يتقاطعان عند متجه السرعة المرغوب.
• أخطاء زاوية ($\delta\phi, \delta\theta, \delta\psi$)، حيث يُفترض أن الميل والتدحرج المرغوبان صفر، ويُشتق الانعراج المرغوب من إسقاط المسار.

2. تحويل الصيغة الطبيعية (Normal Form Transformation):
   لتسهيل تصميم التحكم، يتم تحويل النظام إلى "صيغة طبيعية" باستخدام سلسلة من عمليات الاشتقاق وتغييرات الإحداثيات. يقدم المؤلفون متغيرات مساعدة ومكاملات للتعامل مع تشبع مدخل التحكم في الدفع ($u_1$). ينتج عن هذا التحويل نظام حيث تشكل المتغيرات المنظمة ($\xi_1$) ومشتقاتها ($\xi_2, \xi_3, \xi_4$) متجهاً لحالة ممتدة. ويتبين أن النظام قابل للعكس، مما يسمح بإعادة بناء مدخلات التحكم الأصلية من متغيرات الصيغة الطبيعية.

3. تخليق التحكم بالتغذية الراجعة للمخرجات القوية:

• التغذية الراجعة للحالة المثالية: في البداية، يتم تخليق قانون تحكم بافتراض توفر الحالة الكاملة. يستخدم هذا القانون هيكلاً للتغذية الراجعة الخطية مع معاملات ($\gamma_1$ إلى $\gamma_4$) يتم اختيارها لتشكيل متعدد حدود هورويتز (Hurwitz polynomial)، مما يضمن الاستقرار التقاربي المحلي لديناميكيات الخطأ.
• تنفيذ التغذية الراجعة للمخرجات: إدراكاً بأن قياس الحالة الكاملة غير متاح، يستخدم المؤلفون طريقة المراقب الممتد. يتم تصميم مراقب عالي الكسب لتقدير الحالات غير المقاسة ($\hat{\xi}_2, \hat{\xi}_3, \hat{\xi}_4$) وعنصر الاضطراب غير المعروف ($\hat{\sigma}$).
• قانون التحكم: يستخدم قانون التحكم النهائي هذه الحالات المقدرة ويتضمن دالة تشبع سلسة لضمان بقاء مدخلات التحكم ضمن الحدود الفيزيائية. يتم حساب قوى الدفع للمراوح الأربعة عن طريق عكس مصفوفة التحويل المستمدة من الصيغة الطبيعية.

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

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

النتائج والادعاءات
تقدم الورقة إثباتاً نظرياً للاستقرار المحلي للنظام المغلق الحلقة. يوضح المؤلفون أنه إذا تم اختيار معاملات المتحكم كمعاملات لمتعدد حدود هورويتز، فإن متغيرات الانحراف ($\tilde{\xi}$) تؤول تقاربياً إلى الصفر. وهذا يضمن أن الكوادكوبتر سوف:

1. يتبع المنحنى المكاني المحدد.
2. يحافظ على ملف السرعة المحدد على طول المنحنى.
3. يبقي أخطاء التوجه ضمن حدود مقيدة.

يؤكد الاشتقاق الرياضي أن قانون التحكم يحقق الأهداف المتمثلة في تقليل الانحراف عن المسار والحفاظ على السرعة والتوجه المطلوبين، بشرط أن يكون انحناء المسار محدوداً وأن تكون الظروف الأولية ضمن منطقة الجذب.

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