CN113520682A - 一种膝-踝-趾动力型下肢假肢的解耦控制方法 - Google Patents

一种膝-踝-趾动力型下肢假肢的解耦控制方法 Download PDF

Info

Publication number
CN113520682A
CN113520682A CN202110600099.9A CN202110600099A CN113520682A CN 113520682 A CN113520682 A CN 113520682A CN 202110600099 A CN202110600099 A CN 202110600099A CN 113520682 A CN113520682 A CN 113520682A
Authority
CN
China
Prior art keywords
knee
joint
ankle
toe
lower limb
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
CN202110600099.9A
Other languages
English (en)
Other versions
CN113520682B (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.)
Hebei University of Technology
Original Assignee
Hebei University of Technology
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 Hebei University of Technology filed Critical Hebei University of Technology
Priority to CN202110600099.9A priority Critical patent/CN113520682B/zh
Publication of CN113520682A publication Critical patent/CN113520682A/zh
Application granted granted Critical
Publication of CN113520682B publication Critical patent/CN113520682B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61F—FILTERS IMPLANTABLE INTO BLOOD VESSELS; PROSTHESES; DEVICES PROVIDING PATENCY TO, OR PREVENTING COLLAPSING OF, TUBULAR STRUCTURES OF THE BODY, e.g. STENTS; ORTHOPAEDIC, NURSING OR CONTRACEPTIVE DEVICES; FOMENTATION; TREATMENT OR PROTECTION OF EYES OR EARS; BANDAGES, DRESSINGS OR ABSORBENT PADS; FIRST-AID KITS
    • A61F2/00—Filters implantable into blood vessels; Prostheses, i.e. artificial substitutes or replacements for parts of the body; Appliances for connecting them with the body; Devices providing patency to, or preventing collapsing of, tubular structures of the body, e.g. stents
    • A61F2/50—Prostheses not implantable in the body
    • A61F2/5044—Designing or manufacturing processes
    • A61F2/5046—Designing or manufacturing processes for designing or making customized prostheses, e.g. using templates, finite-element analysis or CAD-CAM techniques
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61F—FILTERS IMPLANTABLE INTO BLOOD VESSELS; PROSTHESES; DEVICES PROVIDING PATENCY TO, OR PREVENTING COLLAPSING OF, TUBULAR STRUCTURES OF THE BODY, e.g. STENTS; ORTHOPAEDIC, NURSING OR CONTRACEPTIVE DEVICES; FOMENTATION; TREATMENT OR PROTECTION OF EYES OR EARS; BANDAGES, DRESSINGS OR ABSORBENT PADS; FIRST-AID KITS
    • A61F2/00—Filters implantable into blood vessels; Prostheses, i.e. artificial substitutes or replacements for parts of the body; Appliances for connecting them with the body; Devices providing patency to, or preventing collapsing of, tubular structures of the body, e.g. stents
    • A61F2/50—Prostheses not implantable in the body
    • A61F2/60—Artificial legs or feet or parts thereof
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61F—FILTERS IMPLANTABLE INTO BLOOD VESSELS; PROSTHESES; DEVICES PROVIDING PATENCY TO, OR PREVENTING COLLAPSING OF, TUBULAR STRUCTURES OF THE BODY, e.g. STENTS; ORTHOPAEDIC, NURSING OR CONTRACEPTIVE DEVICES; FOMENTATION; TREATMENT OR PROTECTION OF EYES OR EARS; BANDAGES, DRESSINGS OR ABSORBENT PADS; FIRST-AID KITS
    • A61F2/00—Filters implantable into blood vessels; Prostheses, i.e. artificial substitutes or replacements for parts of the body; Appliances for connecting them with the body; Devices providing patency to, or preventing collapsing of, tubular structures of the body, e.g. stents
    • A61F2/50—Prostheses not implantable in the body
    • A61F2/68—Operating or control means
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61F—FILTERS IMPLANTABLE INTO BLOOD VESSELS; PROSTHESES; DEVICES PROVIDING PATENCY TO, OR PREVENTING COLLAPSING OF, TUBULAR STRUCTURES OF THE BODY, e.g. STENTS; ORTHOPAEDIC, NURSING OR CONTRACEPTIVE DEVICES; FOMENTATION; TREATMENT OR PROTECTION OF EYES OR EARS; BANDAGES, DRESSINGS OR ABSORBENT PADS; FIRST-AID KITS
    • A61F2/00—Filters implantable into blood vessels; Prostheses, i.e. artificial substitutes or replacements for parts of the body; Appliances for connecting them with the body; Devices providing patency to, or preventing collapsing of, tubular structures of the body, e.g. stents
    • A61F2/50—Prostheses not implantable in the body
    • A61F2/68—Operating or control means
    • A61F2002/6854—Operating or control means for locking or unlocking a joint

