CN107806837A - 一种非侵入式腕关节轴线运动模型测量方法 - Google Patents
一种非侵入式腕关节轴线运动模型测量方法 Download PDFInfo
- Publication number
- CN107806837A CN107806837A CN201711032354.4A CN201711032354A CN107806837A CN 107806837 A CN107806837 A CN 107806837A CN 201711032354 A CN201711032354 A CN 201711032354A CN 107806837 A CN107806837 A CN 107806837A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- forearm
- hand
- axis
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 210000003857 wrist joint Anatomy 0.000 title claims abstract description 72
- 230000033001 locomotion Effects 0.000 title claims abstract description 37
- 238000000034 method Methods 0.000 title claims abstract description 29
- 210000000245 forearm Anatomy 0.000 claims abstract description 59
- 239000013598 vector Substances 0.000 claims abstract description 12
- 238000005457 optimization Methods 0.000 claims abstract description 6
- QBWCMBCROVPCKQ-UHFFFAOYSA-N chlorous acid Chemical compound OCl=O QBWCMBCROVPCKQ-UHFFFAOYSA-N 0.000 claims description 14
- 210000000707 wrist Anatomy 0.000 claims description 7
- 239000011159 matrix material Substances 0.000 claims description 6
- 238000005452 bending Methods 0.000 claims description 5
- 230000002068 genetic effect Effects 0.000 claims description 5
- 210000000236 metacarpal bone Anatomy 0.000 claims description 4
- 230000001052 transient effect Effects 0.000 claims description 3
- 241001269238 Data Species 0.000 claims description 2
- 210000004247 hand Anatomy 0.000 claims description 2
- 238000003780 insertion Methods 0.000 claims 1
- 230000037431 insertion Effects 0.000 claims 1
- 208000034657 Convalescence Diseases 0.000 abstract description 2
- 238000013461 design Methods 0.000 abstract description 2
- 238000005259 measurement Methods 0.000 description 15
- 238000010586 diagram Methods 0.000 description 4
- 238000012545 processing Methods 0.000 description 3
- 230000036651 mood Effects 0.000 description 2
- 208000027418 Wounds and injury Diseases 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 210000000988 bone and bone Anatomy 0.000 description 1
- 230000006378 damage Effects 0.000 description 1
- 238000013480 data collection Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000004925 denaturation Methods 0.000 description 1
- 230000036425 denaturation Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 210000003414 extremity Anatomy 0.000 description 1
- 208000014674 injury Diseases 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000003786 synthesis reaction Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/24—Measuring arrangements characterised by the use of optical techniques for measuring contours or curvatures
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Measurement Of The Respiration, Hearing Ability, Form, And Blood Characteristics Of Living Organisms (AREA)
Abstract
本发明公开了一种非侵入式腕关节轴线运动模型测量方法,属于人机工程和测量技术领域。本发明包括以下三个步骤:(1)采集腕关节的运动数据:前臂及手臂各绑缚一个法兰,每个法兰上贴放四个标记点,为了防止标记点之间互相干涉,前臂与手部的法兰尽量远离腕关节,其中前臂的法兰固定在升降台上。(2)建立腕关节轴线运动模型:将前臂及手部视为刚体,建立2自由度的空间连杆机构;(3)腕关节运动轴线位姿求解:通过采集到的腕关节运动数据,构建空间矢量闭环方程,进而用matlab优化工具箱优化出腕关节的轴线运动模型的参数。利用该方法可以较为准确的得到某一时刻下腕关节运动的轴线位姿,为假肢设计及腕关节康复装置的设计提供了理论依据。
Description
技术领域
本发明涉及人体工程和测量领域,尤其涉及一种非侵入式腕关节 轴线运动模型测量方法。
背景技术
在人体工程和测量学领域中,腕关节轴线运动的模型至关重要, 经查阅文献发现腕关节模型为倾斜不相交的两根轴线,即腕关节屈伸 与收展轴线之间存在一定的夹角和距离。腕关节模型的建立,一方面 可以为假肢以及腕关节的康复装置提供设计的理论依据,另一方面也 可以作为输入数评估人体腕关节进行功能性评估。目前腕关节的测量 方法分为侵入式和非侵入式。侵入式测量常见于将标记点直接作用于 骨骼上,由于对人体伤害较大,故一般较少采纳。非侵入式测量则采 用将标记点贴放在人体皮肤表面进行测量,因此非侵入式测量一定程 度上减少了对人体的伤害,但是非侵入式测量受皮肤运动的影响较 大。
经对比现有技术文献发现,目前针对非侵入式腕关节的测量存在 以下问题:(1)将腕关节视为轴线垂直相交的胡克副,如专利CN 1748642A中关于非侵入式测量人体手臂关节的测量方法;(2)在测 量的过程中忽略了皮肤运动给测量带来的影响;本发明不仅可以较为 精确的测量出腕关节运动轴线的模型,而且测量过程中很大程度上减 少了皮肤运动带来的干扰。
发明内容
本发明的目的在于综合现有腕关节测量的不足提供了一种非侵 入式腕关节轴线运动模型测量方法,使用该方法可以得到较为精确的 腕关节轴线运动模型,该方法容易实现,且有效的避免了皮肤运动带 来的测量误差。
为了实现上述目的,本发明采用的技术方案是:
一种非侵入式腕关节轴线运动模型测量方法,包括:腕关节运动 数据的采集、腕关节轴线模型的建立、腕关节轴线运动模型的求解。
第一、腕关节运动数据的采集:将贴有4个标记点的手部法兰(2) 与手部绑缚,手部与手部法兰(2)之间加上弹性垫,将贴有4个标 记点的前臂法兰(1)将前臂固定到升降台上,前臂与前臂法兰(1) 之间加上弹性垫。通过前臂法兰(1)上的4个标记点建立前臂局部坐标系O1(9),通过手部法兰(2)上的4个标记点建立手部局部坐 标系O2(10),本方法通过vicon***捕捉***获得8个标志点的位 置坐标。每个标志点的数据就是在固定坐标系O(11)下的坐标。
第二、腕关节运动模型的建立:腕关节为一广义的两自由度关节, 即腕关节运动的屈/伸轴线(FE)、收/展轴线(RUD)在空间内是不 断变化的,且屈/伸轴线(FE)、收/展轴线(RUD)大致位于头状骨 附近,为求解腕关节运动轴线位姿,将腕关节模型建为轴线倾斜不相 交的两根轴线,将前臂以及手部视为刚体,最终建立一个两自由度的 参数化的空间连杆机构;
第三、腕关节轴线位姿求解:根据刚体运动时刚体上的标记点相 对刚体的运动不变性,通过vicon光学运动捕捉***将前臂以及手部 的标记点运动时的坐标数据采集下来,通过构建空间矢量闭环建立约 束方程,利用matlab中的遗传算法优化工具箱去辨识腕关节模型的 相关参数。
以下对上述每一步做具体描述。
1)数据测量
测试者的前臂通过前臂法兰(1)固定到升降台(13)上,前臂 与前臂法兰(1)之间设有弹性垫,测试者手部通过手部法兰(2)固 定,手部与手部法兰(2)之间同样添加弹性垫。为了让vicon光学 运动捕捉***更精确的采集到标志点,避免丢点的情况出现,前臂法兰(1)与手部法兰(2)尽量远离腕关节。
在实验过程中,屈伸采集运动数据时,约束导轨(3)平面和引 导棒(4)与人体手部的第三掌骨重合,拧紧紧固螺钉(5)后,手腕 由屈向伸运动,往复三个周期。收展采集数据时,将约束导轨(3) 翻转90°通过滑块***支撑架(12),约束导轨(3)平面与第三掌骨 平齐,拧紧紧固螺钉(5)后,手腕由内收向外展运动,往复三个周 期。
利用vicon光学运动捕捉***能够精确的采集到前臂四个标记点 (6)以及手部四个标记点(7)的位置。这些位置数据都是在固定坐 标系O(11)下描述的,固定坐标系O(11)是由vicon***决定的。 如图3所示,前臂四个标记点(6)确定前臂局部坐标系O1(9),手 部四个标记点(7)确定手部局部坐标系O2(10)。
将8个标记点记为Pi,每个标记点的位置为(xi yi zi),i表示标 记点的序号,i=1,2,···,8,固定坐标系O(11)的x、y、z轴分别用Ox、 Oy、Oz表示,前臂局部坐标系O1(9)的原点为O1,x、y、z轴分别 用O1x、O1y、O1z表示,其中:
式中P1表示前臂第一标记点的位置坐标,P2表示前臂第二标记点 的位置坐标,P3表示前臂第三标记点的位置坐标,P4表示前臂第四标 记点的位置坐标。
手部局部坐标系O2(10)的原点为O2,x、y、z轴分别用O2x、O2y、 O2z表示,其中:
式中P5表示手部第一标记点的位置坐标,P6表示手部第二标记点 的位置坐标,P7表示手部第三标记点的位置坐标,P8表示手部第四标 记点的位置坐标。
前臂局部参考系O1(9)相对固定坐标系O(11)的旋转矩阵表示为:
手部局部参考系O2(10)相对固定坐标系O(11)的旋转矩阵表示为:
2)腕关节模型的建立:
将人体的腕关节模型建为轴线倾斜不相交的两根轴线,两根轴线 之间的夹角为α,距离为d。将前臂以及手部视为刚体,建立一个两 自由度的参数化的空间连杆机构,定义(m1,l1)为屈/伸轴线(FE)相对 前臂参考坐标系O1(9)的位姿,(m2l2)为收/展轴线(RUD)相对手 部参考坐标系O2(10)的位姿。屈/伸轴线(FE)的方向用l1(1a1b1)表 示,收/展轴线(RUD)的方向用l2(a2b21)表示,两根轴线与公垂线之 间的交点记为m1(m1x m1y m1z)和m2(m2x m2ym2z)。得到屈/伸轴线相对固定 坐标系O(11)的位姿为:
收/展轴线(RUD)相对于固定坐标系O(11)的位姿为:
3)腕关节运动轴线位姿求解
通过vicon运动捕捉***采集到的数据仅仅是标志点的坐标值, 因此还需要做数据处理。在腕关节运动的过程中屈伸与收展的轴线位 姿是瞬时变化的,为获取t时刻屈伸与收展轴线之间的位姿关系,利 用构建空间封闭矢量环作为约束方程来求解轴线的位姿。
如图4所示,各个矢量存在以下关系:
所有矢量必须在固定坐标系O(11)下运算,由于存在误差e,故 根据式(7)得:
将一个周期T内屈伸以及收展的数据带入,利用matlab优化工具 箱中的遗传算法去辨识腕关节模型的相关参数,使得δ的值最小。
最后,需要辨识的参数为l1(1 a1 b1)、l2(a2 b2 1)、m1(m1x m1y m1z)、 m2(m2x m2ym2z)、d,将最终得到的结果带入式(5)、式(6)中便得 到某一时刻t下,腕关节屈/伸以及收/展轴线的位姿在固定坐标系O (11)下的数值,求得屈/伸(FE)和收/展轴线(RUD)之间的距离 和夹角。
与现有技术相比,本发明具有如下有益效果。
1、该方法将腕关节模型建为倾斜不相交的两根轴线,通过数据 处理得到了较为精确的腕关节运动模型;
2、现有的腕关节方法,没有充分考虑在测量过程中皮肤运动带 来的误差,本方法充分考虑皮肤运动带来的影响,利用将标记点贴放 到法兰上,再通过弹性垫将法兰固定到人体的手部以及前臂,从而有 效的解决了腕关节测量过程中皮肤带来的误差问题;
3、实践表明,该方法能够有效辨识腕关节运动模型参数,方法 较为简单,是一种有效地非侵入式腕关节轴线运动模型测量方法。
附图说明
图1是腕关节运动检测示意图。
图2是腕关节轴线运动模型示意图。
图3是坐标系建立示意图。
图4是腕关节轴线位姿计算示意图。
图1-图4中:1-前臂法兰,2-手部法兰,3-约束导轨,4-引导棒, 5-紧固螺钉,6-前臂标记点,7-手部标记点,8-滑块,9-前臂参考系, 10-手部参考系,11-固定坐标系,12-支撑架,13-升降台,FE-屈/伸轴 线,RUD-收/展轴线。
具体实施方式
实施例
本发明具体步骤如下:
1、数据测量
如图1所示,在测试者的手部及前臂贴放8个标记点,通过vicon 光学运动捕捉***采集8个标记点的位置。以屈伸运动为例,在实验 过程中,采集屈/伸运动数据时,手腕由屈向伸运动,往复三个周期。
在t时刻下,8个标记点的位置为:
P1(235.6984 219.5886 960.4167),P2(236.211 295.7337 957.716),
P3(194.9982 258.908 957.5391),P4(273.4254 256.3104 959.5434),
P5(180.4009 409.6366 942.4073),P6(233.7286 467.6213 947.0558),
P7(235.792 412.195 946.8046),P8(178.0265 466.1292 942.5173)。
由(1)式得前臂局部坐标系O1(9)的原点:
O1(235.0832 257.6352 958.8038),x、y、z轴为:O1x(0.9991,-0.0331,0.0255) O1y(0.0340 0.9988 -0.0348)、O1z(-0.0244 0.0356 0.9991)。
手部局部坐标系O2(10)的原点为O2(206.9870 438.8955 944.6963), x、y、z轴为:O2x(-0.7299 0.6815 -0.0542)、O2y(0.6789 0.7318 0.0591)、 O2z(0.0799 0.0064 -0.9968)。
前臂局部参考系O1(9)相对固定坐标系O(11)的旋转矩阵表示为:
手部局部参考系O2(10)相对固定坐标系O(11)的旋转矩阵表示为:
2、腕关节模型的建立:
如图2所示,将人体的腕关节模型建为轴线倾斜不相交的两根轴 线,两根轴线之间的夹角为α,距离为d。将前臂以及手部视为刚体, 建立一个两自由度的参数化的空间连杆机构,定义(l1 m1)为屈/伸轴线 (FE)相对前臂参考坐标系O1(9)的位姿,(l2 m2)为收/展轴线(RUD) 相对手部参考坐标系O2(10)的位姿。屈/伸轴线(9)的方向用l1(1 a1 b1) 表示,收/展轴线(RUD)的方向用l2(a2 b2 1)表示,两根轴线与公垂线 之间的交点记为m1(m1x m1ym1z)和m2(m2x m2y m2z)。通过式(5)、式(6) 可得屈/伸轴线(FE)相对固定坐标系O的位姿收/展轴线 (RUD)相对于固定坐标系O(11)的位姿
通过vicon运动捕捉***采集到的数据仅仅是标志点的坐标值, 因此还需要做数据处理。在腕关节运动的过程中屈伸与收展的轴线位 姿是瞬时变化的,为获取t时刻屈伸与收展轴线之间的位姿关系,利 用构建空间封闭矢量环作为约束方程来求解轴线的位姿。
如图4所示,图中各个矢量存在以下关系:
所有矢量必须在固定坐标系O(11)下运算,由于存在误差e,故 根据上式得:
将一个周期T内屈伸以及收展的数据带入,利用matlab工具箱中 的遗传算法去辨识腕关节模型的相关参数,使得δ的值最小。
最后,辨识的参数结果m1(-14.78115029 116.0295361 -56.52210627)、 m2(-54.16107293 -35.84456843 58.06368374)
l1(1 -53.30903462 14.976680811)l2(-68.5783805 40.92556321)、 d=7.436956691,将辨识结果带入(5)、(6)式中,便可求得腕关节 屈/伸轴线(FE)以及收/展轴线(RUD)的位姿在固定坐标系O(11) 的数值,求得屈/伸轴线(FE)以及收/展轴线(RUD)的距离为 7.436956691mm和夹角为83.2312°。
Claims (4)
1.一种非侵入式腕关节轴线运动模型测量方法,其特征在于:该方法包括腕关节运动数据的采集、腕关节轴线模型的建立、腕关节轴线运动模型的求解;
第一、腕关节运动数据的采集:将贴有4个标记点的手部法兰(2)与手部绑缚,手部与手部法兰(2)之间加上弹性垫,将贴有4个标记点的前臂法兰(1)将前臂固定到升降台上,前臂与前臂法兰(1)之间加上弹性垫;通过前臂法兰(1)上的4个标记点建立前臂局部坐标系O1(9),通过手部法兰(2)上的4个标记点建立手部局部坐标系O2(10),本方法通过vicon***捕捉***获得8个标志点的位置坐标;每个标志点的数据就是在固定坐标系O(11)下的坐标;
第二、腕关节运动模型的建立:腕关节为一广义的两自由度关节,即腕关节运动的屈/伸轴线、收/展轴线在空间内是不断变化的,且屈/伸轴线、收/展轴线大致位于头状骨附近,为求解腕关节运动轴线位姿,将腕关节模型建为轴线倾斜不相交的两根轴线,将前臂以及手部视为刚体,最终建立一个两自由度的参数化的空间连杆机构;
第三、腕关节轴线位姿求解:根据刚体运动时刚体上的标记点相对刚体的运动不变性,通过vicon光学运动捕捉***将前臂以及手部的标记点运动时的坐标数据采集下来,通过构建空间矢量闭环建立约束方程,利用matlab中的遗传算法优化工具箱去辨识腕关节模型的相关参数。
2.根据权利要求1所述的一种非侵入式腕关节轴线运动模型测量方法,其特征在于:测试者的前臂通过前臂法兰(1)固定到升降台(13)上,前臂与前臂法兰(1)之间设有弹性垫,测试者手部通过手部法兰(2)固定,手部与手部法兰(2)之间同样添加弹性垫;为了让vicon光学运动捕捉***更精确的采集到标志点,避免丢点的情况出现,前臂法兰(1)与手部法兰(2)远离腕关节;
在实验过程中,屈伸采集运动数据时,约束导轨(3)平面和引导棒(4)与人体手部的第三掌骨重合,拧紧紧固螺钉(5)后,手腕由屈向伸运动,往复三个周期;收展采集数据时,将约束导轨(3)翻转90°通过滑块***支撑架(12),约束导轨(3)平面与第三掌骨平齐,拧紧紧固螺钉(5)后,手腕由内收向外展运动,往复三个周期;
利用vicon光学运动捕捉***能够精确的采集到前臂四个标记点(6)以及手部四个标记点(7)的位置;这些位置数据都是在固定坐标系O(11)下描述的,固定坐标系O(11)是由vicon***决定的;前臂四个标记点(6)确定前臂局部坐标系O1(9),手部四个标记点(7)确定手部局部坐标系O2(10);
将8个标记点记为Pi,每个标记点的位置为(xi yi zi),i表示标记点的序号,i=1,2,…,8,固定坐标系O(11)的x、y、z轴分别用Ox、Oy、Oz表示,前臂局部坐标系O1(9)的原点为O1,x、y、z轴分别用O1x、O1y、O1z表示,其中:
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>O</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>P</mi>
<mn>1</mn>
</msub>
<mi>+</mi>
<msub>
<mi>P</mi>
<mi>2</mi>
</msub>
<mi>+</mi>
<msub>
<mi>P</mi>
<mi>3</mi>
</msub>
<mi>+</mi>
<msub>
<mi>P</mi>
<mi>4</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>/4</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>O</mi>
<mrow>
<mn>1</mn>
<mi>x</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>P</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>P</mi>
<mn>3</mn>
</msub>
</mrow>
<mrow>
<mo>|</mo>
<mrow>
<msub>
<mi>P</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>P</mi>
<mn>3</mn>
</msub>
</mrow>
<mo>|</mo>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>O</mi>
<mrow>
<mn>1</mn>
<mi>y</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>O</mi>
<mrow>
<mn>1</mn>
<mi>x</mi>
</mrow>
</msub>
<mo>&times;</mo>
<msub>
<mi>O</mi>
<mrow>
<mn>1</mn>
<mi>z</mi>
</mrow>
</msub>
</mrow>
<mrow>
<mo>|</mo>
<mrow>
<msub>
<mi>O</mi>
<mrow>
<mn>1</mn>
<mi>x</mi>
</mrow>
</msub>
<mo>&times;</mo>
<msub>
<mi>O</mi>
<mrow>
<mn>1</mn>
<mi>z</mi>
</mrow>
</msub>
</mrow>
<mo>|</mo>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>O</mi>
<mrow>
<mn>1</mn>
<mi>z</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>P</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>P</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
<mo>&times;</mo>
<mo>(</mo>
<msub>
<mi>P</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>P</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
</mrow>
<mrow>
<mo>|</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>P</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>P</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>&times;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>P</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>P</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>|</mo>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
式中P1表示前臂第一标记点的位置坐标,P2表示前臂第二标记点的位置坐标,P3表示前臂第三标记点的位置坐标,P4表示前臂第四标记点的位置坐标;
手部局部坐标系O2(10)的原点为O2,x、y、z轴分别用O2x、O2y、O2z表示,其中:
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>O</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>P</mi>
<mn>5</mn>
</msub>
<mo>+</mo>
<msub>
<mi>P</mi>
<mn>6</mn>
</msub>
<mo>+</mo>
<msub>
<mi>P</mi>
<mn>7</mn>
</msub>
<mo>+</mo>
<msub>
<mi>P</mi>
<mn>8</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>/</mo>
<mn>4</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>O</mi>
<mrow>
<mn>2</mn>
<mi>x</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>P</mi>
<mn>6</mn>
</msub>
<mo>-</mo>
<msub>
<mi>P</mi>
<mn>5</mn>
</msub>
</mrow>
<mrow>
<mo>|</mo>
<mrow>
<msub>
<mi>P</mi>
<mn>6</mn>
</msub>
<mo>-</mo>
<msub>
<mi>P</mi>
<mn>5</mn>
</msub>
</mrow>
<mo>|</mo>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>O</mi>
<mrow>
<mn>2</mn>
<mi>y</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>O</mi>
<mrow>
<mn>2</mn>
<mi>x</mi>
</mrow>
</msub>
<mo>&times;</mo>
<msub>
<mi>O</mi>
<mrow>
<mn>2</mn>
<mi>z</mi>
</mrow>
</msub>
</mrow>
<mrow>
<mo>|</mo>
<mrow>
<msub>
<mi>O</mi>
<mrow>
<mn>2</mn>
<mi>x</mi>
</mrow>
</msub>
<mo>&times;</mo>
<msub>
<mi>O</mi>
<mrow>
<mn>2</mn>
<mi>z</mi>
</mrow>
</msub>
</mrow>
<mo>|</mo>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>O</mi>
<mrow>
<mn>2</mn>
<mi>z</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>P</mi>
<mn>6</mn>
</msub>
<mo>-</mo>
<msub>
<mi>P</mi>
<mn>5</mn>
</msub>
<mo>)</mo>
<mo>&times;</mo>
<mo>(</mo>
<msub>
<mi>P</mi>
<mn>8</mn>
</msub>
<mo>-</mo>
<msub>
<mi>P</mi>
<mn>7</mn>
</msub>
<mo>)</mo>
</mrow>
<mrow>
<mo>|</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>P</mi>
<mn>6</mn>
</msub>
<mo>-</mo>
<msub>
<mi>P</mi>
<mn>5</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>&times;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>P</mi>
<mn>8</mn>
</msub>
<mo>-</mo>
<msub>
<mi>P</mi>
<mn>7</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>|</mo>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
式中P5表示手部第一标记点的位置坐标,P6表示手部第二标记点的位置坐标,P7表示手部第三标记点的位置坐标,P8表示手部第四标记点的位置坐标;
前臂局部参考系O1(9)相对固定坐标系O(11)的旋转矩阵表示为:
手部局部参考系O2(10)相对固定坐标系O(11)的旋转矩阵表示为:
3.根据权利要求1所述的一种非侵入式腕关节轴线运动模型测量方法,其特征在于:将人体的腕关节模型建为轴线倾斜不相交的两根轴线,两根轴线之间的夹角为α,距离为d;将前臂以及手部视为刚体,建立一个两自由度的参数化的空间连杆机构,定义(m1,l1)为屈/伸轴线(FE)相对前臂参考坐标系O1(9)的位姿,(m2 l2)为收/展轴线(RUD)相对手部参考坐标系O2(10)的位姿;屈/伸轴线(FE)的方向用l1(1 a1 b1)表示,收/展轴线(RUD)的方向用l2(a2b2 1)表示,两根轴线与公垂线之间的交点记为m1(m1x m1y m1z)和m2(m2x m2y m2z);得到屈/伸轴线相对固定坐标系O(11)的位姿为:
收/展轴线(RUD)相对于固定坐标系O(11)的位姿为:
4.根据权利要求1所述的一种非侵入式腕关节轴线运动模型测量方法,其特征在于:腕关节运动轴线位姿求解
通过vicon运动捕捉***采集到的数据仅仅是标志点的坐标值,因此还需要做数据处理;在腕关节运动的过程中屈伸与收展的轴线位姿是瞬时变化的,为获取t时刻屈伸与收展轴线之间的位姿关系,利用构建空间封闭矢量环作为约束方程来求解轴线的位姿;
各个矢量存在以下关系:
<mrow>
<mover>
<mrow>
<msub>
<mi>OO</mi>
<mn>2</mn>
</msub>
</mrow>
<mo>&RightArrow;</mo>
</mover>
<mo>-</mo>
<mover>
<mrow>
<msub>
<mi>OO</mi>
<mn>1</mn>
</msub>
</mrow>
<mo>&RightArrow;</mo>
</mover>
<mo>=</mo>
<mover>
<mrow>
<msub>
<mi>O</mi>
<mn>1</mn>
</msub>
<msub>
<mi>m</mi>
<mn>1</mn>
</msub>
</mrow>
<mo>&RightArrow;</mo>
</mover>
<mo>+</mo>
<mover>
<mrow>
<msub>
<mi>m</mi>
<mn>1</mn>
</msub>
<msub>
<mi>m</mi>
<mn>2</mn>
</msub>
</mrow>
<mo>&RightArrow;</mo>
</mover>
<mo>+</mo>
<mover>
<mrow>
<msub>
<mi>m</mi>
<mn>2</mn>
</msub>
<msub>
<mi>O</mi>
<mn>2</mn>
</msub>
</mrow>
<mo>&RightArrow;</mo>
</mover>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
所有矢量必须在固定坐标系O(11)下运算,由于存在误差e,故根据式(7)得:
将一个周期T内屈伸以及收展的数据带入,利用matlab优化工具箱中的遗传算法去辨识腕关节模型的相关参数,使得δ的值最小;
<mrow>
<mi>&delta;</mi>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mi>T</mi>
</mfrac>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
<msubsup>
<mo>&Integral;</mo>
<mn>0</mn>
<mi>T</mi>
</msubsup>
<mi>e</mi>
<mi>d</mi>
<mi>t</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
最后,需要辨识的参数为l1(1 a1 b1)、l2(a2 b2 1)、m1(m1x m1y m1z)、m2(m2x m2y m2z)、d,将最终得到的结果带入式(5)、式(6)中便得到某一时刻t下,腕关节屈/伸以及收/展轴线的位姿在固定坐标系O(11)下的数值,求得屈/伸(FE)和收/展轴线(RUD)之间的距离和夹角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711032354.4A CN107806837B (zh) | 2017-10-29 | 2017-10-29 | 一种非侵入式腕关节轴线运动模型测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711032354.4A CN107806837B (zh) | 2017-10-29 | 2017-10-29 | 一种非侵入式腕关节轴线运动模型测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107806837A true CN107806837A (zh) | 2018-03-16 |
CN107806837B CN107806837B (zh) | 2020-03-13 |
Family
ID=61582530
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711032354.4A Expired - Fee Related CN107806837B (zh) | 2017-10-29 | 2017-10-29 | 一种非侵入式腕关节轴线运动模型测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107806837B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110132156A (zh) * | 2019-05-16 | 2019-08-16 | 大连理工大学 | 一种海缆径向变形非接触式测量设备 |
CN110544278A (zh) * | 2018-05-29 | 2019-12-06 | 杭州海康机器人技术有限公司 | 刚体运动捕捉方法及装置、agv位姿捕捉*** |
CN112883650A (zh) * | 2021-02-26 | 2021-06-01 | 深圳市瑞立视多媒体科技有限公司 | 一种基于遗传算法的刚体标记点优化方法、设备以及可读存储介质 |
CN114152218A (zh) * | 2021-11-05 | 2022-03-08 | 北京科技大学 | 一种冰雪护具活动范围测量装置 |
WO2022116411A1 (zh) * | 2020-12-02 | 2022-06-09 | 中国标准化研究院 | 一种人体功能性关节旋转中心检测与定位分析方法 |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1748642A (zh) * | 2005-10-13 | 2006-03-22 | 上海交通大学 | 非侵入式人体手臂关节的测量方法 |
CN101200068A (zh) * | 2006-12-11 | 2008-06-18 | Abb股份有限公司 | 机器人手腕 |
CN101582166A (zh) * | 2008-05-12 | 2009-11-18 | 皇家飞利浦电子股份有限公司 | 目标的跟踪***和方法 |
CN102087096A (zh) * | 2010-11-12 | 2011-06-08 | 浙江大学 | 一种基于激光跟踪测量的机器人工具坐标系自动标定装置及方法 |
CN102922521A (zh) * | 2012-08-07 | 2013-02-13 | 中国科学技术大学 | 一种基于立体视觉伺服的机械臂***及其实时校准方法 |
CN103150752A (zh) * | 2013-02-02 | 2013-06-12 | 浙江大学 | 一种基于关键标记点的人体姿态稀疏重建方法 |
US8498741B2 (en) * | 2009-09-22 | 2013-07-30 | Gm Global Technology Operations | Dexterous humanoid robotic wrist |
CN204618765U (zh) * | 2015-03-27 | 2015-09-09 | 厦门理工学院 | 上肢康复训练装置 |
CN105050515A (zh) * | 2013-03-18 | 2015-11-11 | 奥瑟菲克斯有限公司 | 用于腕部的铰接设备 |
CN105813568A (zh) * | 2013-12-17 | 2016-07-27 | 库卡罗伯特有限公司 | 具有调节器的x光装置 |
CN106726353A (zh) * | 2017-01-08 | 2017-05-31 | 北京工业大学 | 一种基于自适应的并联腕关节康复训练装置 |
CN107198639A (zh) * | 2017-05-12 | 2017-09-26 | 北京工业大学 | 一种用于上肢康复外骨骼机构的主被融合关节 |
JP2017170113A (ja) * | 2016-12-28 | 2017-09-28 | 株式会社バンダイ | 人形玩具の手首関節構造及び人形玩具 |
-
2017
- 2017-10-29 CN CN201711032354.4A patent/CN107806837B/zh not_active Expired - Fee Related
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1748642A (zh) * | 2005-10-13 | 2006-03-22 | 上海交通大学 | 非侵入式人体手臂关节的测量方法 |
CN101200068A (zh) * | 2006-12-11 | 2008-06-18 | Abb股份有限公司 | 机器人手腕 |
CN101582166A (zh) * | 2008-05-12 | 2009-11-18 | 皇家飞利浦电子股份有限公司 | 目标的跟踪***和方法 |
US8498741B2 (en) * | 2009-09-22 | 2013-07-30 | Gm Global Technology Operations | Dexterous humanoid robotic wrist |
CN102087096A (zh) * | 2010-11-12 | 2011-06-08 | 浙江大学 | 一种基于激光跟踪测量的机器人工具坐标系自动标定装置及方法 |
CN102922521A (zh) * | 2012-08-07 | 2013-02-13 | 中国科学技术大学 | 一种基于立体视觉伺服的机械臂***及其实时校准方法 |
CN103150752A (zh) * | 2013-02-02 | 2013-06-12 | 浙江大学 | 一种基于关键标记点的人体姿态稀疏重建方法 |
CN105050515A (zh) * | 2013-03-18 | 2015-11-11 | 奥瑟菲克斯有限公司 | 用于腕部的铰接设备 |
CN105813568A (zh) * | 2013-12-17 | 2016-07-27 | 库卡罗伯特有限公司 | 具有调节器的x光装置 |
CN204618765U (zh) * | 2015-03-27 | 2015-09-09 | 厦门理工学院 | 上肢康复训练装置 |
JP2017170113A (ja) * | 2016-12-28 | 2017-09-28 | 株式会社バンダイ | 人形玩具の手首関節構造及び人形玩具 |
CN106726353A (zh) * | 2017-01-08 | 2017-05-31 | 北京工业大学 | 一种基于自适应的并联腕关节康复训练装置 |
CN107198639A (zh) * | 2017-05-12 | 2017-09-26 | 北京工业大学 | 一种用于上肢康复外骨骼机构的主被融合关节 |
Non-Patent Citations (4)
Title |
---|
R.A. PROKOPENKO等: "Assessment of the accuracy of a human arm model with seven degrees of freedom", 《JOURNAL OF BIOMECHANICS》 * |
孙立宁等: "一种用于腕关节的球面三自由度并联解耦机构位置分析", 《中国机械工程》 * |
张浩等: "腕关节有限元骨性建模及力学分析", 《江苏大学学报(医学版)》 * |
张琪涣等: "基于被动连接关节的下肢康复外骨骼机构设计", 《工业技术创新》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110544278A (zh) * | 2018-05-29 | 2019-12-06 | 杭州海康机器人技术有限公司 | 刚体运动捕捉方法及装置、agv位姿捕捉*** |
CN110132156A (zh) * | 2019-05-16 | 2019-08-16 | 大连理工大学 | 一种海缆径向变形非接触式测量设备 |
CN110132156B (zh) * | 2019-05-16 | 2021-02-19 | 大连理工大学 | 一种海缆径向变形非接触式测量设备 |
WO2022116411A1 (zh) * | 2020-12-02 | 2022-06-09 | 中国标准化研究院 | 一种人体功能性关节旋转中心检测与定位分析方法 |
US11707209B2 (en) | 2020-12-02 | 2023-07-25 | China National Institute Of Standardization | Detecting method and positioning analysis method of human functional joint rotation center |
CN112883650A (zh) * | 2021-02-26 | 2021-06-01 | 深圳市瑞立视多媒体科技有限公司 | 一种基于遗传算法的刚体标记点优化方法、设备以及可读存储介质 |
CN112883650B (zh) * | 2021-02-26 | 2023-06-09 | 深圳市瑞立视多媒体科技有限公司 | 一种基于遗传算法的刚体标记点优化方法、设备以及可读存储介质 |
CN114152218A (zh) * | 2021-11-05 | 2022-03-08 | 北京科技大学 | 一种冰雪护具活动范围测量装置 |
CN114152218B (zh) * | 2021-11-05 | 2022-09-27 | 北京科技大学 | 一种冰雪护具活动范围测量装置 |
Also Published As
Publication number | Publication date |
---|---|
CN107806837B (zh) | 2020-03-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107806837A (zh) | 一种非侵入式腕关节轴线运动模型测量方法 | |
O'Brien et al. | Automatic joint parameter estimation from magnetic motion capture data | |
CN108030496B (zh) | 一种人体上肢肩部盂肱关节旋转中心与上臂抬升角耦合关系测量方法 | |
Lin et al. | Human pose recovery using wireless inertial measurement units | |
Plecnik et al. | Design of Stephenson linkages that guide a point along a specified trajectory | |
Vaughan et al. | Selection of body segment parameters by optimization methods | |
CN105832343B (zh) | 多维视觉手功能康复定量评估***和评估方法 | |
CN105945909A (zh) | 三自由度并联机器人的误差校正方法及*** | |
Hannan et al. | Real-time shape estimation for continuum robots using vision | |
CN107115114A (zh) | 人体运动能力评价方法、装置及*** | |
CN106344026A (zh) | 基于imu的便捷式人体关节参数估计方法 | |
Ude et al. | Automatic generation of kinematic models for the conversion of human motion capture data into humanoid robot motion | |
CN105559790B (zh) | 一种用于检测人体上肢肩关节旋转中心位置信息的穿戴外骨骼机构 | |
Bonnet et al. | Fast determination of the planar body segment inertial parameters using affordable sensors | |
CN101533578A (zh) | 一种仿人机器人模拟人体上肢潜意识动作姿态的方法 | |
Wouda et al. | On the validity of different motion capture technologies for the analysis of running | |
CN101533526B (zh) | 基于动态模板的光学运动捕捉数据处理方法 | |
Fang et al. | A real-time identification and tracking method for the musculoskeletal model of human arm | |
CN116197914A (zh) | 一种机器人上下料用轨迹规划方法 | |
CN108013880A (zh) | 一种人体肘关节前屈后伸绕瞬时动心运动的瞬时动心测量方法 | |
Kuryło et al. | Machine vision system measuring the trajectory of upper limb motion applying the matlab software | |
CN115919250A (zh) | 一种人体动态关节角测量*** | |
Ambrósio et al. | Spatial reconstruction of human motion by means of a single camera and a biomechanical model | |
WO2010082157A1 (en) | Method for determining the rotation axis of a joint and device for monitoring the movements of at least one body part | |
Demircan et al. | Human motion reconstruction and synthesis of human skills |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200313 |