你的浏览器版本过低,可能导致网站不能正常访问!
为了你能正常使用网站功能,请使用这些浏览器。

STM32Cube 的X-CUBE-MEMS1 扩展软件中MotionFX 传感器融合库使用入门

[复制链接]
STMCU小助手 发布时间:2022-12-4 18:00
前言2 u5 Q1 H( w( P# Z( h  m: A
MotionFX 是 X-CUBE-MEMS1 软件的中间件库组件,可在 STM32 上运行。它可提供实时运动传感器数据融合。它还执行陀螺仪偏差和磁力计硬铁校准。
4 U9 S1 ^! T, f' t& j, Y6 _, u该算法以静态库格式提供,旨在用于基于 ARM® Cortex®-M4 架构的 STM32 微控制器。  y) j  \2 r+ O4 c) q/ {- A
它以 STM32Cube 软件技术为基础而构建,便于在不同 STM32 微控制器之间移植。
& Q  e# q& t' j) ^该 软 件 附 带 了 NUCLEO-F401RE 或 NUCLEO-L476RG 开 发 板 上 的 X-NUCLEO-IKS01A1 ( 可 选STEVAL-MKI160V1)或 X-NUCLEO-IKS01A2 扩展板上运行的示例实现。
8 n# K; x( D2 A. @8 O0 e/ f, z0 v4 k, J$ \" [
1 缩写和缩略语
3 t. [% d8 N. x6 d" x. f6 y K7B5EXOWSMKY]OTCUD8Y]X9.png 1 G" ]5 a" F3 G0 n; D
' m$ F; u6 |" t% _: a
2 MotionFX middleware library in X-CUBE-MEMS1 software expansion for STM32Cube
7 k' t; I3 Z; c. [& I* u1 Y2.1 MotionFX 概述; c2 z" W# `! C7 }, k
MotionFX 库扩展了 X-CUBE-MEMS1 软件的功能。
6 q, {+ y; {) j* x: Q该库从加速度计、陀螺仪(6 轴融合)和磁力计(9 轴融合)获取数据,并提供实时运动传感器数据融合。
0 U' v7 ^4 `5 Y6 N无论环境条件如何,MotionFX 滤波和预测软件都利用高级算法智能地对来自多个 MEMS 传感器的输出进行整合,可以实现最佳性能。
4 T+ l3 \- o* NX-NUCLEO-IKS01A2 和 X-NUCLEO-IKS01A1(可选 STEVAL-MKI160V1)扩展板上提供了一个示例实现,安装在 NUCLEO-F401RE 或 NUCLEO-L476RG 开发板上。
8 N! U. Q& x. i2 o/ Y7 G" p+ K. F3 }0 R' o' u# E
2.2 MotionFX 库5 j6 a8 h6 }6 T3 K' O/ J
在“Documentation”文件夹的 HTML 文件(使用 MotionFX_Package.chm 编译)中,提供了完整描述 MotionFX API 的功能和参数的技术信息。
$ A# C0 S8 x" @* n2.2.1 MotionFX 库说明
2 g: j% L% i0 F" S1 U% vMotionFX 传感器融合库可管理从加速度计、陀螺仪和磁力计传感器获取的数据;它能够:$ b) v5 ]$ p: |) u: _0 V) q( i; x
• 实时 9 轴运动传感器数据融合(加速度计,陀螺仪,磁力计)  r, o& `2 S  D& T
• 实时 6 轴运动传感器数据融合(加速度计,陀螺仪)0 u) {+ x9 W/ s& R0 d, q
• 计算旋转、四元数、重力和线性加速度数据
$ u# x/ {0 j9 M• 陀螺仪偏差校准
9 _8 A4 x2 x. Y2 J• 磁力计硬铁校准3 Y0 E0 y5 z4 G
• 建议传感器数据采样频率为 100 Hz- z, E2 j' y9 D; b3 d6 M0 W
• 45 kB 的代码和 8 kB 的数据存储器  j1 j% e+ v  Z+ G9 I
实际空间大小对于不同的 IDE(工具链)可能不同/ e0 b3 j4 i2 \9 P" p
• 适用于 ARM Cortex-M4 架构0 g- @' B7 \* b

: J4 ]+ ]" ?8 K( h) s
2.2.2 MotionFX 6 轴和 9 轴传感器融合模式2 R7 ~- l0 T" l7 ]
MotionFX 库实现了传感器融合算法,用来估算空间中的 3D 方向。它使用基于 Kalman 理论的数字滤波器来融合来自多个传感器的数据,并补偿单个传感器的限制。例如,陀螺仪数据可能会漂移,这会影响定向估计;这个问题可以通过使用磁力计提供绝对定向信息来解决。
0 I% D7 J  Y( W: X' U类似地,磁力计带宽不高,并且受磁力干扰,但是这些弱点可利用陀螺仪来进行补偿。
( ]2 X0 c& ?+ {) W% L0 \" G# _3 j; \$ m/ w. T: O( C# c5 k
9 轴传感器融合使用来自加速度计、陀螺仪和磁力计的数据,并提供 3D 空间中的绝对定向,包括航向(即磁性北方向)。- l  |, p4 E" n6 e9 V
6 轴传感器融合仅使用加速度计和陀螺仪数据。它对计算要求较低,但不能提供有关器件绝对定向的信息。5 t2 u& p( }6 D( B2 d
6 轴传感器融合适用于快速移动(例如,游戏中)并且不需要绝对定位时的场景。
( |; `" |% v& Q% n$ _3 c% P: O4 J6 z2 ]
$ E. o' ]! P$ t2 k  u" z& b
2.2.3 MotionFX 库操作6 p/ |6 K! b! a/ u- A1 r( L3 `
MotionFX 库将 6 轴和 9 轴传感器融合算法集成在一个库中;甚至可以同时运行它们。
6 B% `: `! b# K该库实现了传感器融合计算相关的以下关键内部函数:8 Q, `' J, x- @2 Z1 C# C
1. MotionFX_propagate 是用于估计 3D 空间中定向的预测函数;在此阶段给予了陀螺仪数据更高权重。  F- v7 t- \: v1 {( L
2. MotionFX_update 是校正函数,可在需要时调整预测值;这个阶段给予了加速度计和磁力计数据更高权重。
% [$ t3 x: }8 E1 {每当调用 MotionFX_propagate 时,都可调用 MotionFX_update 函数,在计算能力较小的系统中不经常调用该函数。
" O1 x) T7 ~8 CMotionFX_update 函数大约比 MotionFX_propagate 函数多花费三倍的 MCU 计算时间。2 t1 T8 o& b3 i: ~3 }$ N
! a. u1 x: ]# q
2.2.4 MotionFX 库参数! ?5 o3 F6 q' t+ x
MotionFX 库使用 MFX_knobs_t 结构体进行“参数化”。
5 o* V( r5 D$ z6 L结构体参数如下:
% U3 Q; }8 Z/ ~) v• ATime、MTime、FrTime 表示用于预测的传感器(信任因子)的加权稳定性,从 0 到 1。建议使用默认值。
, X. i, l' l% P0 j" {. O( U; R• LMode 代表陀螺仪偏差学习模式;库能够自动监测校准条件并进行零偏校准。
& p6 f7 s+ M) N2 j' x: G. c, l此可能的参数值是:! j# K( _! b8 q$ {9 A" _- W
− LMode = 0 – 学习关闭;如果陀螺仪已校准,则使用此模式* P' K' X( n* C8 L# `
− LMode = 1 – 静态学习;仅当系统不动时进行学习
7 b) F! ^' N/ K8 `− LMode = 2 – 动态学习;系统移动时也进行学习/ Z; u* o/ P# a" u. i0 B
• gbias_acc/gyro/mag_th_sc_6X, gbias_acc/gyro/mag_th_sc_9X 表示阈值,低于这些阈值时 gbias 算法自动启动。这些值应通过测试来确定(不同型号器件对应不同的阈值)。6 {( n+ Z" R) b% h) u: b$ N! g
示例项目中的值通常是正确的
" _3 f# w* C* w& j" A# e5 V, k− modx 表示 MotionFX_update 调用频率的抽取
, @8 h5 j9 S6 h− output_type 用于定义融合库输出数据的坐标系统类型:0 = NED,1 = ENU; t2 ]* K6 j. X. E2 S
− start_automatic_gbias_calculation 表示一个标志,当该标志设置为 1 时可重新启动陀螺仪偏差校准) k/ C, x  d& n) r( T
− acc/gyro/mag_orientation 是由三个字符组成的 acc/gyro/mag 数据定向字符串,指示速度计数据输出使用的参考框架的每个正定向的方向,顺序为 x、y、z。有效值2 Q2 v4 R) d0 \7 m% o7 K/ p& B
为:n(北)或 s(南),w(西)或 e(东),u(上)或 d(下)。
9 V3 u. L+ W! U% M如下图所示,X-NUCLEO-IKS01A1 加速度计传感器采用 ENU 定向(x - 东,y - 北,z - 上),因此字符串为“enu”,而 STEVAL-MKI160V1 中的加速度计传感器为 NWU 定向(x-北,y-西,z-上),字符串为“nwu”。1 P& R9 B4 ~; c; {  H& O

3 \. p7 c% k# p Z3MBJ8L`T]`V%JB%8QE3%NL.png , l! {' @* `3 c+ P/ l' r5 s! p& J
+ @$ }' Y# F3 p  S; b# C; N
MotionFX_propagate 和 MotionFX_update 函数从 MFX_input_t 结构体获取传感器数据:* Z5 q) ]9 o2 ~0 z
• mag 表示校准后的磁力计数据,以 µT/ 50 计  u( T' |3 j3 K, k% j% X  C
• acc 表示加速度计数据,以 g 计) E( Z: O; Q4 o* s  j/ T
• gyro 表示陀螺仪数据,以 dps 计
! y" P, X) V' E! m: d, l  v: ?: o; X0 T4 ]
MotionFX_propagate 和 MotionFX_update 将融合算法输出保存到 MFX_output_t 结构体中:
( G1 M5 U9 e; v" U* y' |% e• rotation_6/9X 表示系统定向为三角格式:偏航角,俯仰角,翻滚角! J0 k# K, {$ Y: k$ n8 ~8 ?
• quaternion_6/9X 表示系统定向四元素格式;此格式可提供与 rotation_6/9X 同样的信息,但它在计算方面具有优势,因此通常用于其他算法(基于传感器融合)。
' y! X0 P! a# G+ u• gravity_6/9X 表示从加速度数据中所得到的静态加速度(即,地球重力)向量; l2 O  \: E% {+ l! n- `3 d6 F
• linear_acceleration_6/9X 表示从加速度数据中得到的动态加速度(即,移动)向量。
5 y/ u9 V) V6 @: ?; t. m
5 v! C9 [9 r7 C% Y$ a! `5 v% U, h完整版请查看:附件9 y5 x! ~0 B+ o6 Q" ^! D
) x, h: D- D" c( u
3 k; o0 z5 l# g. B4 @2 u  ]

% f2 c! t: M: O0 p2 j: Q

STM32Cube 的 X-CUBE-MEMS1 扩展软件中 MotionFX 传感器融合库使用入门.pdf

下载

1.34 MB, 下载次数: 25

赞 收藏 评论0 发布时间:2022-12-4 18:00

举报

0个回答

所属标签

相似技术帖

官网相关资源

关于
我们是谁
投资者关系
意法半导体可持续发展举措
创新与技术
意法半导体官网
联系我们
联系ST分支机构
寻找销售人员和分销渠道
社区
媒体中心
活动与培训
隐私策略
隐私策略
Cookies管理
行使您的权利
官方最新发布
人形机器人运动控制、感知与智能配电
半导体创新技术与应用方向
EE架构与软件定义汽车
12V/48V 汽车智能配电(SPD)
区域控制单元(ZCU)与分区架构
关注我们
st-img 微信公众号
st-img 手机版