Landscapes

  • Health & Medical Sciences (AREA)
  • Transplantation (AREA)
  • Engineering & Computer Science (AREA)
  • Vascular Medicine (AREA)
  • Oral & Maxillofacial Surgery (AREA)
  • Cardiology (AREA)
  • Biomedical Technology (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Animal Behavior & Ethology (AREA)
  • General Health & Medical Sciences (AREA)
  • Public Health (AREA)
  • Veterinary Medicine (AREA)
  • Manufacturing & Machinery (AREA)
  • Orthopedic Medicine & Surgery (AREA)
  • Prostheses (AREA)

Abstract

本发明公开了一种膝‑踝‑趾动力型下肢假肢的解耦控制方法，属于下肢假肢技术领域，采用膝踝趾下肢假肢模型为被控对象，建立不同步态阶段的下肢假肢模型，设计基于控制法则分解的解耦方法对膝踝趾下肢假肢关节进行解耦，使用自适应迭代控制策略对解耦后的假肢模型进行控制，本发明确定了膝踝趾下肢假肢模型的解耦控制律和解耦系统的结构，采用逆系统反馈的形式，将原系统的各阶输出或状态向量反馈，重构为具有标准积分形式的线性系统，将原控制对象内部存在的耦合关系通过内部逆的形式抵消，实现解耦。解决了下肢假肢关节间的交连耦合影响，提高了三关节系统的可控性和稳定性，有效降低了被控对象的复杂程度，缩短了控制时间，达到了快速收敛要求。

Description

一种膝-踝-趾动力型下肢假肢的解耦控制方法
技术领域
本发明属于下肢假肢技术领域，具体是涉及一种膝-踝-趾动力型下肢假肢的解耦控制方法。
背景技术
根据第二次全国残疾人抽样调查，我国有肢体残疾人2412万，占残疾人总数的29.07％，其中下肢截肢者158万人，约占截肢者总数的70％，并且近年来下肢截肢者的数量还在不断上涨。
假肢是截肢者重要的辅助工具，是为了弥补截肢者肢体缺损，代偿肢体功能而制造、装配的人工肢体。下肢假肢是下肢截肢者恢复行走功能的重要手段，下肢假肢基本能达到对人体缺失功能的替代，使下肢截肢者生活可以自理，甚至可以正常参加一些简单社会工作。研究能够模拟正常人下肢摆动的下肢假肢，需要运用数学建模、运动检测、运动控制等多方面的知识，涉及到机械电子、机器人技术、自动化技术、智能材料与结构等多个学科。下肢假肢的研究不仅能够解决截肢者的生产和生活问题，还能将其应用于仿生机器人、工程建设、交通运输、智能生产中，带动多个学科领域相关研究的发展。因此，开展能够模拟正常人行走的下肢假肢的研究具有重要的学术价值。
下肢假肢是一个典型的多输入多输出的非线性系统，要将其中的一个关节进行控制，需要将腿部的其他所有关节都锁定，一旦这些关节被解除锁定，各关节间就存在着交连耦合影响。因此，在假肢正常运动过程中，每一个关节的运动都会受到其他关节的耦合影响。这给下肢假肢多关节间协调运动控制带来了很大的困难。因而，降低下肢假肢关节间的交连耦合影响，对机器人各个关节进行解耦控制变得十分必要。
目前智能下肢假肢研究多对于智能膝-踝关节、踝-趾关节相关性进行研究，控制方法应用协调控制仅限于拟合正常膝关节与踝关节角度曲线实现控制，并没有涉及各关节的解耦研究。
发明内容
本发明要解决的问题是提供一种针对膝踝趾下肢假肢结构，将假肢三关节进行解耦并进行控制，可以提高各个关节的控制效果，降低被控系统的耦合性与复杂度，缩短控制时间，以达到快速收敛要求的膝-踝-趾动力型下肢假肢的解耦控制方法。
为解决上述技术问题，本发明采用的技术方案是：一种膝-踝-趾动力型下肢假肢的解耦控制方法，包括以下步骤：
步骤1、利用VICON MX三维步态分析系统采集下肢各关节角度信息，
髋-膝-踝关节角度可由模型直接计算出来，由于标准的下肢模型在足部只有两个标记点，无法计算趾关节角度，所以创建新的下肢实验模型，得到足部各标记点相对位置图，关节角度可由HEE，TOE和TT三个点的位置信息计算获得，由三个标记点的位置，可以计算出HEE的相对位移x，且HEE 到TOE的距离l已知，则：
Figure BDA0003092643920000021
步骤2、根据膝-踝-趾动力型下肢假肢的行走模式，进行步态划分，
通过分析腿部各关节角度变化规律及脚部受力点，将下肢运动的步态周期分为两个阶段：支撑期和摆动期，并针对不同的阶段分别进行建模与控制。
步骤3、在不同阶段，建立不同的下肢假肢模型，使用基于控制法则分解的解耦方法对膝踝趾下肢假肢关节进行解耦。
摆动期阶段，脚底不与地面接触，可将髋关节看做固定点建立动力学方程。
Figure BDA0003092643920000022
其中，M1为关节空间惯性矩阵，H1是哥式力和向心力的耦合矩阵，G1是重力矩阵，T1是髋关节与膝关节驱动力矩矩阵。θ1＝[θhip,θknee]T，τ1＝[τhip,τknee]T，τhip为髋关节力矩，τknee为膝关节力矩。
根据支撑期阶段趾关节受力情况，可将其分为支撑前中期和支撑末期。
支撑前中期阶段，人体的运动可以看作绕踝关节旋转，以踝关节为固定点，并建立动力学方程：
Figure BDA0003092643920000023
其中，τ2是膝关节与踝关节驱动力矩矩阵，θ2＝[θknee,θankle]T，τ2＝[τknee,τankle]T，τankle为踝关节力矩。
支撑末期，人体的运动可以看作绕趾关节旋转，将趾关节作为原点，并建立动力学模型：
Figure BDA0003092643920000031
其中，τ3是膝关节与踝关节驱动力矩矩阵，θ3＝[θknee,θankle,θtoe]T，τ3＝[τknee,τankle,τtoe]T，τtoe为趾关节力矩。
研究系统解耦问题，分为两个步骤：首先，确定系统能够被解耦的充要条件，即能解耦性判别问题，然后，确定解耦控制律和解耦系统的结构，即解耦系统的具体综合问题。逆系统方法采用反馈的形式，将原系统的各阶输出或状态向量反馈，重构为具有标准积分形式的线性系统，将原控制对象内部存在的耦合关系通过内部逆的形式抵消，实现解耦。
针对此关键问题，从多体动力学入手，选择基于控制法则分解法对关节间的耦合进行解耦，选取f＝αu+β控制律中‘对象校正’部分为：
Figure BDA0003092643920000032
‘误差伺服’部分固定取
Figure BDA0003092643920000033
其中，α与β为‘反模型’，用于简化非线性对象的控制。xd为中间变量，e为系统期望与实际输出的误差。从而可得到支撑末期膝-踝-趾三关节下肢假肢模型的解耦后效果为三阶对角阵Y，即各关节力矩仅与本关节运动角度有关。
步骤4、设计下肢假肢控制器，以解耦后的假肢动力学模型为被控对象，设计自适应迭代学习控制策略，实现下肢假肢的膝-踝-趾三关节角度的快速跟踪。
被控系统在第k次迭代时，系统模型如下：
Figure BDA0003092643920000034
式(6)中θk(t)∈R3，
Figure BDA0003092643920000035
为关节角位移、角速度和角加速度。
定义角位移误差为ek(t)，表示为期望轨迹θd(t)与第k次迭代的跟踪角度
Figure BDA0003092643920000036
的差值，计算如下：
ek(t)＝θd(t)-θk(t) (7)
同理，角速度误差为
Figure BDA0003092643920000041
自适应迭代学习控制器设计如下：
Figure BDA0003092643920000042
式(8)中KP∈R3×3，KD∈R3×3为迭代学习控制的PID增益矩阵，Γ为自适应参数，vk(t)为自适应项。
期望轨迹θd(t)是由实验所测量的到的膝关节、髋关节和趾关节的角度位移，将控制系统的输出力矩作用在解耦后的下肢假肢动力学模型中，可以得到下肢假肢的实际跟踪角度位移θk(t)。
步骤5、控制系统平台MATLAB模型搭建。
基于自适应迭代学习的下肢假肢解耦控制，在MATLAB/Simulink下建立解耦控制器，包括以下几部分，自适应迭代学习控制器、解耦器、膝踝趾下肢假肢模型、期望轨迹输入模块、跟踪轨迹输出模块和控制力矩模块。
步骤6、MATLAB模型参数设置及仿真分析。
设置控制器的参数及下肢假肢模型的参数，控制器参数有迭代学习控制的PID增益KP，KD和自适应参数Γ以及控制的精度γ；下肢假肢的参数有假肢接受腔、小腿、后脚掌与前脚掌的总量与长度。
通过控制器的仿真结果分析，可以得到膝踝趾三关节在解耦后的角度跟踪和跟踪误差。在三个关节的跟踪误差均达到控制精度时，观察误差收敛情况，得到解耦后的三关节角度误差收敛图。
与现有技术相比，本发明的有益效果在于：
1.创建了新的下肢实验模型，通过足部各标记点相对位置可以计算出传统模型中无法得到的趾关节角度信息。
2.设计了膝踝趾三关节的假肢解耦器，将复杂的三关节电机模型进行简化，降低了系统的耦合性，使被控系统更加可控。
3.根据下肢行走具有周期性重复的特点，使用了自适应迭代学习控制器，通过迭代过程可以更快速地得到满足控制精度要求的控制力矩。
附图说明
下面通过参考附图并结合实例具体地描述本发明，本发明的优点和实现方式将会更加明显，其中附图所示内容仅用于对本发明的解释说明，而不构成对本发明的任何意义上的限制，在附图中：
图1为本发明足部各标记点相对位置图
图2为本发明膝踝趾三关节的期望角度轨迹图
图3为本发明MATLAB/simulink控制系统模型图
图4为本发明膝关节角度跟踪图
图5为本发明踝关节角度跟踪图
图6为本发明趾关节角度跟踪图
图7为本发明膝踝趾三关节角度跟踪误差收敛图
具体实施方式
下面结合实施例及其附图进一步叙述本发明：
如图1至图7所示，一种膝-踝-趾动力型下肢假肢的解耦控制方法，包括以下步骤：
步骤1、利用VICON MX三维步态分析系统采集下肢各关节角度信息。
髋-膝-踝关节角度可由模型直接计算出来，由于标准的下肢模型在足部只有两个标记点，无法计算趾关节角度，所以创建新的下肢实验模型，得到足部各标记点相对位置，如图1所示，关节角度可由HEE，TOE和TT三个点的位置信息计算获得。由三个标记点的位置，可以计算出HEE的相对位移x，且HEE到TOE的距离l已知，则：
Figure BDA0003092643920000051
步骤2、根据膝-踝-趾动力型下肢假肢的行走模式，进行步态划分。
通过分析腿部各关节角度变化规律及脚部受力点，将下肢运动的步态周期分为两个阶段：支撑期和摆动期，并针对不同的阶段分别进行建模与控制。
步骤3、在不同阶段，建立不同的下肢假肢模型，使用基于控制法则分解的解耦方法对膝踝趾下肢假肢关节进行解耦。
摆动期阶段，脚底不与地面接触，可将髋关节看做固定点建立动力学方程：
Figure BDA0003092643920000061
其中，M1为关节空间惯性矩阵，H1是哥式力和向心力的耦合矩阵，G1是重力矩阵，T1是髋关节与膝关节驱动力矩矩阵。θ1＝[θhip,θknee]T，τ1＝[τhip,τknee]T，τhip为髋关节力矩，τknee为膝关节力矩。
根据支撑期阶段趾关节受力情况，可将其分为支撑前中期和支撑末期。
支撑前中期阶段，人体的运动可以看作绕踝关节旋转，以踝关节为固定点，并建立动力学方程：
Figure BDA0003092643920000062
其中，τ2是膝关节与踝关节驱动力矩矩阵，θ2＝[θknee,θankle]T，τ2＝[τknee,τankle]T，τankle为踝关节力矩。
支撑末期，人体的运动可以看作绕趾关节旋转，将趾关节作为原点，并建立动力学模型：
Figure BDA0003092643920000063
其中，τ3是膝关节与踝关节驱动力矩矩阵，θ3＝[θknee,θankle,θtoe]T，τ3＝[τknee,τankle,τtoe]T，τtoe为趾关节力矩。
研究系统解耦问题，分为两个步骤：首先，确定系统能够被解耦的充要条件，即能解耦性判别问题，然后，确定解耦控制律和解耦系统的结构，即解耦系统的具体综合问题。逆系统方法采用反馈的形式，将原系统的各阶输出或状态向量反馈，重构为具有标准积分形式的线性系统，将原控制对象内部存在的耦合关系通过内部逆的形式抵消，实现解耦。
针对此关键问题，从多体动力学入手，选择基于控制法则分解法对关节间的耦合进行解耦，选取f＝αu+β控制律中‘对象校正’部分为：
Figure BDA0003092643920000064
‘误差伺服’部分固定取
Figure BDA0003092643920000065
其中，α与β为‘反模型’，用于简化非线性对象的控制。xd为中间变量，e为系统期望与实际输出的误差。从而可得到支撑末期膝-踝-趾三关节下肢假肢模型的解耦后效果为三阶对角阵Y，即各关节力矩仅与本关节运动角度有关。
步骤4、设计下肢假肢控制器，以解耦后的假肢动力学模型为被控对象，设计自适应迭代学习控制策略，实现下肢假肢的膝-踝-趾三关节角度的快速跟踪。
被控系统在第k次迭代时，系统模型如下：
Figure BDA0003092643920000071
式(6)中θk(t)∈R3，
Figure BDA0003092643920000072
为关节角位移、角速度和角加速度。
定义角位移误差为ek(t)，表示为期望轨迹θd(t)与第k次迭代的跟踪角度
Figure BDA0003092643920000073
的差值，计算如下：
ek(t)＝θd(t)-θk(t) (7)
同理，角速度误差为
Figure BDA0003092643920000074
自适应迭代学习控制器设计如下：
Figure BDA0003092643920000075
式(8)中KP∈R3×3，KD∈R3×3为迭代学习控制的PID增益矩阵，Γ为自适应参数，vk(t)为自适应项。
期望轨迹θd(t)是由实验所测量的到的膝关节、髋关节和趾关节的角度位移，如图2所示，将控制系统的输出力矩作用在解耦后的下肢假肢动力学模型中，可以得到下肢假肢的实际跟踪角度位移θk(t)。
步骤5、控制系统平台MATLAB模型搭建。
基于自适应迭代学习的下肢假肢解耦控制，在MATLAB/Simulink下建立解耦控制器，包括以下几部分，自适应迭代学习控制器、解耦器、膝踝趾下肢假肢模型、期望轨迹输入模块、跟踪轨迹输出模块和控制力矩模块。
如图3所示，其中解耦器为控制法则分解法解耦，膝踝趾下肢假肢模型为三关节动力学模型，期望轨迹输入模块为膝踝趾三关节的角度位移θd(t)，跟踪轨迹模块为假肢模型的输出的角度位移θk(t)，控制力矩模块为达到控制精度要求的控制器输出τk(t)。
步骤6、MATLAB模型参数设置及仿真分析。
设置控制器的参数及下肢假肢模型的参数，控制器参数有迭代学习控制的PID增益
Figure BDA0003092643920000081
和自适应参数Γ＝10以及控制的精度γ＝0.15°；下肢假肢的参数有假肢接受腔长度l1＝0.42m，质量m1＝2.14kg；小腿长度l2＝0.39m，质量m2＝1.84kg；后脚掌长度l3＝0.14m，质量m3＝0.51kg；前脚掌长度l4＝0.07m，质量m4＝0.25kg。
通过控制器的仿真结果分析，可以得到膝踝趾三关节在解耦后的角度跟踪和跟踪误差。
如图4至图6所示，分别为膝、踝和趾关节的角度跟踪图，如图7所示，为三关节的跟踪误差收敛图。可以明显看出在三个关节的角度跟踪时，跟踪轨迹始终保持在期望轨迹附近，第一次迭代的均方误差的最大值为4.3度，经过几次迭代后可以使跟踪误差保持在0.15度以内，实现了膝踝趾下肢假肢的解耦控制，使用本方法实现了稳定跟踪与快速跟踪的效果。
以上对本发明的实施例进行了详细说明，但所述内容仅为本发明的较佳实施例，不能被认为用于限定本发明的实施范围。其各步骤的实现方式是可以有所变化的，凡依本发明范围所作的均等变化与改进等，均应仍归属于本专利涵盖范围之内。

Claims (7)

1.一种膝-踝-趾动力型下肢假肢的解耦控制方法，其特征在于：包括以下步骤：
步骤1、利用VICON MX三维步态分析系统采集下肢各关节角度信息，髋-膝-踝关节角度由模型直接计算出来，并创建下肢实验模型，得到足部各标记点相对位置图，关节角度可由HEE，TOE和TT三个点的位置信息计算获得；
步骤2、根据膝-踝-趾动力型下肢假肢的行走模式，进行步态划分；
步骤3、在不同阶段，建立不同的下肢假肢模型，使用基于控制法则分解的解耦方法对膝踝趾下肢假肢关节进行解耦；
步骤4、设计下肢假肢控制器，以解耦后的假肢动力学模型为被控对象，设计自适应迭代学习控制策略，实现下肢假肢的膝-踝-趾三关节角度的快速跟踪；
步骤5、控制系统平台MATLAB模型搭建；
步骤6、MATLAB模型参数设置及仿真分析，得到膝踝趾三关节在解耦后的角度跟踪和跟踪误差，在三个关节的跟踪误差均达到控制精度时，观察误差收敛情况，得到解耦后的三关节角度误差收敛图。
2.根据权利要求1所述的膝-踝-趾动力型下肢假肢的解耦控制方法，其特征在于：在步骤一中，由三个标记点的位置，计算出HEE的相对位移x，且HEE到TOE的距离l已知，则：
Figure FDA0003092643910000011
3.根据权利要求2所述的膝-踝-趾动力型下肢假肢的解耦控制方法，其特征在于：在步骤2中，通过分析腿部各关节角度变化规律及脚部受力点，将下肢运动的步态周期分为两个阶段：支撑期和摆动期，并针对不同的阶段分别进行建模与控制。
4.根据权利要求3所述的膝-踝-趾动力型下肢假肢的解耦控制方法，其特征在于：在步骤三3中，摆动期阶段，脚底不与地面接触，可将髋关节看做固定点建立动力学方程。
Figure FDA0003092643910000012
其中，M1为关节空间惯性矩阵，H1是哥式力和向心力的耦合矩阵，G1是重力矩阵，T1是髋关节与膝关节驱动力矩矩阵。θ1＝[θhip,θknee]T，τ1＝[τhip,τknee]T，τhip为髋关节力矩，τknee为膝关节力矩，
根据支撑期阶段趾关节受力情况，可将其分为支撑前中期和支撑末期，
支撑前中期阶段，人体的运动可以看作绕踝关节旋转，以踝关节为固定点，并建立动力学方程：
Figure FDA0003092643910000021
其中，τ2是膝关节与踝关节驱动力矩矩阵，θ2＝[θknee,θankle]T，τ2＝[τknee,τankle]T，τankle为踝关节力矩；
支撑末期，人体的运动可以看作绕趾关节旋转，将趾关节作为原点，并建立动力学模型：
Figure FDA0003092643910000022
其中，τ3是膝关节与踝关节驱动力矩矩阵，θ3＝[θknee,θankle,θtoe]T，τ3＝[τknee,τankle,τtoe]T，τtoe为趾关节力矩，
解耦分为两个步骤：首先，确定系统能够被解耦的充要条件，即能解耦性判别问题，然后，确定解耦控制律和解耦系统的结构，即解耦系统的具体综合问题。逆系统方法采用反馈的形式，将原系统的各阶输出或状态向量反馈，重构为具有标准积分形式的线性系统，将原控制对象内部存在的耦合关系通过内部逆的形式抵消，实现解耦，
从多体动力学入手，选择基于控制法则分解法对关节间的耦合进行解耦，选取f＝αu+β控制律中对象校正部分为：
Figure FDA0003092643910000023
误差伺服部分固定取
Figure FDA0003092643910000024
其中，α与β为反模型，用于简化非线性对象的控制，xd为中间变量，e为系统期望与实际输出的误差，从而可得到支撑末期膝-踝-趾三关节下肢假肢模型的解耦后效果为三阶对角阵Y，即各关节力矩仅与本关节运动角度有关。
5.根据权利要求4所述的膝-踝-趾动力型下肢假肢的解耦控制方法，其特征在于：在步骤4中，被控系统在第k次迭代时，系统模型如下：
Figure FDA0003092643910000031
式(6)中θk(t)∈R3，
Figure FDA0003092643910000032
为关节角位移、角速度和角加速度，
定义角位移误差为ek(t)，表示为期望轨迹θd(t)与第k次迭代的跟踪角度
Figure FDA0003092643910000033
的差值，计算如下：
ek(t)＝θd(t)-θk(t) (7)
同理，角速度误差为
Figure FDA0003092643910000034
自适应迭代学习控制器设计如下：
Figure FDA0003092643910000035
式(8)中KP∈R3×3，KD∈R3×3为迭代学习控制的PID增益矩阵，Γ为自适应参数，vk(t)为自适应项，
期望轨迹θd(t)是由实验所测量的到的膝关节、髋关节和趾关节的角度位移，将控制系统的输出力矩作用在解耦后的下肢假肢动力学模型中，可以得到下肢假肢的实际跟踪角度位移θk(t)。
6.根据权利要求5所述的膝-踝-趾动力型下肢假肢的解耦控制方法，其特征在于：在步骤5中，基于自适应迭代学习的下肢假肢解耦控制，在MATLAB/Simulink下建立解耦控制器，包括以下几部分，自适应迭代学习控制器、解耦器、膝踝趾下肢假肢模型、期望轨迹输入模块、跟踪轨迹输出模块和控制力矩模块。
7.根据权利要求6所述的膝-踝-趾动力型下肢假肢的解耦控制方法，其特征在于：在步骤6中，设置控制器的参数及下肢假肢模型的参数，控制器参数有迭代学习控制的PID增益KP，KD和自适应参数Γ以及控制的精度γ；下肢假肢的参数有假肢接受腔、小腿、后脚掌与前脚掌的总量与长度。
CN202110600099.9A 2021-05-31 2021-05-31 一种膝-踝-趾动力型下肢假肢的解耦控制方法 Active CN113520682B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110600099.9A CN113520682B (zh) 2021-05-31 2021-05-31 一种膝-踝-趾动力型下肢假肢的解耦控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110600099.9A CN113520682B (zh) 2021-05-31 2021-05-31 一种膝-踝-趾动力型下肢假肢的解耦控制方法

Publications (2)

Publication Number Publication Date
CN113520682A true CN113520682A (zh) 2021-10-22
CN113520682B CN113520682B (zh) 2024-02-20

Family

ID=78094920

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110600099.9A Active CN113520682B (zh) 2021-05-31 2021-05-31 一种膝-踝-趾动力型下肢假肢的解耦控制方法

Country Status (1)

Country Link
CN (1) CN113520682B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114795604A (zh) * 2022-04-18 2022-07-29 合肥综合性国家科学中心人工智能研究院(安徽省人工智能实验室) 基于非零和博弈的下肢假肢协调控制方法及系统

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20150066156A1 (en) * 2013-08-27 2015-03-05 Carnegie Mellon University, A Pennsylvania Non-Profit Corporation Robust swing leg controller under large disturbances
US20150190200A1 (en) * 2012-05-30 2015-07-09 Ecole Polytechnique Federale De Lausanne Apparatus and method for restoring voluntary control of locomotion in neuromotor impairments
US20160045385A1 (en) * 2014-08-15 2016-02-18 Honda Motor Co., Ltd. Admittance shaping controller for exoskeleton assistance of the lower extremities
US20160296347A1 (en) * 2015-02-13 2016-10-13 Jacob Quintus Laurence Anthony Boender Prosthetic joints
CN106983589A (zh) * 2017-04-07 2017-07-28 河北工业大学 一种基于干扰观测器的主动型膝上假肢终端滑模控制方法
US20180116828A1 (en) * 2016-11-03 2018-05-03 University Of New Brunswick Powered lower limb devices and methods of control thereof

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20150190200A1 (en) * 2012-05-30 2015-07-09 Ecole Polytechnique Federale De Lausanne Apparatus and method for restoring voluntary control of locomotion in neuromotor impairments
US20150066156A1 (en) * 2013-08-27 2015-03-05 Carnegie Mellon University, A Pennsylvania Non-Profit Corporation Robust swing leg controller under large disturbances
US20160045385A1 (en) * 2014-08-15 2016-02-18 Honda Motor Co., Ltd. Admittance shaping controller for exoskeleton assistance of the lower extremities
US20160296347A1 (en) * 2015-02-13 2016-10-13 Jacob Quintus Laurence Anthony Boender Prosthetic joints
US20180116828A1 (en) * 2016-11-03 2018-05-03 University Of New Brunswick Powered lower limb devices and methods of control thereof
CN106983589A (zh) * 2017-04-07 2017-07-28 河北工业大学 一种基于干扰观测器的主动型膝上假肢终端滑模控制方法

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
CHEN, YW (CHEN, YAWEI) ; XUAN, BK (XUAN, BOKAI) ; GENG, YL (GENG, YANLI) ; DING, SB (DING, SANBO) ; CHEN, LL (CHEN, LINGLING): "Modeling and Control of Knee-Ankle-Toe Active Transfemoral Prosthesis", 《IEEE ACCESS》, vol. 8, pages 133451 - 133462, XP011801215, DOI: 10.1109/ACCESS.2020.3010636 *
尹贵;张小栋;陈江城;马伟光;: "模型不确定的下肢康复机器人轨迹跟踪自适应控制", 电子测量与仪器学报, no. 11 *
尹贵;张小栋;陈江城;马伟光;: "模型不确定的下肢康复机器人轨迹跟踪自适应控制", 电子测量与仪器学报, no. 11, 15 November 2016 (2016-11-15) *
龚思远;杨鹏;刘启栋;宋亮;: "智能下肢假肢传感器的应用", 中国组织工程研究与临床康复, no. 17 *
龚思远;杨鹏;刘启栋;宋亮;: "智能下肢假肢传感器的应用", 中国组织工程研究与临床康复, no. 17, 23 April 2010 (2010-04-23) *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114795604A (zh) * 2022-04-18 2022-07-29 合肥综合性国家科学中心人工智能研究院(安徽省人工智能实验室) 基于非零和博弈的下肢假肢协调控制方法及系统

Also Published As

Publication number Publication date
CN113520682B (zh) 2024-02-20

Similar Documents

Publication Publication Date Title
CN112051741B (zh) 一种双足机器人动态运动生成与控制方法
Azimi et al. Robust ground reaction force estimation and control of lower-limb prostheses: Theory and simulation
CN106983589B (zh) 一种基于干扰观测器的主动型膝上假肢终端滑模控制方法
CN109991979B (zh) 一种面向复杂环境的下肢机器人拟人步态规划方法
CN104401419B (zh) 一种基于气动人工肌肉的新型双足仿人机器人系统
CN114248855B (zh) 双足机器人空间域步态规划与控制的方法
CN109871018A (zh) 一种具有腰部自由度四足机器人的控制方法
CN110524525B (zh) 一种下肢外骨骼控制方法
CN112558622B (zh) 一种爬壁六足机器人足端轨迹跟踪控制器的控制方法
CN113021299A (zh) 一种双腿轮复合机器人全方位运动控制方法
CN113520682B (zh) 一种膝-踝-趾动力型下肢假肢的解耦控制方法
CN111658246A (zh) 一种基于对称性的智能关节假肢调控方法及系统
Zhao et al. 3D multi-contact gait design for prostheses: Hybrid system models, virtual constraints and two-step direct collocation
CN106897575B (zh) 一种主动型膝上假肢的准滑模控制方法
CN116115217A (zh) 一种基于深度网络的人体下肢步态相位估计方法
CN114795604A (zh) 基于非零和博弈的下肢假肢协调控制方法及系统
CN115202378A (zh) 一种仿人机器人动态步行控制方法
Jelačić Wearable sensor control of above-knee prosthetic device
Wang et al. Design and implementation of coordinated control strategy for biped robot with heterogeneous legs
CN118070430B (zh) 轮腿式车辆腿部结构参数优化方法、装置、介质及产品
An et al. Adaptive Neural Network-Based Gait Coordination Control for Bipedal Modular Robot
Issabekov et al. Developing the Mathematical Model of the Bipedal Walking Robot Executive Mechanism
Pi Gait control of robotic leg prosthesis based on motion predictive system
Song et al. Modeling, Simulation and Kinematic Validation of Transfemoral Prosthetic Mechanism with Ankle Varus-Valgus Characteristic
Gosha et al. Robotic Amputated Lower Limb for In-vitro Testing of Osseointegrated Prostheses Devices

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