一种基于MEMS传感器的人体肢体关节轴校准装置

一种基于mems传感器的人体肢体关节轴校准装置
技术领域
1.本发明涉及人体肢体关节轴校准领域，尤其涉及一种基于mems(micro
‑
electro
‑
mechanical system，微机电系统)传感器的人体肢体关节轴校准装置。


背景技术：

2.随着微电子技术的飞速发展，惯性测量单元(imu)由于其体积小、成本低、功耗低、无线传输不受环境限制等优势，已被广泛用于可穿戴人体运动分析中，通常利用imu对人体动作数据进行采集，然后对建立的人体运动学模型进行驱动，从而可对人体运动姿态进行近似追踪。因此，建立一个符合人体行为特征的三维关节连接模型，如图1所示，图(a)一种是运动链模型，该模型把人体各肢体部位假设成用铰链连接的刚体，每相邻两个部位之间的自由度根据人体关节的旋转自由度而定，通常情况下，运动链由多个刚体部分组成，通过1至3个自由度的关节连接，因此第一步确定根段的全局方向和位置是至关重要的，然后根据不同身体段相对根段的方向，可以得到各个不同身体段的全局方向和位置；图(b)是自由部位模型，此类方法假设传感器拥有很高的精度，能够单独估计每个身体部位的姿态，该模型通常用于在人体姿态估计时某些轴上的运动自由度存在限制时使用，该方法需要使用随机约束(如运动学约束)进行估计，且对关节连接不作限制，可以独立估计各个部位的姿态，建立人体肘关节和膝关节模型时，难以准确定位旋转轴的真实方向，因此选用自由部位模型进行建模更为合适。
3.然而在imu实际应用中常存在传感器坐标系与肢体坐标系不一致的情况，即将imu安装到人体肢体并使得imu局部坐标轴中的一个与关节轴精确地重合是非常困难，因此基于imu的人体运动分析的一个基本问题是imu的局部坐标轴与人体肢体轴不对齐，为解决imu放置位置与理想姿态不一致的情况，需建立人体关节轴校准装置，虽然可以近似将imu精确安装到朝向关节的预定关节轴上，或者通过手工测量关节轴的位置，最终可以将测量误差降低到几厘米左右，但是无法保证每次测量都能保证安装位置的一致性，而且使用多个传感器进行姿态测量时，imu的安放误差以及多个传感器之间的不对准误差都会严重影响到多传感器数据融合算法的有效性，因此初始时刻必须使用人体关节轴校准装置进行校准。常见的方法是通过校准姿势或校准运动来完成此操作，通常该方法被称为imu
‑
to
‑
segment(后简称i2s校准)。即在使用imu研究肢体运动过程中，身体通常被建模为一组已知长度的刚性节段，并且假设imu被刚性地安装在相关节段上，它们通过不同自由度的无摩擦关节连接在一起，因此需要将每个imu的方向和位置与身体的段进行校准。
4.i2s校准问题一般分为两类，一种是人工指定位置的静态校准，即规定受试者做几个简单的动作，比如n型姿势、t形姿势或者静止站立等，然后使用imu传感器此时收集的数据减去初始位置数据，以便建立传感器和身体段坐标系之间的关系，在此情况下，传感器坐标系和身体段坐标系之间的对准差异被认为是恒定的，这是大多数关于传感器到身体段校准研究中的经典假设，然而该方法的实验结果精度会受到对象可以执行姿势或运动精度的限制，因此任意运动校准方法(即功能性动态校准)的优势就体现出来了，即不再固定imu具
体的朝向、以及坐标轴的方位，而是建立一种关节轴校准装置，该装置可利用运动学约束(如铰链约束、球形约束，如图2所示)识别来自任意运动数据的位置姿态估计。
5.对于现实关节轴校准过程中，不免遇到关节两段肢体的运动幅度不一致的情况，如进行膝关节校准时，大腿一般相对静止，小腿做弯曲
‑
伸展动作，此时传统关节轴校准因代价函数最优解收敛性差等问题不再适用，因此在传统关节校准的基础上建立人体关节轴校准装置并进行代价函数优化，可有效提高校准的有效性和适应性。


技术实现要素：

