⚡ electrical engineering

Robust Global Position and Heading Tracking on SE(3) via Saturated Hybrid Feedback

تقترح هذه الورقة بنية تحكم تغذية راجعة هجينة قوية للمركبات ناقصة التفعيل على مجموعة SE(3)، والتي تحقق تتبعاً عالمياً للموقع والاتجاه مع حدود تفعيل محددة من قبل المستخدم عبر الجمع بين متحكم موضع مشبع ومتحكم اتجاه يعتمد على MRP ومشبع، معزز بآلية هجينة لرفع المسار.

المؤلفون الأصليون: Luís Martins, Carlos Cardeira, Paulo Oliveira

نُشر 2026-03-20

📖 4 دقيقة قراءة☕ قراءة في استراحة قهوة

CC BY 4.0

المؤلفون الأصليون: Luís Martins, Carlos Cardeira, Paulo Oliveira

البحث الأصلي مرخَّص بموجب CC BY 4.0 (http://creativecommons.org/licenses/by/4.0/). ✨ هذا شرح مولَّده بالذكاء الاصطناعي للبحث أدناه. لم يكتبه المؤلفون ولم يصادقوا عليه. وللتحقق من الدقة التقنية، يرجى الرجوع إلى البحث الأصلي. اقرأ إخلاء المسؤولية الكامل

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

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

إليك تفصيل لحلها باستخدام تشبيهات من الحياة اليومية:

1. المشكلة: "الراقص الأخرق"

معظم الطائات بدون طيار هي ناقصة التوجيه (underactuated). فكر في راقص لا يستطيع إلا الدفع للأمام بقدميه، لكن ليس لديه أذرع للتوازن. إذا أراد الالتفاف لليسار، فعليه أن يميل بجسمه بالكامل.

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

2. الحل: فريق مكون من جزأين

بنى المؤلفون نظام تحكم يتكون من جزأين رئيسيين يعملان معاً: الحلقة الخارجية (الملاح) والحلقة الداخلية (الطيار).

الجزء أ: الملاح (الحلقة الخارجية) – "نظام تحديد المواقع المفلتر"

مهمة الملاح هي قول: "نحن بحاجة للذهاب إلى هناك".

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

الجزء ب: الطيار (الحلقة الداخلية) – "الجمبازي الهجين"

بمجرد أن يقول الملاح "مل بجسمك 45 درجة لليسار"، يجب على الطيار أن يحرك جسم الدرون فعلياً للقيام بذلك.

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

3. سحر الـ "هجين" (Hybrid)

كلمة "هجين" في العنوان هي الكلمة المفتاحية. وهي تعني أن النظام يستخدم كلاً من القيادة السلسة (عندما تسير الأمور على ما يرام) والقفزات المفاجئة (عندما يرتبك الدرون أو يكون مقلوباً).

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

4. لماذا هذا مهم؟

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

الملخص

لقد ابتكر المؤلفون عقلاً ذكياً وحريصاً على السلامة لطائرات الدرون الضعيفة.

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

الأمر يشبه إعطاء روبوت أخرق وضعيف مدرباً يعرف تماماً كيف يدفعه دون أن يكسره، ويعرف أيضاً كيف يعيد ضبط عقله إذا أصيب بالدوار.

إليك ملخص تقني مفصل للورقة البحثية بعنوان: "تتبع الموضع والاتجاه العالمي المتين على مجموعة SE(3) عبر التغذية الراجعة الهجينة المشبعة".

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

تعالج الورقة مشكلة تتبع الموضع والاتجاه العالمي المتين للمركبات ناقصة التفعيل (مثل الكوادروتور، والدرونز) التي تعمل تحت حدود تفعيل محددة من قبل المستخدم.

ديناميكيات النظام: يتم نمذجة المركبات كأجسام صلبة ذات دفع أحادي المحور (قوة على طول محور الجسم $z$ ) وتفعيل عزم دوران كامل. تتطور الديناميكيات على مجموعة الاستمرار الخاصة $SE(3)$ .
التحديات الجوهرية:
1. نقص التفعيل (Underactuation): عدد درجات الحرية يتجاوز مدخلات التحكم، مما يخلق عجزاً هيكلياً حيث يحدد اتجاه الدفع الوضعية (Attitude).
2. تشبع المشغلات (Actuator Saturation): الحدود الفيزيائية للدفع ( $T \le T_{max}$ ) وعزم الدوران ( $\tau \le \tau_{max}$ ) لا يمكن تجنبها. تجاهل هذه الحدود يؤدي إلى تدهور الأداء أو عدم الاستقرار.
3. العوائق الطوبولوجية: الفضاء التكويني $SE(3)$ (وتحديداً مجموعة الدوران $SO(3)$ ) ليس قابلاً للانكماش. هذا يمنع الاستقرار العالمي عبر التغذية الراجعة المستمرة وحدها. أما المتحكمات غير المستمرة، رغم قدرتها على تحقيق الاستقرار العالمي، فإنها تفتقر إلى المتانة ضد الاضطرابات الصغيرة (الارتجاج أو الوقوع في مناطق غير مرغوب فيها).
4. تجنب التفرد (Singularity Avoidance): غالباً ما تفشل هياكل التحكم الهرمية القياسية عندما يتلاشى الدفع المأمور به، مما يؤدي لفقدان القدرة على تحديد مرجع وضعية صالح.
5. الاقتران (Coupling): الحلول الحالية غالباً ما تعالج تشبع الدفع وتتجاهل تشبع عزم الدوران، أو تقيد تتبع الاتجاه (Heading) بشروط معينة (مثل زاوية ميل/دوران صفرية).

الهدف: تصميم مدخلات تحكم محدودة ( $T, \tau$ ) بحيث تحقق المركبة تتبعاً تقاربياً عالمياً متيناً وتتبعاً أسياً شبه عالمي لمسار مرجعي (الموضع والاتجاه) مع احترام حدود تشبع المدخلات بصرامة.

2. المنهجية

الحل المقترح هو بنية تحكم هجينة هرمية تتكون من حلقة موضع خارجية وحلقة وضعية داخلية، مترابطتين عبر إطار عمل تكافؤ الاستقرار.

أ. الحلقة الخارجية: تتبع الموضع المشبع مع المرشحات

بدلاً من استخدام وظائف التشبع المتداخلة (التي تعقد حدود المشتقات)، قدم المؤلفون متحكم موضع مشبع معزز بمرشحين من الدرجة الأولى.

البنية: يتم تقسيم قانون التحكم $u$ (قوة التحكم الافتراضية) إلى حد تغذية أمامية وحد تغذية راجعة مرشح $u_f$ .
ديناميكيات المرشح: يتم تطبيق مرشحين متتاليين من الدرجة الأولى ( $\dot{u}_f, \dot{u}_s$ ) على مخرج المتحكم الأساسي.
التحويل الإحداثي: الابتكار الرئيسي هو التحويل الإحداثي المسقط للأمام ( $z = \Phi_p \tilde{x}_p$ $z = Φ_{p} \tilde{x}_{p}$ ). هذا التحويل يفصل ديناميكيات المرشح جبرياً عن أخطاء التتبع.
- يقوم بخرائط نظام فيزيائي بمرشحات ذات عرض نطاق محدود إلى نظام "محول" يتصرف مثل مكامل مزدوج مثالي.
- يسمح هذا للمتحكم بأن يُصمم بافتراض عرض نطاق لانهائي، بينما يعالج التحويل رياضياً تأخر الطور الناتج عن المرشحات.
الفوائد: يوفر هذا النهج حدوداً قابلة للتحليل وغير محافظة لإشارة التحكم ومشتقاتها الأولى والثانية. هذه الحدود سهلة الضبط عبر كسب المرشحات ( $k_f, k_s$ )، مما يسهل التحقق من جدوى المسار قبل التنفيذ.

ب. الحلقة الداخلية: تتبع الوضعية الهجين المشبع

يتتبع متحكم الوضعية المراجع الديناميكية الناتجة عن الحلقة الخارجية.

التمثيل: يستخدم معاملات رودريغز المعدلة (MRP) لتمثيل خطأ الوضعية. تتجنب الـ MRPp التفردات ضمن منطقة معينة وتسمح بوجود "طقم ظل" للتعامل مع التغطية المزدوجة لـ $SO(3)$ .
رفع المسار الهجين (Hybrid Path-Lifting): لتحقيق الاستقرار العالمي على $SO(3)$ $S O (3)$ ، يستخدم المتحكم آلية رفع مسار هجينة ديناميكية.
- ينتقل بين تمثيلات MRP الرئيسية وظل الـ MRP بناءً على منطق التباطؤ (Hysteresis).
- هذا يتجنب العائق الطوبولوجي لـ $SO(3)$ ، مما يضمن عدم وقوع النظام في نهايات صغرى محلية.
قانون التحكم: قانون تغذية راجعة مشبع يعتمد على أخطاء MRP، مقترن بحد تغذية أمامية لإلغاء ديناميكيات الاقتران. تضمن وظائف التشبع احترام حدود عزم الدوران.

ج. الترابط وتحليل الاستقرار

تكافؤ الاستقرار: يستفيد المؤلفون من إطار عمل تكافؤ الاستقرار لإثبات أن استقرار النظام المترابط (الموضع + الوضعية) يتحقق على $SE(3)$ .
تحليل ليابونوف:
- الحلقة الخارجية: تثبت الاستقرار التقاربي العالمي والاستقرار الأسي شبه العالمي باستخدام دالة ليابونوف مركبة تأخذ في الاعتبار حالات المرشح.
- الحلقة الداخلية: تثبت الاستقرار التقاربي العالمي المتين والاستقرار الأسي شبه العالمي لنظام الوضعية الهجين.
- النظام المترابط: يستخدم تحليل الاستقرار من نوع $L_2$ والاستدلال الشبيه بـ "الربح الصغير" (عبر معدلات الاضمحلال الأسي) لإظهار أن حد الاقتران (الاضطراب من خطأ الوضعية إلى ديناميكيات الموضع) هو قابل للتكامل التربيعي ويضمحل أسياً، مما يضمن استقرار النظام ككل.

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

بنية معززة بالمرشحات مبتكرة: تستبدل وظائف التشبع المتداخلة المعقدة بنهج قائم على المرشحات، مما يبسط اشتقاق حدود المشتقات ويسمح بضبط حدود المرجع بشكل منهجي.
التحويل الإحداثي المسقط للأمام: تقنية فصل هندسي تعزل ديناميكيات المرشح هيكلياً، مما يتيح تصميم متحكمات كما لو كانت عملية التفعيل مثالية، مع إثبات الاستقرار بصرامة تحت القيود الحقيقية.
تشبع الدفع وعزم الدوران في آن واحد: على عكس الأعمال السابقة التي غالباً ما تتجاهل حدود عزم الدوران أو تقيد تتبع الاتجاه، يفرض هذا الحل حدوداً صارمة على كلا مدخلي الدفع وعزم الدوران في وقت واحد.
تتبع اتجاه غير مقيد: يضمن الصياغة إمكانية تتبع دقيق لزاوية الالتفاف (Yaw) دون تقييد زوايا الميل (Roll/Pitch) عند الصفر، متجاوزاً قيود الاقتران الهندسي الموجودة في الأدبيات السابقة.
ضمانات استقرار صارمة: تؤسس لـ استقرار تقاربي عالمي متين واستقرار أسي شبه عالمي لنظام $SE(3)$ الكامل تحت تشبع المدخلات، وهو أمر جديد للمركبات التي تعمل بالدفع وتفتقر لتفعيل كامل وتواجه تشبعاً متزامناً في الدفع وعزم الدوران.

4. نتائج المحاكاة

أُجريت محاكاة عددية على نموذج جسم صلب بـ:

الكتلة: 0.46 كجم، عزم القصور الذاتي: مصفوفة قطرية.
الحدود: $T_{max} = 7$ نيوتن، $\tau_{max} = (0.5, 0.5, 0.5)$ نيوتن متر.
السيناريو: بدأت المركبة في وضعية مواجهة للأسفل (زوايا أويلر $\approx -179^\circ$ ميل) مع أخطاء موضع أولية كبيرة، وكانت مكلفة بتتبع مسار جيبي ثلاثي الأبعاد مع تدوير اتجاهها.

النتائج الرئيسية:

التعافي: نجح النظام في التعافي من الوضعية الأولية المتطرفة وأخطاء الموضع الكبيرة.
أداء التتبع: تقاربت معايير خطأ الموضع وخطأ MRP إلى قيم مستقرة أقل من $0.001 $م و$ 0.0001$ على التوالي.
الامتثال للتشبع: احترمت إشارات الدفع وعزم الدوران المولدة حدود النظرية المشتقة في النظريات بدقة.
المتانة: حافظ المتحكم على الأداء رغم التأخر العابر الناتج عن المرشحات والتشبع الأولي لإشارات التحكم.

5. الأهمية

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