Invariant Kalman filtering for extended pose estimation in multi-IMU articulated rigid-body systems
تقترح هذه الورقة تمثيلاً جديداً للوضعية الممتدة بـ L-نسبية ومرشح كالمان الممتد الثابت المتكرر (IterIEKF) الذي يدمج بفعالية قيود الحركة المشتركية في أنظمة الأجسام الصلبة المفصلية متعددة وحدات القياس بالقصور الذاتي (multi-IMU)، محققاً تفوقاً في التقارب والاتساق والدقة مقارنة بالنماذج المرجعية الحالية.
تخيل محاولة تتبع حركة آلة معقدة أو جسم بشري باستخدام مستشعرات صغيرة مثبتة على الجلد أو المعدن فقط. هذا هو عالم الملاحة بالقصور الذاتي، وهو مجال يستخدم فيه العلماء وحدات القياس بالقصور الذاتي (IMUs) — وهي أجهزة صغيرة مليئة بمقاييس التسارع والجيروسكوبات — لمعرفة مكان الشيء، وسرعته، والاتجاه الذي يواجهه. فكر في وحدة (IMU) كراقص معصوب العينين يمكنه الشعور بكل دورة وخطوة، لكنه لا يعرف أين هو في الغرفة. ولإيجاد طريقه، يحتاج إلى "عقل" ذكي ليخمن موقعه بناءً على تلك الأحاسيس.
بالنسبة للأجسام المفردة، مثل طائرة بدون طيار تطير في خط مستقيم، لدينا رياضيات ممتازة لمساعدة هذا العقل على التخمين بشكل صحيح. لكن الأمور تصبح معقدة عندما نتعامل مع الأنظمة المفصلية — وهي أشياء مكونة من أجزاء متعددة متصلة بمفاصل، مثل ذراع روبوت بها أكواع ومعاصم، أو ساق بشرية بها ركبة وكاحل. هذه الأجزاء مترابطة؛ فإذا انثنت الركبة، تتحرك القدم، وتتحول السلسلة بأكملها. التحدي يكمكم في أن الرياضيات المستخدمة للأجسام المفردة غالبًا ما تنهار عندما تحاول تطبيقها على هذه السلاسل المترابطة، مما يؤدي إلى تخمينات تنحرف عن المسار أو ترتبك بسبب الروابط بين الأجزاء. لقد كان العلماء يبحثون عن طريقة أفضل لإبقاء هؤلاء "الراقصين المعصوبين العينين" في حالة تزامن دون الحاجة إلى كاميرات خارجية لمراقبتهم.
تقدم هذه الورقة البحثية طريقة جديدة ذكية لحل هذا اللغز. اقترح المؤلفون، وهم فريق من الباحثين، "لغة" رياضية جديدة تسمى الوضعية النسبية الموسعة-L (relative L-extended pose). بدلاً من محاولة تتبع موضع كل جزء من الجسم من نقطة ثابتة (مثل خريطة عالمية)، قرروا تتبع كيفية حركة كل جزء بالنسبة للجزء المجاور له مباشرة. تخيل صفًا من الناس يمسكون بأيدي بعضهم البعض: بدلاً من أن يحاول كل شخص تذكر مسافته من خط البداية، يحتاجون فقط إلى معرفة مدى بعدهم عن الشخص الذي يمسك بأيديهم. هذا التحول البسيط في المنظور يسمح للرياضيات بالتعامل مع عملية "إمساك الأيدي" (المفاصل) بشكل مثالي.
باستخدام هذا النهج النسبي، بنى الفريق مرشحًا جديدًا يسمى IterIEKF (مرشح كالمان الموسع الثابت المتكرر). هذا المرشح مميز لأنه يعامل الروابط بين أجزاء الجسم كقواعد "خالية من الضجيج". في الطرق القديمة، كان على الكمبيوتر تخمين مدى إحكام المفاصل، مما يؤدي غالبًا إلى أخطاء صغيرة تتراكم مع الوقت. أما الطريقة الجديدة فتعامل المفاصل كقوانين فيزيائية صلبة لا يمكن كسرها، مما يجبر التقدير على البقاء مطابقًا للشكل الفعلي للروبوت أو الإنسان.
اختبر الباحثون هذه الفكرة على شيئين مختلفين تمامًا: ذراع روبوت UR5e تؤدي مهام الالتقاط والنقل، وساق بشرية تقوم بتمارين الطعن الأمامي. وقارنوا طريقتهم الجديدة بعدة تقنيات قياسية قديمة. كانت النتائج مذهلة؛ فلم يكتفِ المرشح الجديد بالعمل فحسب، بل عمل بشكل أفضل بكثير. في اختبارات الروبوت، قلل الأخطاء في الموضع بنحو 50% والأخطاء في السرعة بنسبة تقارب 88% مقارنة بثاني أفضل طريقة. وبالنسبة للساق البشرية، كان التحسن أكثر دراماتيكية، حيث انخفضت أخطاء الموضع بنسبة 85.6%.
والأهم من ذلك، أن المرشح الجديد لم يحصل على الإجابة الصحيحة فحسب، بل وصل إليها بشكل أسرع وبثبات أكبر. فبينما كانت المرشحات القديمة تتعثر غالبًا في البداية، مظهرةً طفرات كبيرة في الخطأ قبل أن تتعافى ببطء، كان المرشح الجديد يتقارب (converge) فورًا ويظل مستقرًا، مرة تلو الأخرى. تُظهر الورقة أنه من خلال تغيير كيفية تمثيلنا للمشكلة — بالتركيز على العلاقات بين الأجزاء بدلاً من مواضعها المطلقة — يمكننا إنشاء طريقة أكثر موثوقية لتتبع الحركة. وهذا ليس مجرد فوز نظري؛ بل يعني أن الروبوتات يمكن أن تتحرك بدقة أكبر، ويمكن للمستشعرات القابلة للارتداء تتبع الحركة البشرية بدقة أكبر بكثير، وكل ذلك دون الحاجة إلى كاميرات خارجية باهظة الثمن لمراقبتهم.
ملخص تقني: مرشح كالمان الثابت لتقدير الوضع الممتد في الأنظمة المتعددة المستشعرات (IMU) للأجسام الصلبة المفصلية
بيان المشكلة يعد التقدير الدقيق للوضع الممتد (التوجه، السرعة، والموقع) للأنظمة ذات الأجسام الصلبة المفصلية المزودة بوحدات قياس عطالية (IMUs) تحديًا حاسمًا في مجال الروبوتات وتحليل حركة الإنسان. وبينما يوفر مرشح كالمان الممتد الثابت (IEKF) ضمانات التقارب والاتساق تحت حالة عدم القابلية للملاحظة بالنسبة للأجسام الصلبة المنفردة، فإن توسيع هذه الخصائص لتشمل الأنظمة المفصلية ظل مشكلة مفتوحة. تواجه النهج الحالية عائقين رئيسيين:
نماذج القطع الحرة: إن معاملة كل جسم على أنه يمتلك وضعًا مستقلًا بالنسبة للإطار العطالي يمنع التطبيق المباشر للترشيح الثابت، لأن الارتباط بين أوضاع الأجسام يجعل من المستحيل التعبير عن القيود الكينماتيكية في شكل ثابت. كما أن فرض هذه القيود كقياسات شبه مستشعرة مشوبة بالضجيج يؤدي إلى انتهاكات في البقايا.
نماذج الشجرة الكينماتيكية: بينما تلبي هذه النماذج القيود من خلال البناء، إلا أنها غالبًا ما تعتمد على تمثيلات (مثل زوايا أويلر) تؤدي إلى تقريبات ديناميكية ضعيفة ونماذج قياس عالية غير الخطية، مما يعيق عملية التقارب.
المنهجية يقترح المؤلفون إعادة صياغة لمشكلة تقدير الوضع الممتد باستخدام تمثيل محدد لمجموعة "Lie group" يستوفي متطلبات إطار الترشيح الثابت.
الوضع الممتد النسبي (Relative L-Extended Pose): المساهمة المنهجية الجوهرية هي تقديم "الوضع الممتد النسبي L". فبدلاً من تمثيل الحالة كأوضاع مطلقة لجميع الأجسام، يتم تعريف حالة النظام كمصفوفة قطرية كتلية في مجموعة Lie group SE2L(3). تمثل كل كتلة قطرية الوضع الممتد لجسم تابع بالنسبة لجسم سابق في الشجرة الكينماتيكية، معبراً عنه في إطار الجسم السابق.
الديناميكيات التآلفية للمجموعة (Group-Affine Dynamics): يوضح المؤلفون أن هذا التمثيل النسبي ينتج ديناميكيات تآلفية للمجموعة. هذه الخاصية ضرورية لمرشح IEKF، حيث تضمن أن ديناميكيات الخطأ مستقلة عن تقدير الحالة، مما يحافظ على ضمانات التقارب للمرشح.
القيود المفصلية الثابتة: من خلال استخدام الأوضاع النسبية، يمكن التعبير عن القيود الكينماتيكية (مثل المفاصل الكروية والمفصلية) في شكل ثابت. وتحديدًا، القيود التي كانت تربط الأوضاع المطلقة سابقًا (مثل p01+R01ρ1=p02+R02ρ2) تتحول إلى قيود تعتمد فقط على الكتلة النسبية (Xk)j.
مرشح IEKF المتكرر (IterIEKF): يدمج الإطار المقترح هذه القيود الكينماتيكية كقياسات شبه مستشعرة خالية من الضجيج ضمن مرشح IEKF متكرر. يسمح هذا للمرشح بفرض القيود الكينماتيكية بدقة (حتى حدود الدقة العددية) دون التضحية بالضمانات النظرية للترشيح الثابت. ويتم بعد ذلك استعادة الوضع المطلق لكل جسم عن طريق ربط الكتل النسبية على طول الشجرة الكينماتيكية.
المساهمات الرئيسية تحدد الورقة ثلاث مساهمات رئيسية:
تمثيل الحالة: تقديم الوضع الممتد النسبي L، وهو تمثيل حالة لمجموعات Lie للأنظمة متعددة الـ IMU المفصلية يسمح بديناميكيات تآلفية للمجموعة وقيود مفصلية ثابتة.
صياغة المرشح: صياغة محددة لـ IterIEKF تدمج قيود المفاصل الكروية والمفصلية كقياسات شبه مستشعرة خالية من الضجيج، مستفيدة من التمثيل المقترح.
التحقق التجريبي: تقييم شامل عبر مهمتين متميزتين: ذراع روبوتية من طراز UR5e تقوم بحركات الالتقاط والوضع، وساق بشرية تقوم بحركات الطعن الأمامي.
النتائج التجريبية تم التحقق من صحة الطريقة المقترحة مقابل نماذج مرجعية تشمل EKF القياسي، وIterEKF، وIterIEKF ذو التمثيل المطلق.
روبوت UR5e: في 100 تجربة، تقارب مرشح (relative-representation IterIEKF) بشكل فوري تقريبًا مع تباين ضئيل بين التجارب. وقد حقق أدنى جذر متوسط مربع الخطأ (RMSE) عبر جميع الفئات مقارنة بالنماذج المرجعية. وتحديدًا، قلل من RMSE بنسبة 50% للتوجه، و87.7% للسرعة، و59.7% للموقع مقارنة بثاني أفضل مرشح (relative-representation EKF).
الساق البشرية: وبالمثل، في تتبع الحركة البشرية، تقارب (relative-representation IterIEKF) في غضون خطوات زمنية قليلة مع حد أدنى من التباين. وقد تفوق على جميع المرشحات الأخرى، محققًا انخفاضات في RMSE بنسبة 60.7% (التوجه)، و92.4% (السرعة)، و85.6% (الموقع) مقارنة بثاني أفضل مرشح في كل فئة.
ملاحظات عامة: عبر كلا السيناريوهين، ثبت أن التمثيل النسبي كان حاسمًا. فالمرشحات التي تستخدم التمثيلات المطلقة (حتى مع الهياكل الثابتة) أظهرت تقاربًا أبطأ، وأخطاء عابرة أكبر، وتباينًا أعلى.
الأهمية والادعاءات تدعي الورقة أن اختيار تمثيل الحالة هو العامل الأساسي في النجاح في توسيع نطاق الترشيح الثابت ليشمل الأنظمة المفصلية. ومن خلال اعتماد الوضع الممتد النسبي L، يوفر المؤلفون إطارًا مبدئيًا:
يحافظ على ضمانات التقارب والاتساق للترشيح الثابت.
يسمح بالإدراج الدقيق للقيود الكينماتيكية كقياسات شبه مستشعرة خالية من الضجيج.
يتفوق باستمرار على مناهج EKF وIterEKF الحالية من حيث الدقة، وسرعة التقارب، والاستقرار.
يخلص المؤلفون إلى أن هذا النهج يضع أساسًا متينًا لتقدير الوضع القائم على الـ IMU في الأنظمة المفصلية. ويشيرون إلى أنه بينما يعالج العمل الحالي المفاصل المفصلية والكروية، فإن العمل المستقبلي سيمتد ليشمل أنواع المفاصل الأخرى (الأسطوانية، المنزلقة، المستوية) ويستقصي استراتيجيات التعويض عن آثار الأنسجة الرخوة في تحليل الحركة البشرية.