6.本发明提供了一种基于mems传感器的人体肢体关节轴校准装置，该技术在人体运动关节连接类似于铰链关节的假设基础上，采用被试者完成一组动态动作的数据结合运动学约束方程实现传感器
‑
肢体的校准，同时通过结合角速度和传感器方位建立新的最小二乘代价函数，使校准更适用于现实关节轴校准情况，以提高关节轴动态校准精度和适用性，详见下文描述：
7.一种基于mems传感器的人体肢体关节轴校准装置，，所述装置包括：imu测量单元，
8.所述imu测量单元将人体运动关节作为铰链关节，建立人体关节约束条件，使用最小二乘估计寻找最优解的方法创建代价函数并实现局部关节轴的最优估计；
9.针对现实关节动态校准情况提出新的关节约束误差条件，并结合角速度和传感器方位建立新的最小二乘代价函数，获取最优解，使校准装置更适用于现实关节轴校准。
10.其中，所述装置采用被试者完成一组动态动作的数据结合运动学约束方程实现传感器
‑
肢体的校准。
11.进一步地，所述装置融合9轴惯性传感器数据进行关节轴估计。
12.进一步地，所述人体关节约束条件为：
13.基于动态关节校准得到两个关节轴向量j1、j2分别在某一固定坐标系下的投影应互相重合，即从自身坐标系s2下转到相对固定的坐标系下时，应满足和完全重合为，和为关节轴。
14.其中，所述使用最小二乘估计寻找最优解的方法创建代价函数并实现局部关节轴的最优估计为：
[0015][0016]
其中，c为代价函数，n为采样数，ω1、ω2分别为传感器imu1和imu2采集的角速度信息。
[0017]
所述新的关节约束误差条件记为与间的夹角：
[0018]
其中，所述最优解为：
[0019]
[0020]
其中，分别为传感器imu1和imu2在各自坐标系下关节轴信息，为传感器imu2相对imu1的相对姿态，为四元数的乘法。
[0021]
本发明提供的技术方案的有益效果是：
[0022]
1、本发明设计利用运动学约束(铰链约束)可从人体关节轴校准装置采集的运动数据中确定传感器到人体段方向的局部关节轴坐标位置，不依赖于评估者执行预定使用规范的限制，减少了由安装标定和校准引起的误差，可以大大提高后期人体姿态追踪结果的稳定性；
[0023]
2、本发明通过建立新的最小二乘代价函数改进了现有的关节轴校准中最优化估计，并融合9轴惯性传感器数据进行关节轴估计，适用于关节一端的肢体运动显著小于另一端的肢体运动幅度的现实关节动态校准情况，提高了人体关节运动校准中的实用性和准确性。
附图说明
[0024]
图1为两种不同的生物力学模型表示法示意图；
[0025]
其中，(a)为运动链模型；(b)为自由段模型。
[0026]
图2为两种关节约束类型示意图；
[0027]
其中，(a)为铰链关节约束；(b)为球形关节约束。
[0028]
图3为膝关节校准示意图；
[0029]
图4为将膝关节近似铰链关节并进行模型简化示意图；
[0030]
图5为下肢外骨骼铰链连接示意图；
[0031]
图6为使用两台笔记本电脑创建磁干扰环境示意图；
[0032]
图7为关节主轴j2与参考关节轴之间的夹角误差示意图。
具体实施方式
[0033]
为使本发明的目的、技术方案和优点更加清楚，下面对本发明实施方式作进一步地详细描述。
[0034]
实施例1
[0035]
本发明实施例设计了一种适用于现实关节轴校准情况的肢体关节轴校准装置，该装置使用微机电系统(mems,micro
‑
electro
‑
mechanical system)，即由加速度计、陀螺仪和磁力计组成的imu测量单元(inertial measurement unit,imus)和人体关节约束。通常情况当两个imu和铰链关节组成的人体关节轴校准装置连接到关节上时，即可用于计算铰链关节角度，在大多数机器人和机械应用中，imu可以以这样的方式安装，即局部坐标轴中的一个与铰链轴线重合，然而，人类肢体和大多数机器人的设置之间有一个非常重要的区别是，很难将imu正确连接到肢体上，并使其中一个局部坐标轴与人体关节轴完全一致，通常更倾向于将imu摆放在任意位置，因此处理任意传感器到肢体段安装是使用imu进行运动分析的主要挑战，手动测量以及校准姿势和运动通常是imu传感器到肢体段对齐的解决方案，imu在运动分析领域应用中的另一个主要挑战是关节校准的准确性取决于相连接的两段肢体的运动幅度。
[0036]
因此，本发明实施例提出一种结合特定动作下9轴imu方向信息的关节校准装置，
以适应现实关节轴校准情况。
[0037]
其技术流程是：首先假设人体运动关节为铰链关节并结合两个imu建立人体关节轴校准装置，该装置通过建立关节约束条件，使用最小二乘估计寻找最优解的方法，创建代价函数并实现局部关节轴的最优估计。随后针对一端肢体运动显著小于另一端的肢体运动幅度的现实关节动态校准情况，提出新的关节约束误差条件，并通过结合角速度和传感器方位建立新的最小二乘代价函数，使校准装置更适用于现实关节轴校准情况。
[0038]
实施例2
[0039]
下面结合图2
‑
图7、具体的计算公式，对实施例1中的方案进行进一步地介绍，详见下文描述：
[0040]
一、运动学约束
[0041]
使用关节轴动态校准装置的目的在于在更真实、更方便的安装方向环境下，可自动识别连接在肢体两端传感器的局部关节轴坐标，而无需精确的imu放置或精确的校准运动。关节轴动态校准假设人体肢体段通过铰链关节(如图2中(a)所示)，利用由这种类型关节引起的运动学约束，使用非线性最小二乘法进行关节轴估计。此方法的优势在于无需考虑imu的安装方向和位置，同时不受限于受试者执行预定姿势或动作准确性的影响，同时避免了使用惯性传感器估计人体运动姿态时传感器到身体段重合的假设。
[0042]
以膝关节关节轴校准装置为例进行原理阐述。基于运动链模型，本发明装置实施例假定大腿和小腿各自附着一个任意位置及方向的imu(分别为imu1和imu2)，如图3所示。在每个imu上分别定义固定在传感器三维中心处的笛卡尔坐标系(传感器坐标系s1和s2)，同时定义一个相对固定不变的惯性坐标系u。使用下标i∈{1,2}表示特定传感器。定义采集数据集s(i)＝{ω1(t),ω2(t)}，其中ω1(t)，为角速度值，代表ω
i
的三个坐标的取值范围都是任意实数。
[0043]
基于关节轴校准理论，将膝关节近似看成铰链关节并进行模型简化，如图4所示。理论上，ω1(t)和ω2(t)仅在关节角速度和(时变)旋转矩阵之间差异。因此，在大腿与小腿端传感器局部坐标系下，对于每个采样瞬间，ω1(t)和ω2(t)在各自关节平面的投影(关节轴和是法线向量的几何平面)中都具有相同的长度，此时关节约束必须满足：
[0044][0045]
其中，||
·
||2表示欧几里得范数。
[0046]
然而，以上关节约束(以上简称ta约束)关节校准的准确性取决于相连接的两段肢体的运动幅度。为使校准方法更适用于现实关节轴校准情况，本研究对关节约束进行进一步优化。理论上，基于动态关节校准得到两个关节轴向量j1、j2分别在某一固定坐标系下的投影应互相重合，即从自身坐标系s2下转到相对固定的坐标系下时，应满足和完全重合：
[0047][0048]
即无论传感器在身体段上的安装位置和方向如何，以上关节轴约束条件(1)、(2)在理想条件下都成立。
[0049]
二、关节轴动态校准优化模型
[0050]
用采集数据集s(i)，i∈{1,2}可自动识别参考坐标系下膝关节弯曲
‑
伸展轴j
u
分
别在各自传感器坐标系s1、s2下单位长度方向矢量和(二者一般为常数,仅取决于传感器相对关节的安装方向),从而将关节轴估计限制为单位长度。
[0051]
此时关节轴位置信息变为四维，为便于计算，将关节轴的位置坐标和以球坐标参数化，其中θ
i
和分别为imu1和imu2的倾角和方位角，即：
[0052][0053]
使用最小二乘估计寻找最优解的方法，可对ta约束创建代价函数(4)，进而实现局部关节轴的最优估计：
[0054][0055]
然而，以上ta约束代价函数并不适用于一端肢体运动显著小于另一端的肢体运动幅度的现实关节动态校准情况，如图4所示，可以看出实际关节轴与之间并不相互平行。
[0056]
因此提出新的关节约束误差条件e2：
[0057][0058]
其中，三维向量执行四元数乘法(6)可从传感器自身坐标系s2变换到s1坐标系下，即得到
[0059][0060]
传感器imu2相对imu1的相对姿态可由式(7)得出：
[0061][0062]
同样使用最小二乘估计寻找最优解的方法，可对以上两个关节约束误差条件共同创建新的代价函数(后简称为oa约束)，并求得关节轴坐标的最优解：
[0063][0064]
三、数据采集
[0065]
为验证该关节轴校准优化装置的有效性，开展了关节轴校准装置的机械仿真实验。使用附着在下肢外骨骼机器人不同身体段上的imu无线惯性传感器采集关节轴校准实验中大腿和小腿的运动传感数据。该九轴传感器包含三轴加速度计，三轴陀螺仪和三轴磁力计。其中，加速度计量程范围设置为
±
16g，陀螺仪量程范围为
±
500
°
/s，磁力计量程范围为
±
1ga，采样频率为51.2hz。
[0066]
如图5所示，分别将imu1和imu2组成的校准装置附着在下肢外骨骼机器人身体段
上，其中大腿和小腿通过铰链关节连接。
[0067]
为比较关节轴校准装置在不同实验环境影响下表现的差异性，使用2台笔记本电脑创造了磁干扰环境(如图6所示)。
[0068]
共设计了2组实验，分别是无磁干扰环境(non
‑
mag)和有磁干扰环境(mag)。下肢外骨骼机器人通过软件控制左、右膝关节以某一固定速度，反复执行弯曲
‑
伸展运动，每组实验时长1分钟。
[0069]
如图7所示，在下肢外骨骼机器人膝关节弯曲
‑
伸展运动过程中，关节主轴j2值应与传感器的z轴方向一致，因此参考关节轴设定为[0 0 1]
t
。为评估装置精度，本研究计算关节轴j2与参考关节轴之间的夹角作为估计的角度误差，t检验结果如表1所示。
[0070]
表1 oa和ta两种约束在无磁干扰、有磁干扰环境下关节轴估计误差与t检验结果
[0071][0072]
由表1可知，在无磁干扰环境下oa约束的角度误差(3.71
°±
1.96
°
)显著低于ta约束(6.19
°±
3.97
°
)。由于ta约束没有采用磁感向量数据，其算法受磁场环境小，在non
‑
mag和mag两种情况下算法角度的误差没有显著性差别。
[0073]
另一方面，在oa约束中采用了传感器的四元数位置信息对于约束进行了优化，其受磁干扰影响较ta约束大，但oa约束在磁干扰环境下的角度误差(4.65
°±
2.04
°
)，显著小于ta约束(6.46
°±
3.05
°
)。
[0074]
因此，本发明实施例提出的关节轴动态优化装置有效地提高了关节轴校准精度。
[0075]
本发明实施例提出了一种适用于现实关节轴校准情况的肢体关节轴校准装置。该发明首先假设人体运动关节为铰链关节，通过建立关节约束条件，使用最小二乘估计寻找最优解的方法，创建代价函数并实现局部关节轴的最优估计。随后针对一端肢体运动显著小于另一端的肢体运动幅度的现实关节动态校准情况，提出新的关节约束误差条件，并通过结合角速度和传感器方位建立新的最小二乘代价函数，使校准方法更适用于现实关节轴校准情况，可以应用在残疾人康复、生活、娱乐等领域，可以大大获得更好的社会和经济价值。
[0076]
本发明实施例对各器件的型号除做特殊说明的以外，其他器件的型号不做限制，只要能完成上述功能的器件均可。
[0077]
本领域技术人员可以理解附图只是一个优选实施例的示意图，上述本发明实施例序号仅仅为了描述，不代表实施例的优劣。
[0078]
以上所述仅为本发明的较佳实施例，并不用以限制本发明，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。