ماذا يعلّمك المسار
دمج الحساسات ومرشح كالمان سبعة دروس على لوحة Uno، موزعة على أربعة فصول. يأتي بعد المسرّعات والجيروسكوبات ووحدات IMU ويبني على المرشح التكميلي فيه بدلا من تكراره.
- الضجيج، مقاسا: الوسط والانحراف المعياري والتباين، قاعدة 68-95، قانون جذر التربيع في المتوسطات، وضجيج وتأخر المتوسط المتحرك وEMA، مقيسة باختبار خطوة.
- From fusion to Kalman: the complementary filter derived (alpha from tau, the crossover frequency, the steady error bias x tau, the noise it passes), then the 1D Kalman filter worked step by step to its steady state, with an innovation test and a wrong R.
- كالمان على أرض الواقع: زاوية الميل بمرشح كالمان من المعرض (الزاوية وانحياز الجيروسكوب في مرشح واحد)، ودمج GPS مع بوصلة، بما في ذلك أثر بوصلة منحرفة 10 درجات عليه.
- بناء الزعيم: أفق صناعي على شاشة SSD1306 OLED، تشغّله مرشحات كالمان ثنائية الحالة كُتبت صراحة في الكود، مع ضجيج قياس متكيّف.
ينتهي كل فصل باختبار قصير. افتحه من /learn.
الدوائر
يفتح درس واحد من الدروس زاوية الميل بمرشح كالمان مع MPU6050 من المعرض. أما البقية فتعمل بأكواد كُتبت خصيصا للدورة:
| الكود | قطعة | ما يفعله |
|---|---|---|
kalnoise |
MPU6050 | نوافذ من 200 قراءة: الوسط والانحراف المعياري والتباين و68-95 وavg N |
kalema |
MPU6050 | متوسط متحرك وEMA جنبا إلى جنب، step وalpha وspike |
kalcomp |
MPU6050 | مرشح تكميلي مقارن بالصيغ، tau وbias |
kal1d |
MPU6050 | مرشح كالمان أحادي القيمة خطوة بخطوة، الحالة المستقرة، q |
kalgps |
NEO-6M, MPU-9250 | الإبحار التقديري مع تصحيحات GPS، مقارنة بالحقيقة، وins |
kalboss |
MPU6050, SSD1306 | مرشّحات ذات حالتين تتعلّم انحيازات الجيروسكوب، والهزّة |
لماذا تضيف الأكواد الضجيج
الحساسات في المحاكاة مثالية. كل كود في هذه الدورة يضيف ضجيجًا غاوسيًا مُبذورًا وانحيازات معروفة فوق القراءة النظيفة، بأرقام ثابتة في الأعلى، ويحتفظ بالقراءة النظيفة كمرجع للحقيقة تُقارن النتائج بها. هذا ما يتيح لكل درس أن يتنبأ برقم من صيغة ثم يتحقق منه. المولّد المُبذور يعني أن تشغيلًا واحدًا يطبع الأرقام نفسها في كل مرة.
حدود صريحة
The filters here are linear and assume Gaussian noise. 3D attitude is not linear, which is why drones run extended Kalman filters or Madgwick and Mahony filters on quaternions; a full inertial navigation system also integrates the accelerometers twice and needs GPS to stop the drift. A Kalman filter is only as good as the Q and R it is given.
حل المشكلات
- رقم ما يختلف قليلًا عن رقم الدرس. إحصائية محسوبة من بضع مئات من العيّنات المليئة بالضجيج تتأرجح بنسبة عدة بالمئة؛ والدرس يوضّح مقدار ذلك.
- شاشة OLED تُحدَّث ببطء. إطار واحد بحجم 1 KB عبر I2C الخاص بـ Uno يستغرق نحو ثلث ثانية، لذا يعيد الكود الرسم مرة كل ثانية.
- لا توجد تصحيحات GPS. تحقّق من أن TX للوحدة موصول بالطرف 4، وأن التصحيح مفعّل (اضغط على الوحدة لتبديله).