一种多节点穿戴式关节姿态测量系统及方法

摘要: 本发明涉及穿戴式姿态测量与人体运动分析,尤其涉及一种多节点穿戴式关节姿态测量系统及方法。背景技术:1、在现代医疗康复、运动生物力学分析以及虚拟现实(virtua...
一种多节点穿戴式关节姿态测量系统及方法

本发明涉及穿戴式姿态测量与人体运动分析,尤其涉及一种多节点穿戴式关节姿态测量系统及方法。

背景技术:

1、在现代医疗康复、运动生物力学分析以及虚拟现实(virtual reality,vr)全身动作捕捉领域,穿戴式关节姿态测量系统扮演着至关重要的角色。然而,现有依赖惯性测量单元(inertial measurement unit,imu)的穿戴式系统仍存在以下技术缺陷:

2、‌其一,多传感器采集不同步产生时间偏斜。传统i2c/spi轮询机制导致多节点采样存在数毫秒至数十毫秒时间偏斜,剧烈运动时该偏差被放大,使参与解算的基准四元数与末端四元数在时间维度上错位,造成相对角度解算出现严重几何畸变与动态误差。

3、‌其二,动态剧烈运动冲击直接干扰姿态解算稳定性。传统姿态估计算法采用固定pi增益(kp/ki)或等效的加速度修正权重、磁场修正权重、时间常数或观测噪声参数,无法兼顾不同运动状态:静止时收敛慢,剧烈运动时非重力加速度被误引入,导致姿态发散崩溃。

4、‌其三,复杂环境磁场扰动引发偏航漂移,同时推高系统功耗。常规九轴imu方案中磁力计与加速度计、陀螺仪高频同步采样,在复杂环境下瞬态磁干扰导致偏航角频繁毛刺波动,同时增加运算负担与功耗;现有方案无法在精准消除yaw轴长期漂移与降低功耗之间取得合理平衡。

技术实现思路

1、本发明提供一种多节点穿戴式关节姿态测量系统及方法,因多节点传感器硬件采集存在时间差、动态剧烈运动冲击与磁场干扰而导致姿态信号失真的缺陷,实现在穿戴设备侧直接解耦出低延迟、更真实的相对关节响应。

2、本发明提一种多节点穿戴式关节姿态测量系统,包括:

3、多个子节点,布设于待测关节的远端肢段,每个所述子节点包括:子惯性测量单元imu和磁力计;所述子imu,用于采集待测关节的子imu数据;所述磁力计,用于采集地磁场数据;

4、一母节点,布设于待测关节的近端肢段,包括:母imu以及边缘计算模块;

5、所述母imu,用于采集待测关节的母imu数据;

6、所述边缘计算模块,用于基于所述母imu数据、多个所述子imu数据以及地磁场数据,输出多个相对关节姿态;

7、其中,所述母节点,与多个所述子节点之间采用共享通信总线与独立节点选择信号的拓扑结构,在同一采样周期内对多个所述子节点进行有序访问,得到多个所述子节点的子imu数据;

8、所述边缘计算模块,包括:自适应姿态估计单元、地磁场数据处理单元以及相对姿态解算单元;

9、所述自适应姿态估计单元,用于基于所述母imu数据以及多个所述子imu数据,确定当前运动状态,自适应的调整姿态估计参数,结合航向误差,得到母节点绝对姿态以及多个子节点绝对姿态;

10、所述地磁场数据处理单元,用于通过对所述地磁场数据进行异步降频采样,并根据磁场质量选择性地进行倾角补偿,得到所述航向误差,输入至所述自适应姿态估计单元;

11、所述相对姿态解算单元,用于基于所述母节点绝对姿态以及多个子节点绝对姿态,进行相对姿态解算,输出多个相对关节姿态。

12、根据本发明提供的一种多节点穿戴式关节姿态测量系统,所述自适应姿态估计单元,包括:第一计算子单元、判定子单元、配置子单元以及绝对姿态输出子单元;

13、所述第一计算子单元,用于分别计算当前母imu数据以及各所述子imu数据的三轴角速度模长、加速度模长偏差以及加速度短时变化量,得到多个对应的计算结果;

14、所述判定子单元,用于将多个所述对应的计算结果与对应的预设阈值进行比较,判定当前各节点所处的实时运动状态为静止、轻微运动或剧烈运动中的一种;

15、所述配置子单元,用于为不同运动状态配置不同的姿态估计参数;所述姿态估计参数通过离线标定样本回放预先确定;

16、所述绝对姿态输出子单元,用于利用配置后的所述姿态估计参数,通过姿态估计算法输出所述母节点绝对姿态以及多个所述子节点绝对姿态;

17、其中,所述姿态估计参数,包括比例增益kp、积分增益ki、加速度观测权重、磁场观测权重、滤波时间常数或观测噪声参数中的至少一种。

18、根据本发明提供的一种多节点穿戴式关节姿态测量系统,所述为不同运动状态配置不同的姿态估计参数,具体包括:

19、当所述实时运动状态为静止状态时,提高所述加速度观测权重;

20、当所述实时运动状态为轻微运动状态时,采用介于静止与剧烈运动状态之间的所述加速度观测权重;

21、当所述实时运动状态为剧烈运动状态时,降低所述加速度观测权重;

22、在不同运动状态之间,通过引入连续衰减系数对所述加速度观测权重进行平滑修正。

23、根据本发明提供的一种多节点穿戴式关节姿态测量系统,所述相对姿态解算单元,包括:

24、第二计算子单元,用于基于所述母节点绝对姿态与多个所述子节点绝对姿态,通过求逆与复合运算,得到多个所述子节点相对于母节点的原始相对姿态;

25、零位基线处理子单元,用于获取零位基线姿态,所述零位基线姿态用于表征标准零位姿态下,所述子节点相对于所述母节点的原始相对姿态;

26、解耦子单元,用于通过对所述原始相对姿态施加所述零位基线姿态的逆变换解耦,得到多个相对关节姿态。

27、根据本发明提供的一种多节点穿戴式关节姿态测量系统,所述航向误差,通过对所述地磁场数据进行异步降频采样,并根据磁场质量选择性地进行倾角补偿得到,具体包括:

28、所述地磁场数据以低于姿态解算频率的频率进行异步更新;

29、基于更新后的所述地磁场数据,进行磁场质量计算;

30、若所述磁场质量满足预设质量阈值,则利用当前子imu数据中的横滚角和俯仰角对所述地磁场数据进行倾角补偿,得到所述航向误差;

31、若所述磁场质量不满足预设质量阈值,则所述磁力计被禁用或降低权重;

32、其中,磁场质量包括以下一项或多项:磁场模长、方向突变或有效性判断。

33、根据本发明提供的一种多节点穿戴式关节姿态测量系统,所述母节点还包括,直接存储器访问dma控制器和/或fifo缓冲区。

34、根据本发明提供的一种多节点穿戴式关节姿态测量系统,所述相对姿态解算单元,还包括:轻量化输出子单元;

35、所述轻量化输出子单元,用于将所述多个相对关节姿态转换为包含关节角度信息、节点标识及校验信息的轻量化数据帧并输出。

36、根据本发明提供的一种多节点穿戴式关节姿态测量系统,所述母节点和多个所述子节点,通过关节拓扑配置表,复用于不同的人体关节。

37、根据本发明提供的一种多节点穿戴式关节姿态测量系统,所述共享通信总线为spi总线,所述母节点通过所述spi总线连接各所述子节点,每一所述子节点配置独立片选信号;

38、所述母节点按照预设顺序依次读取各所述子节点的子imu数据,并为每个所述子imu数据附加采样序号或时间戳。

39、本发明还提供一种多节点穿戴式关节姿态测量方法,基于上述任一所述的多节点穿戴式关节姿态测量系统实现,包括:

40、获取母节点的母imu数据、多个子节点的子imu数据以及地磁场数据;

41、基于所述母imu数据以及多个所述子imu数据,确定当前运动状态,自适应的调整姿态估计参数,结合航向误差,得到母节点绝对姿态以及多个子节点绝对姿态;其中,所述航向误差,通过对所述地磁场数据进行异步降频采样,并根据磁场质量选择性地进行倾角补偿后得到;

42、基于所述母节点绝对姿态以及多个子节点绝对姿态,进行相对姿态解算,输出多个相对关节姿态。

43、本发明还提供一种计算机可读存储介质,其上存储有计算机程序,该计算机程序被处理器执行时实现如上述任一种所述多节点穿戴式关节姿态测量方法。

44、本发明还提供一种计算机程序产品,包括计算机程序,所述计算机程序被处理器执行时实现如上述任一种所述多节点穿戴式关节姿态测量方法。

45、与现有技术相比,本发明的有益效果是:

46、(1)本发明通过母节点统一管理多个子节点,并在同一采样周期内完成多节点有序访问,可降低多节点之间的采样时间偏斜,从而从根本上消除因时间错位引发的动态几何误差,提升了测量精度。

47、(2)本发明根据实时运动状态,自适应调整姿态估计参数,使设备在静止时能够较快收敛,在剧烈运动时降低非重力加速度对姿态解算的误注入,从而提升动态抗干扰能力,以及姿态解算的鲁棒性与精度。

48、(3)本发明在边缘端采用母子节点相对姿态解耦与零位基线扣除机制,将人体整体空间朝向变化、节点初始安装偏差与目标关节相对运动进行分离,从而避免了直接对多个绝对欧拉角相减所带来的旋转顺序误差与安装误差叠加,显著提升了关节相对姿态的解耦精度与稳定性。

49、(4)本发明通过异步磁力计质量判定与低权重航向补偿,降低磁场干扰对偏航角的瞬态影响。