FPGA-Based Real-Time Sensor Fusion for Inertial Navigation Using IMU and GPS Data

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

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

مهمة الورقة البحثية: بناء عقل ملاحة فائق السرعة

تقدم هذه الورقة البحثية بقلم عباس فدفي طريقة جديدة لبناء ذلك "المطبخ الخارق" للملاحة. قام المؤلف بأخذ خوارزمية ملاحة معقدة تعمل عادةً على جهاز كمبيوتر، ونجح في ترجمتها إلى تصميم يعيش مباشرة على شريحة Xilinx Kintex-7 FPGA. كان الهدف هو جعل "الحكم" (EKF) سريعاً بما يكفي للتعامل مع البيانات عالية السرعة من وحدة IMU، مع انتظار تحديثات GPS البطيئة، دون أن يثقل كاهله بالرياضيات المعقدة.

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

تضمن أحد التغييرات الرئيسية "متجه الحالة" (state vector)، وهو ببساطة قائمة بكل الأشياء التي يحاول الكمبيوتر تخمينها حول موقعك (مثل مكانك، وسرعتك، والاتجاه الذي تواجهه). حاول نموذج MATLAB الأصلي تخمين 22 شيئاً مختلفاً، بما في ذلك بيانات المجال المغناطيسي. أدرك المؤلف أنه بالنسبة لإعداد GPS/IMU هذا، فإن البيانات المغناطيسية ليست ضرورية تماماً. ومن خلال تقليص القائمة إلى 16 عنصراً رئيسياً، قللوا من كمية الرياضيات التي يتعين على الشريحة القيام بها بنسبة 65% تقريباً. الأمر يشبه إدراك أنك لست بحاجة لتتبع درجة حرارة كل ورقة شجر في الغابة لتعرف أنك تائه؛ فأنت تحتاج فقط لتتبع مسارك وسرعتك.

الخدع السحرية: كيف جعلوا الأمر سريعاً
لجعل الرياضيات تطير، استخدم المؤلف بعض الخدع الذكية:

1. الصيغ التحليلية: بدلاً من ترك الكمبيوتر يخمن ويتحقق (الطرق التكرارية) لحل المسائل الرياضية المعقدة، استخدموا صيغاً دقيقة ومحسوبة مسبقاً. الفرق هو كمن يحاول تخمين الإجابة على لغز عبر تجربة كل كلمة في القاموس مقابل من يعرف الإجابة مباشرة.
2. تحليل تشولسكي (Cholesky Factorization): بالنسبة للعمل الثقيل في رياضيات المصفوفات (والذي يشبه تنظيم جدول بيانات ضخم من الاحتمالات)، استخدموا طريقة فعالة محددة تسمى تحليل تشولسكي. هذا يشبه استخدام طريق مختصر لحل لغز بدلاً من محاولة وضع كل قطعة في كل مكان ممكن.
3. التدفق المتوازي (Pipelining): استخدموا تعليمات خاصة تسمى "PIPELINE" و "ARRAY_PARTITION". تخيل خط تجميع في مصنع حيث يقوم كل عامل بخطوة صغيرة واحدة ثم يمرر العمل إلى الشخص التالي فوراً. هذا يسمح للشريحة بمعالجة البيانات باستمرار دون التوقف لانتظار انتهاء الخطوة السابقة.

النتائج: السرعة والدقة
اختبر الفريق تصميمهم على شريحة Xilinx Kintex-7 FPGA. كانت النتائج مبهرة. عملت الشريحة بسرعة ساعة قدرها 50 ميجاهرتز. وفي كل مرة احتاجت فيها لتحديث تخمينها لموقعك، استغرقت ما بين 1.12 مللي ثانية و1.21 مللي ثانية. هذا سريع للغاية—بما يكفي لمواكبة مستشعرات IMU عالية السرعة.

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

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