芯耀
199
目的和益處
本設(shè)計建議解釋了如何利用陀螺儀數(shù)據(jù)更新傾斜測量（翻轉(zhuǎn)和俯仰角）和電子羅盤（偏航角）。還給出了四元數(shù)實現(xiàn)，其不存在奇點(diǎn)問題，也稱為萬向節(jié)鎖。
優(yōu)勢：
- 對簡單的 6 軸 Acc+Mag 數(shù)據(jù)融合功能進(jìn)行了增強(qiáng)，此 6 軸融合算法在存在 high-g 運(yùn)動或磁異常時無法執(zhí)行。
- 使用 osxMotionFX 庫提供的完整數(shù)據(jù)融合，可減少固件占用空間，請參閱設(shè)計支持材料段落中的 Open.MEMS。
- 基本實現(xiàn)簡短，可以讓最終用戶輕松實現(xiàn)定制和增強(qiáng)（osxMotionFX 僅以二進(jìn)制格式提供，而不是源代碼）
- 易于在任意微控制器上使用（osxMotionFX 只能在 STM32 上運(yùn)行，并且只有在Open.MEMS 許可證服務(wù)器發(fā)布了適當(dāng)?shù)脑S可證時才能運(yùn)行）。
Euler 角實現(xiàn)說明
第 1 步：基于當(dāng)前角度 Phi / Theta / Psi 和陀螺儀數(shù)據(jù) Wx / Wy / Wz（參見圖 1），計算角度導(dǎo)數(shù) Phi' / Theta' / Psi'：
翻轉(zhuǎn)角導(dǎo)數(shù)：Phi’ = Wx + Wy * Sin(Phi) * Tan(Theta) + Wz * Cos(Phi) * Tan(Theta)
俯仰角導(dǎo)數(shù)：Theta’ = Wy * Cos(Phi) – Wz * Sin(Phi)
偏航角導(dǎo)數(shù)：Psi’ = Wy * Sin(Phi) / Cos(Theta) + Wz * Cos(Phi) / Cos(Theta)
閱讀全文
下載ECAD模型
