CN115227235A - 基于腕关节运动学模型的转动轴线动态偏移量测量方法 - Google Patents

基于腕关节运动学模型的转动轴线动态偏移量测量方法 Download PDF

Info

Publication number
CN115227235A
CN115227235A CN202210853331.4A CN202210853331A CN115227235A CN 115227235 A CN115227235 A CN 115227235A CN 202210853331 A CN202210853331 A CN 202210853331A CN 115227235 A CN115227235 A CN 115227235A
Authority
CN
China
Prior art keywords
coordinate system
wrist joint
forearm
origin
rotation 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
Application number
CN202210853331.4A
Other languages
English (en)
Other versions
CN115227235B (zh
Inventor
徐东
徐晗
张珝
李益斌
李晓龙
傅建明
顾旭东
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tongji Zhejiang College
Original Assignee
Tongji Zhejiang College
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Tongji Zhejiang College filed Critical Tongji Zhejiang College
Priority to CN202210853331.4A priority Critical patent/CN115227235B/zh
Publication of CN115227235A publication Critical patent/CN115227235A/zh
Application granted granted Critical
Publication of CN115227235B publication Critical patent/CN115227235B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B5/00—Measuring for diagnostic purposes; Identification of persons
    • A61B5/103—Detecting, measuring or recording devices for testing the shape, pattern, colour, size or movement of the body or parts thereof, for diagnostic purposes
    • A61B5/11—Measuring movement of the entire body or parts thereof, e.g. head or hand tremor, mobility of a limb
    • A61B5/1116—Determining posture transitions
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B5/00—Measuring for diagnostic purposes; Identification of persons
    • A61B5/103—Detecting, measuring or recording devices for testing the shape, pattern, colour, size or movement of the body or parts thereof, for diagnostic purposes
    • A61B5/11—Measuring movement of the entire body or parts thereof, e.g. head or hand tremor, mobility of a limb
    • A61B5/1118—Determining activity level
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B5/00—Measuring for diagnostic purposes; Identification of persons
    • A61B5/103—Detecting, measuring or recording devices for testing the shape, pattern, colour, size or movement of the body or parts thereof, for diagnostic purposes
    • A61B5/11—Measuring movement of the entire body or parts thereof, e.g. head or hand tremor, mobility of a limb
    • A61B5/1126—Measuring movement of the entire body or parts thereof, e.g. head or hand tremor, mobility of a limb using a particular sensing technique
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation

Landscapes

  • Health & Medical Sciences (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Engineering & Computer Science (AREA)
  • Medical Informatics (AREA)
  • Physics & Mathematics (AREA)
  • Dentistry (AREA)
  • Biophysics (AREA)
  • Pathology (AREA)
  • Physiology (AREA)
  • Biomedical Technology (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Oral & Maxillofacial Surgery (AREA)
  • Molecular Biology (AREA)
  • Surgery (AREA)
  • Animal Behavior & Ethology (AREA)
  • General Health & Medical Sciences (AREA)
  • Public Health (AREA)
  • Veterinary Medicine (AREA)
  • Measurement Of The Respiration, Hearing Ability, Form, And Blood Characteristics Of Living Organisms (AREA)

Abstract

本发明涉及一种基于腕关节运动学模型的转动轴线动态偏移量测量方法，包括如下步骤：步骤一，测量前准备：首先将人体的前臂放置于前臂托架上，再通过激光指示器引导前臂，直至激光指示器的激光束与腕关节的转动轴线对齐，此时前臂沿前臂托架的轴向放置，再用绑带将前臂固定在前臂托架上；步骤二，腕关节运动学模型的建立：将前臂和手部视为刚体，构建成一个多连杆机构，并分别在腕骨与桡骨接触面中心、头状骨中心、掌屈背伸或桡偏尺偏自由度轴线中心、第三个指骨末端中心分别建立坐标系，构建轴线偏差求解的运动学模型；步骤三，腕关节的转动轴线偏移量求解：构建基于多连杆机构的闭式运动链，通过位姿变换定量求解腕关节的转动轴线偏移量。

Description

基于腕关节运动学模型的转动轴线动态偏移量测量方法
技术领域
本发明属于人体工程技术领域，尤其涉及一种基于腕关节运动学模型的转动轴线动态偏移量测量方法。
背景技术
手腕是人体连接手掌和前臂的部位，如图1所示，手腕的腕骨100前端与手掌的掌骨400连接，手腕的腕骨100后端与前臂的桡骨200和尺骨300连接，由于腕关节复杂的生理解剖结构，手腕在进行掌屈/背屈和桡偏/尺偏两自由度的运动时，其转动轴线并不是固定的，而是随着关节的运动而发生变化，其相对于固定轴线会产生一个动态轴线偏移量。此外，手臂表面皮肤的变形、穿戴绑具与皮肤的相对滑动等都可能导致腕关节运动时的转动轴线相对固定轴线发生偏移。轴线的动态偏移不仅给腕关节转动轴线的定位及测量工作带来干扰和困难，并且在穿戴外骨骼式机器人进行康复训练时，可能产生额外的交互力，影响舒适性和安全性。因此，腕关节转动轴线动态偏移量的准确测量一方面可以为康复训练装置、假肢、矫形器等提供设计的理论依据，另一方面也可作为腕关节功能性评估的评价指标，具有较大的现实应用价值。
目前腕关节转动轴线动态偏移量的测量方法主要有侵入式和非侵入式两种方法。侵入式通常是将标记点直接打入关节骨骼，通过X光等成像设备，实现对转动轴线运动变化的观测。该方法对人体伤害较大，故一般较少采纳。非侵入式测量方法，主要借助于运动捕捉系统、视觉传感等特定设备，配合皮肤表面放置标记点进行测量。该方法一定程度上减少了对人体的伤害，但使用的设备成本往往较高，操作复杂，影响了推广应用。
本发明通过构建腕关节的运动学模型，结合惯性传感器和拉线位移传感器，即可快速配置轴线动态偏移量的测量环境，成本较低，且利用闭式运动链中位姿变换方法，可实时精确求解轴线动态偏差量。
发明内容
为解决现有技术存在的腕关节的转动轴线动态偏移量难以测量，以及测量精度低的问题，本发明提供一种基于腕关节运动学模型的转动轴线动态偏移量测量方法。
为解决上述技术问题，本发明所采用的技术方案如下，一种基于腕关节运动学模型的转动轴线动态偏移量测量方法，该腕关节运动学模型包括激光指示器、底板和设置在底板上的前臂托架，第三个指骨的末端安装有第一惯性传感器，所述底板上设置有第二惯性传感器和拉线位移传感器，所述第二惯性传感器和拉线位移传感器均位于前臂托架的前方，所述拉线位移传感器与前臂托架在竖直面内对齐，所述第二惯性传感器位于拉线位移传感器的侧方，所述激光指示器用于指示腕关节的位置；
该测量方法包括如下步骤：
步骤一，测量前准备：首先将人体的前臂放置于所述前臂托架上，再通过激光指示器引导前臂，直至激光指示器的激光束与腕关节的转动轴线对齐，此时前臂沿前臂托架的轴向放置，再用绑带将前臂固定在前臂托架上；
步骤二，腕关节运动学模型的建立：将前臂和手部视为刚体，构建成一个多连杆机构，并分别在腕骨与桡骨接触面中心、头状骨中心、掌屈背伸或桡偏尺偏自由度轴线中心、第三个指骨末端中心分别建立坐标系，构建轴线偏差求解的运动学模型；
步骤三，腕关节的转动轴线偏移量求解：构建基于多连杆机构的闭式运动链，通过位姿变换定量求解腕关节的转动轴线偏移量。
作为优选，所述步骤二中，建立坐标系：其中基坐标系{O0，X0，Y0，Z0}为固接于腕骨与桡骨接触面中心位置；第一坐标系{O1，X1，Y1，Z1}的原点与基座标系的原点重合；第二坐标系{O2，X2，Y2，Z2}的原点位于头状骨中心；第三坐标系{O3，X3，Y3，Z3}与第二坐标系的原点重合，第三坐标系表示腕关节掌屈背伸或桡偏尺偏自由度运动的转动轴线变化；第四坐标系{O4，X4，Y4，Z4}固接于第三个指骨末端位置；所述步骤三中，使用改进型D-H位姿变换方法建立相邻两坐标系之间的位姿变换关系。
进一步地，所述步骤三中，D-H位姿变换的参数包括：连杆序号i，绕着Xi-1轴从Zi-1轴旋转到Zi轴的角度αi-1；沿着Xi-1轴从Zi-1轴移动到Zi轴的距离ai-1；沿着Zi轴从Xi-1轴移动到Xi轴的距离di；绕着Zi轴从Xi-1轴旋转到Xi轴的角度θi；θ3＝θm-90°，其中θm为腕关节的掌屈背伸自由度转动角度，并规定掌屈方向为正，θm∈[-90°,90°]；l为头状骨中心到第三个指骨末端的距离；e为相对于腕骨与桡骨接触面的腕关节的转动轴线偏移量；
所述第四坐标系相对于基坐标系的位姿变换运动学方程可以表示为：
Figure BDA0003736761600000041
其中，c3＝cosθ3，s3＝sinθ3；
所述第一惯性传感器与第四坐标系重合，所述拉线位移传感器的拉线与第三个指骨的末端连接，分别解算第一惯性传感器和第二惯性传感器姿态的四元数，再将所得到的四元数转换成姿态角，通过姿态角计算所述第一惯性传感器相对于第二惯性传感器的转动角度θm，即腕关节的掌屈背伸自由度转动角度θm；
同时，在拉线位移传感器的出线口处建立第五坐标系{O5，X5，Y5，Z5}，根据位姿变换有：
Figure BDA0003736761600000042
其中，
Figure BDA0003736761600000043
Figure BDA0003736761600000044
为第五坐标系相对于基坐标系的姿态描述，为3X3矩阵形式；
Figure BDA0003736761600000045
为第五坐标系原点在基坐标系的位置描述，为3X3矩阵形式，其坐标(p1x,p1y,p1z)中的参数m为第五坐标系的原点与基坐标系的原点在X轴方向的距离，参数n为第五坐标系的原点与基坐标系的原点在Z轴方向的距离。由此，
Figure BDA0003736761600000046
矩阵可表示为4X4矩阵形式，且各元素均为已知常数；
同理，有：
Figure BDA0003736761600000051
通过第二惯性传感器(p0，p1，p2，p3)可以确定所述第四坐标系相对于第五坐标系的姿态旋转变换矩阵为：
Figure BDA0003736761600000052
Figure BDA0003736761600000053
为所述第四坐标系原点在第五坐标系的位置描述，其可通过拉线位移传感器获得
Figure BDA0003736761600000054
的长度r；第五坐标系的原点与第四坐标系的原点连线与X轴之间的夹角为α，由此第四坐标系的原点在第五坐标系的坐标可表示为(p2x,p2y,p2z)，其中p2x＝-r*cosα，p2y＝0，p2z＝r*sinα；
因此，有：
Figure BDA0003736761600000055
结合式(3)，有：
Figure BDA0003736761600000056
由式(7)与式(1)相等，可得：
Figure BDA0003736761600000061
e＝m-l cosθm-r cosα(9)
最后，根据式(8)和式(9)可求解腕关节的转动轴线偏移量e。
进一步地，将腕关节的桡偏尺偏自由度的轴线与掌屈背伸自由度的轴线简化为正交位置关系；
根据D-H位姿变换方法，在桡偏尺偏运动中，所述第四坐标系相对于基坐标系的位姿变换运动学方程与式(1)不同，表示为：
Figure BDA0003736761600000062
其中，c2＝cosθ2，s2＝sinθ2，θ2＝-90°-θn，其中θn为桡偏尺偏转动角度，可由所述第一惯性传感器相对于第二惯性传感器的转动角度获得，以尺偏方向为正，θn∈[-90°,90°]；同时，腕关节在进行桡偏尺偏自由度运动时，所述第四坐标系的原点在第五坐标系的位置描述
Figure BDA0003736761600000063
表现为空间运动，因此，其坐标(p2x',p2y',p2z')，其中，
Figure BDA0003736761600000064
Figure BDA0003736761600000065
p2z'＝r sinα；α为第五坐标系的原点与第四坐标系的原点连线
Figure BDA0003736761600000066
与其在水平面投影
Figure BDA0003736761600000067
之间的夹角，并在掌屈背伸自由度转动角度为零的情况下，有
Figure BDA0003736761600000068
Figure BDA0003736761600000069
为第五坐标系的原点与第四坐标系的原点连线在水平面的投影
Figure BDA00037367616000000610
与X轴之间的夹角
Figure BDA00037367616000000611
因此，有：
Figure BDA0003736761600000071
Figure BDA0003736761600000072
由式(12)与式(10)相等，可得：
sinα＝n/r(13)
Figure BDA0003736761600000073
Figure BDA0003736761600000074
θ2＝-90°-θn(16)
根据式(13)～(16)可得：
α＝arc sin(n/r)(17)
Figure BDA0003736761600000075
Figure BDA0003736761600000076
最后，根据式(17)～(19)求解腕关节的转动轴线偏移量e。
作为优选，所述激光指示器固定设置在前臂托架上，所述激光指示器的激光束朝向水平方向且垂直于前臂托架，当前臂沿前臂托架的轴向贴合放置在前臂托架内，所述腕关节的转动轴线与激光指示器的激光束轴线对齐时，所述前臂放置到位。
有益效果：本发明的基于腕关节运动学模型的转动轴线动态偏移量测量方法，建立基于腕关节生理结构的多连杆运动学模型，并基于惯性传感器和拉线位移传感器，搭建闭式运动链进行位姿变换，从而求解获得腕关节转动轴线偏移量；在使用本发明的测量方法时，将前臂与前臂托架紧密绑定，并将第一惯性传感器安装于第三个指骨的末端表面，排除表面皮肤变形、前臂与前臂托架之间的相对滑动等因素对腕关节转动轴线的位置带来的干扰，提高了腕关节转动轴线偏移量及转动半径求解的准确性；因此，使用本发明的测量方法求解腕关节转动轴线偏移量，可以比较充分地表征因生理结构原因导致的腕关节转动轴线动态变化情况，相比于现有的方法，本发明的测量方法对于腕关节转动轴线偏移量的测量具有明显的个体化特征，腕关节转动轴线偏差的数值与人体生理结构(如腕骨到指骨的距离、关节活动范围等)相关，且不易受表面皮肤变形、前臂与前臂托架之间的相对滑动等因素的影响，测量简单方便，测量精度高，成本较低，具有较好的推广应用价值。
附图说明
为了更清楚地说明本发明实施例的技术方案，下面将对实施例描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域的普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其它附图。
图1是手腕的结构示意图；
图2是本发明测量方法的建立的各个坐标系的示意图；
图3是本发明测量方法的掌屈/背伸的腕关节转动轴线偏移量测量时的立体结构示意图；
图4是本发明测量方法的桡骨/尺骨的腕关节转动轴线偏移量测量时的立体结构示意图；
图中：1-1、底板，1-2、前臂托架，1-3、第一惯性传感器，1-4、第二惯性传感器，1-5、拉线位移传感器，1-51、拉线，1-6、激光指示器；100、腕骨，101、头状骨，200、桡骨，300、尺骨，400、掌骨，500、指骨。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。以下对至少一个示例性实施例的描述实际上仅仅是说明性的，决不作为对本发明及其应用或使用的任何限制。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其它实施例，都属于本发明保护的范围。
如图2～4所示，一种基于腕关节运动学模型的转动轴线动态偏移量测量方法，该腕关节运动学模型包括激光指示器1-6、底板1-1和设置在底板1-1上的前臂托架1-2，第三个指骨500的末端安装有第一惯性传感器1-3，所述底板1-1上设置有第二惯性传感器1-4和拉线位移传感器1-5，所述第二惯性传感器1-4和拉线位移传感器1-5均位于前臂托架1-2的前方，所述拉线位移传感器1-5与前臂托架1-2在竖直面内对齐，所述第二惯性传感器1-4位于拉线位移传感器1-5的侧方，所述激光指示器1-6用于指示腕关节的位置；所述激光指示器1-6固定设置在前臂托架1-2上，所述激光指示器1-6的激光束朝向水平方向且垂直于前臂托架1-2，当前臂沿前臂托架1-2的轴向贴合放置在前臂托架1-2内，所述腕关节的转动轴线与激光指示器1-6的激光束轴线对齐时，所述前臂放置到位；
该测量方法包括如下步骤：
步骤一，测量前准备：首先将人体的前臂放置于所述前臂托架1-2上，如图3和图4所示，再通过激光指示器1-6发射的激光束引导前臂，直至激光指示器1-6的激光束与腕关节的转动轴线对齐，此时前臂沿前臂托架1-2的轴向贴合放置在前臂托架1-2内，再用绑带(图中未示意出)将前臂固定在前臂托架1-2上，确保前臂与前臂托架1-2之间无相对运动；
步骤二，腕关节运动学模型的建立：将前臂和手部视为刚体，构建成一个多连杆机构，并分别在腕骨100与桡骨200接触面中心、头状骨101中心、掌屈/背伸或桡偏/尺偏自由度轴线中心、第三个指骨500末端中心分别建立坐标系，构建轴线偏差求解的运动学模型；在腕关节运动学模型中，本实施例的所述建立坐标系：如图3所示，其中基坐标系{O0，X0，Y0，Z0}为固接于腕骨100与桡骨200接触面中心位置；第一坐标系{O1，X1，Y1，Z1}的原点与基座标系的原点重合；第二坐标系{O2，X2，Y2，Z2}的原点位于头状骨101中心；第三坐标系{O3，X3，Y3，Z3}与第二坐标系的原点重合，第三坐标系表示腕关节掌屈/背伸或桡偏/尺偏自由度运动的转动轴线变化；第四坐标系{O4，X4，Y4，Z4}固接于第三个指骨500末端位置；
步骤三，腕关节的转动轴线偏移量求解：构建基于多连杆机构的闭式运动链，通过位姿变换定量求解腕关节的转动轴线偏移量；使用改进型D-H位姿变换方法建立相邻两坐标系之间的位姿变换关系。
腕关节具备两个自由度，即腕关节掌屈/背伸自由度和桡偏/尺偏，两自由度的转动轴线位置随着腕关节的转动而不断变化，因两自由度轴线之间也存在一定偏差，为求解方便，将两自由度轴线偏移量分别求解：
Ⅰ.腕关节掌屈/背伸的转动轴线偏移量e：
所述步骤三中，D-H位姿变换的参数包括：连杆序号i，绕着Xi-1轴从Zi-1轴旋转到Zi轴的角度αi-1；沿着Xi-1轴从Zi-1轴移动到Zi轴的距离ai-1；沿着Zi轴从Xi-1轴移动到Xi轴的距离di；绕着Zi轴从Xi-1轴旋转到Xi轴的角度θi；下表1中列出了相邻两坐标系之间的D-H位姿变换的参数；
i α<sub>i-1</sub> a<sub>i-1</sub> d<sub>i</sub> θ<sub>i</sub>
1 0 0 0 90°
2 90 0 e -90°
3 -90° 0 0 θ<sub>3</sub>
4 90° l 0 0
表1 D-H参数
表1中，l为头状骨101中心到第三个指骨500末端的距离，该距离数值与个体生理尺寸有关，参考相关文献(Babaiasl M,Mahdioun SH,Jaryani P,et al.A review oftechnological and clinical aspects of robot-aided rehabilitation of upper-extremity after stroke[J].Disability&Rehabilitation AssistiveTechnology,2016:263.)，有l＝0.108*H，H为人体身高，其为常数；e为相对于腕骨100与桡骨200接触面的腕关节的转动轴线偏移量；θ3＝θm-90°，其中θm为腕关节的掌屈/背伸自由度转动角度，并规定掌屈方向为正，θm∈[-90°,90°]；
因此，所述第四坐标系相对于基坐标系的位姿变换运动学方程可以表示为：
Figure BDA0003736761600000121
其中，c3＝cosθ3，s3＝sinθ3；
如图3所示，所述第一惯性传感器1-3与第四坐标系重合，所述拉线位移传感器1-5的拉线1-51与第三个指骨500的末端(第一惯性传感器1-3)连接，分别解算第一惯性传感器1-3和第二惯性传感器1-4姿态的四元数，再将所得到的四元数转换成姿态角，通过姿态角计算所述第一惯性传感器1-3相对于第二惯性传感器1-4的转动角度θm，即腕关节的掌屈/背伸自由度转动角度θm；
同时，在拉线位移传感器1-5的出线口处建立第五坐标系{O5，X5，Y5，Z5}，因此，在图3中，根据位姿变换有：
Figure BDA0003736761600000122
其中，
Figure BDA0003736761600000123
Figure BDA0003736761600000124
为第五坐标系相对于基坐标系的姿态描述，为3X3矩阵形式；
Figure BDA0003736761600000125
为第五坐标系原点在基坐标系的位置描述，为3X3矩阵形式，其坐标(p1x,p1y,p1z)中的参数m为第五坐标系的原点与基坐标系的原点在X轴方向的距离，参数n为第五坐标系的原点与基坐标系的原点在Z轴方向的距离，m、n均可通过搭建测试实验手动测量获得。由此，
Figure BDA0003736761600000131
矩阵可表示为4X4矩阵形式，且各元素均为已知常数；
同理，有：
Figure BDA0003736761600000132
参考相关文献《李志伟、李克昭、赵磊杰等人.基于单位四元数的任意旋转角度的三维坐标转换[J].大地测量与地球动力学,2017,37(01):81-85.》，通过第二惯性传感器1-4(p0，p1，p2，p3)可以确定所述第四坐标系相对于第五坐标系的姿态旋转变换矩阵为：
Figure BDA0003736761600000133
Figure BDA0003736761600000134
为所述第四坐标系(第一惯性传感器1-3所在坐标系)原点在第五坐标系的位置描述，其可通过拉线位移传感器1-5获得
Figure BDA0003736761600000135
的长度r；第五坐标系的原点与第四坐标系的原点连线(即拉线位移传感器1-5伸出的拉线1-51)与X轴之间的夹角为α，由此第四坐标系的原点在第五坐标系的坐标可表示为(p2x,p2y,p2z)，其中p2x＝-r*cosα，p2y＝0，p2z＝r*sinα；
因此，有：
Figure BDA0003736761600000136
结合式(3)，有：
Figure BDA0003736761600000141
由式(7)与式(1)相等，可得：
Figure BDA0003736761600000142
e＝m-lcosθm-rcosα(9)
最后，式(8)和式(9)中的参数m和n可通过搭建测试实验手动测量获得，l可通过人体高度求解获得，r可通过拉线位移传感器1-5测量获得，腕关节掌屈/背伸自由度的转动角度θm可通过求解第一惯性传感器1-3和第二惯性传感器1-4相对转动角度获得，根据式(8)和式(9)可求解腕关节的转动轴线偏移量e。
腕关节桡偏/尺偏的轴线偏移量求解方法可同理求得，仅对与腕关节掌屈/背伸的转动轴线偏移量的差异点作简要分析；
Ⅱ.腕关节桡偏/尺偏的转动轴线偏移量e：
将腕关节的桡偏/尺偏自由度的轴线与掌屈/背伸自由度的轴线简化为正交位置关系，如图4所示，为简化图4，图4中的第一惯性传感器1-3、第二惯性传感器1-4，以及基座标系、第四坐标系和第五坐标系，未作标注，同图3保持一致；根据D-H位姿变换方法，在桡偏/尺偏运动中，所述第四坐标系相对于基坐标系的位姿变换运动学方程与式(1)不同，表示为：
Figure BDA0003736761600000151
其中，c2＝cosθ2，s2＝sinθ2，θ2＝-90°-θn，其中θn为桡偏/尺偏转动角度，可由所述第一惯性传感器1-3相对于第二惯性传感器1-4的转动角度获得，以尺偏方向为正，θn∈[-90°,90°]；同时，腕关节在进行桡偏/尺偏自由度运动时，所述第四坐标系(第一惯性传感器1-3所在坐标系)的原点在第五坐标系的位置描述
Figure BDA0003736761600000152
表现为空间运动，因此，其坐标(p2x',p2y',p2z')，其中，
Figure BDA0003736761600000153
p2z'＝r sinα；α为第五坐标系的原点与第四坐标系的原点连线
Figure BDA0003736761600000154
(即拉线1-51传感器伸出的拉线1-51)与其在水平面投影
Figure BDA0003736761600000155
之间的夹角，并在掌屈/背伸自由度转动角度为零的情况下，有
Figure BDA0003736761600000156
Figure BDA0003736761600000157
为第五坐标系的原点与第四坐标系的原点连线(即拉线1-51传感器伸出的拉线1-51)在水平面的投影
Figure BDA0003736761600000158
与X轴之间的夹角
Figure BDA0003736761600000159
因此，参照所述第Ⅰ部分的求解方法，有：
Figure BDA00037367616000001510
Figure BDA00037367616000001511
由式(12)与式(10)相等，可得：
sinα＝n/r(13)
Figure BDA0003736761600000161
Figure BDA0003736761600000162
θ2＝-90°-θn(16)
根据式(13)～(16)可得：
α＝arc sin(n/r)(17)
Figure BDA0003736761600000163
Figure BDA0003736761600000164
最后，式(17)～(19)的参数m和n可通过搭建测试实验手动测量获得，l可通过人体高度求解获得，r可通过拉线位移传感器1-5测量获得，腕关节桡偏/尺偏自由度的转动角度θn可通过求解第一惯性传感器1-3和第二惯性传感器1-4相对转动角度获得，因此，根据式(17)～(19)求解腕关节的转动轴线偏移量e。
以上，仅为本发明较佳的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，根据本发明的技术方案及其发明构思加以等同替换或改变，都应涵盖在本发明的保护范围之内。

Claims (5)

1.一种基于腕关节运动学模型的转动轴线动态偏移量测量方法，其特征在于：该腕关节运动学模型包括激光指示器(1-6)、底板(1-1)和设置在底板(1-1)上的前臂托架(1-2)，第三个指骨(500)的末端安装有第一惯性传感器(1-3)，所述底板(1-1)上设置有第二惯性传感器(1-4)和拉线位移传感器(1-5)，所述第二惯性传感器(1-4)和拉线位移传感器(1-5)均位于前臂托架(1-2)的前方，所述拉线位移传感器(1-5)与前臂托架(1-2)在竖直面内对齐，所述第二惯性传感器(1-4)位于拉线位移传感器(1-5)的侧方，所述激光指示器(1-6)用于指示腕关节的位置；
该测量方法包括如下步骤：
步骤一，测量前准备：首先将人体的前臂放置于所述前臂托架(1-2)上，再通过激光指示器(1-6)引导前臂，直至激光指示器(1-6)的激光束与腕关节的转动轴线对齐，此时前臂沿前臂托架(1-2)的轴向放置，再用绑带将前臂固定在前臂托架(1-2)上；
步骤二，腕关节运动学模型的建立：将前臂和手部视为刚体，构建成一个多连杆机构，并分别在腕骨(100)与桡骨(200)接触面中心、头状骨(101)中心、掌屈背伸或桡偏尺偏自由度轴线中心、第三个指骨(500)末端中心分别建立坐标系，构建轴线偏差求解的运动学模型；
步骤三，腕关节的转动轴线偏移量求解：构建基于多连杆机构的闭式运动链，通过位姿变换定量求解腕关节的转动轴线偏移量。
2.根据权利要求1所述的基于腕关节运动学模型的转动轴线动态偏移量测量方法，其特征在于：所述步骤二中，建立坐标系：其中基坐标系{O0，X0，Y0，Z0}为固接于腕骨(100)与桡骨(200)接触面中心位置；第一坐标系{O1，X1，Y1，Z1}的原点与基座标系的原点重合；第二坐标系{O2，X2，Y2，Z2}的原点位于头状骨(101)中心；第三坐标系{O3，X3，Y3，Z3}与第二坐标系的原点重合，第三坐标系表示腕关节掌屈背伸或桡偏尺偏自由度运动的转动轴线变化；第四坐标系{O4，X4，Y4，Z4}固接于第三个指骨(500)末端位置；所述步骤三中，使用改进型D-H位姿变换方法建立相邻两坐标系之间的位姿变换关系。
3.根据权利要求2所述的基于腕关节运动学模型的转动轴线动态偏移量测量方法，其特征在于：所述步骤三中，D-H位姿变换的参数包括：连杆序号i，绕着Xi-1轴从Zi-1轴旋转到Zi轴的角度αi-1；沿着Xi-1轴从Zi-1轴移动到Zi轴的距离ai-1；沿着Zi轴从Xi-1轴移动到Xi轴的距离di；绕着Zi轴从Xi-1轴旋转到Xi轴的角度θi；θ3＝θm-90°，其中θm为腕关节的掌屈背伸自由度转动角度，并规定掌屈方向为正，θm∈[-90°,90°]；l为头状骨(101)中心到第三个指骨(500)末端的距离；e为相对于腕骨(100)与桡骨(200)接触面的腕关节的转动轴线偏移量；
所述第四坐标系相对于基坐标系的位姿变换运动学方程可以表示为：
Figure FDA0003736761590000021
其中，c3＝cosθ3，s3＝sinθ3；
所述第一惯性传感器(1-3)与第四坐标系重合，所述拉线位移传感器(1-5)的拉线(1-51)与第三个指骨(500)的末端连接，分别解算第一惯性传感器(1-3)和第二惯性传感器(1-4)姿态的四元数，再将所得到的四元数转换成姿态角，通过姿态角计算所述第一惯性传感器(1-3)相对于第二惯性传感器(1-4)的转动角度θm，即腕关节的掌屈背伸自由度转动角度θm；
同时，在拉线位移传感器(1-5)的出线口处建立第五坐标系{O5，X5，Y5，Z5}，根据位姿变换有：
Figure FDA0003736761590000031
其中，
Figure FDA0003736761590000032
Figure FDA0003736761590000033
为第五坐标系相对于基坐标系的姿态描述，为3X3矩阵形式；
Figure FDA0003736761590000034
为第五坐标系原点在基坐标系的位置描述，为3X3矩阵形式，其坐标(p1x,p1y,p1z)中的参数m为第五坐标系的原点与基坐标系的原点在X轴方向的距离，参数n为第五坐标系的原点与基坐标系的原点在Z轴方向的距离。由此，
Figure FDA0003736761590000035
矩阵可表示为4X4矩阵形式，且各元素均为已知常数；
同理，有：
Figure FDA0003736761590000036
通过第二惯性传感器(1-4)(p0，p1，p2，p3)可以确定所述第四坐标系相对于第五坐标系的姿态旋转变换矩阵为：
Figure FDA0003736761590000037
Figure FDA0003736761590000041
Figure FDA0003736761590000042
为所述第四坐标系原点在第五坐标系的位置描述，其可通过拉线位移传感器(1-5)获得
Figure FDA0003736761590000043
的长度r；第五坐标系的原点与第四坐标系的原点连线与X轴之间的夹角为α，由此第四坐标系的原点在第五坐标系的坐标可表示为(p2x,p2y,p2z)，其中p2x＝-r*cosα，p2y＝0，p2z＝r*sinα；
因此，有：
Figure FDA0003736761590000044
结合式(3)，有：
Figure FDA0003736761590000045
由式(7)与式(1)相等，可得：
Figure FDA0003736761590000046
e＝m-lcosθm-rcosα (9)
最后，根据式(8)和式(9)可求解腕关节的转动轴线偏移量e。
4.根据权利要求3所述的基于腕关节运动学模型的转动轴线动态偏移量测量方法，其特征在于：将腕关节的桡偏尺偏自由度的轴线与掌屈背伸自由度的轴线简化为正交位置关系；
根据D-H位姿变换方法，在桡偏尺偏运动中，所述第四坐标系相对于基坐标系的位姿变换运动学方程与式(1)不同，表示为：
Figure FDA0003736761590000051
其中，c2＝cosθ2，s2＝sinθ2，θ2＝-90°-θn，其中θn为桡偏尺偏转动角度，可由所述第一惯性传感器(1-3)相对于第二惯性传感器(1-4)的转动角度获得，以尺偏方向为正，θn∈[-90°,90°]；同时，腕关节在进行桡偏尺偏自由度运动时，所述第四坐标系的原点在第五坐标系的位置描述
Figure FDA0003736761590000052
表现为空间运动，因此，其坐标(p2x′,p2y′,p2z′)，其中，
Figure FDA0003736761590000053
p2z′＝rsinα；α为第五坐标系的原点与第四坐标系的原点连线
Figure FDA0003736761590000054
与其在水平面投影
Figure FDA0003736761590000055
之间的夹角，并在掌屈背伸自由度转动角度为零的情况下，有
Figure FDA0003736761590000056
Figure FDA0003736761590000057
为第五坐标系的原点与第四坐标系的原点连线在水平面的投影
Figure FDA0003736761590000058
与X轴之间的夹角
Figure FDA0003736761590000059
因此，有：
Figure FDA00037367615900000510
Figure FDA00037367615900000511
由式(12)与式(10)相等，可得：
sinα＝n/r (13)
Figure FDA0003736761590000061
Figure FDA0003736761590000062
θ2＝-90°-θn (16)
根据式(13)～(16)可得：
α＝arcsin(n/r) (17)
Figure FDA0003736761590000063
Figure FDA0003736761590000064
最后，根据式(17)～(19)求解腕关节的转动轴线偏移量e。
5.根据权利要求1～4任一项所述的基于腕关节运动学模型的转动轴线动态偏移量测量方法，其特征在于：所述激光指示器(1-6)固定设置在前臂托架(1-2)上，所述激光指示器(1-6)的激光束朝向水平方向且垂直于前臂托架(1-2)，当前臂沿前臂托架(1-2)的轴向贴合放置在前臂托架(1-2)内，所述腕关节的转动轴线与激光指示器(1-6)的激光束轴线对齐时，所述前臂放置到位。
CN202210853331.4A 2022-07-08 2022-07-08 基于腕关节运动学模型的转动轴线动态偏移量测量方法 Active CN115227235B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210853331.4A CN115227235B (zh) 2022-07-08 2022-07-08 基于腕关节运动学模型的转动轴线动态偏移量测量方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210853331.4A CN115227235B (zh) 2022-07-08 2022-07-08 基于腕关节运动学模型的转动轴线动态偏移量测量方法

Publications (2)

Publication Number Publication Date
CN115227235A true CN115227235A (zh) 2022-10-25
CN115227235B CN115227235B (zh) 2023-07-18

Family

ID=83672815

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210853331.4A Active CN115227235B (zh) 2022-07-08 2022-07-08 基于腕关节运动学模型的转动轴线动态偏移量测量方法

Country Status (1)

Country Link
CN (1) CN115227235B (zh)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102785248A (zh) * 2012-07-23 2012-11-21 华中科技大学 一种解耦型六自由度工业机器人的运动控制方法
CN111249007A (zh) * 2018-11-30 2020-06-09 微创（上海）医疗机器人有限公司 医疗机器人及其用于夹持医疗器械的机械臂

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102785248A (zh) * 2012-07-23 2012-11-21 华中科技大学 一种解耦型六自由度工业机器人的运动控制方法
CN111249007A (zh) * 2018-11-30 2020-06-09 微创（上海）医疗机器人有限公司 医疗机器人及其用于夹持医疗器械的机械臂

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
张广浩: "《上肢康复外骨骼机器人设计与系统仿真研究》", 《山东科技大学工程硕士学位论文》 *
李双双: "《六自由度上肢康复机器人机构设计与控制研究》", 《燕山大学硕士学位论文》 *

Also Published As

Publication number Publication date
CN115227235B (zh) 2023-07-18

Similar Documents

Publication Publication Date Title
US5676157A (en) Determination of kinematically constrained multi-articulated structures
Klopčar et al. Kinematic model for determination of human arm reachable workspace
MEng Development of finger-motion capturing device based on optical linear encoder
Ben-Tzvi et al. Sensing and force-feedback exoskeleton (SAFE) robotic glove
Bullock et al. Assessing assumptions in kinematic hand models: a review
TWI549655B (zh) 關節活動度量測裝置及其量測方法
CN107115114A (zh) 人体运动能力评价方法、装置及系统
US20080091373A1 (en) Method for calibrating sensor positions in a human movement measurement and analysis system
Lim et al. A low cost wearable optical-based goniometer for human joint monitoring
Li et al. Design and validation of a multi-finger sensing device based on optical linear encoder
CN108013880B (zh) 一种人体肘关节前屈后伸绕瞬时动心运动的瞬时动心测量方法
CN108538362B (zh) 一种运动数据实时采集的肌腱异向受力损伤预警分析方法
RU2718568C1 (ru) Контроллер запястья для использования в контроллере оператора роботохирургического комплекса
CN115227235B (zh) 基于腕关节运动学模型的转动轴线动态偏移量测量方法
Lenarčič et al. Positional kinematics of humanoid arms
CN114711760B (zh) 一种关节轴线计算方法
US20200297447A1 (en) A device for sensing the pose and motion of a human&#39;s arm-hand
Ma et al. Modeling human hand and sensing hand motions with the five-fingered haptic glove mechanism
Guo et al. A novel algorithm OF kinematics parameters measurement for upper limb based ON motion capture
CN109997099B (zh) 基于三维磁传感器的手指动作捕捉接口装置
JPH11325881A (ja) 関節角の計測方法及びその装置
CN115227204B (zh) 一种非侵入式腕关节轴线参数的测量装置及测量方法
Nguyen Check for updates A Novel Adjustable Constant-Force Mechanism Based on Spring and Gear Transmission
Zhao et al. A Wearable Upper Limb Exoskeleton for Intuitive Teleoperation of Anthropomorphic Manipulators. Machines 2023, 11, 441
Gao et al. Three-Dimensional Modeling and Kinematic Analysis of Human Elbow Joint Axis Based on Anatomy and Screw Theory

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