首页 / 专利库 / 物理 / 机器人运动学 / 一种基于稳定性准则的下肢康复外骨骼机器人步态规划方法

一种基于稳定性准则的下肢康复外骨骼机器人步态规划方法

阅读:1032发布:2020-09-08

专利汇可以提供一种基于稳定性准则的下肢康复外骨骼机器人步态规划方法专利检索,专利查询,专利分析的服务。并且一种基于 稳定性 准则的下肢康复 外骨骼 机器人 步态规划方法,包含如下步骤:(1)康复训练计划提供训练步长和步幅,步频由患者心率提供。若心率升高,说明训练量过大;若心率变化不大,说明患者训练强度不够,康复医生需要调整康复训练计划直到有效的训练量。(2)康复外骨骼机器人根据步长、步幅、步频等输入参数,调用ZMP稳定性规则,计算出踝关节、膝 关节 角 度 、 角速度 、角 加速 度数据,然后康复外骨骼机器人的 控制器 根据关节数据进行伺服控制,从而指导患者进行康复训练。,下面是一种基于稳定性准则的下肢康复外骨骼机器人步态规划方法专利的具体信息内容。

1.一种基于稳定性准则的下肢康复外骨骼机器人步态规划方法,其特征在于包含如下步骤:
(1)康复训练计划提供训练步长和步幅,步频由患者心率提供;若心率升高,说明训练量过大;若心率变化不大,说明患者训练强度不够,康复医生需要调整康复训练计划直到有效的训练量;
(2)康复外骨骼机器人根据步长、步幅、步频等输入参数,调用ZMP稳定性规则,计算出踝关节、膝关节度、角速度、角加速度数据,然后康复外骨骼机器人的控制器根据关节数据进行伺服控制,从而指导患者进行康复训练。
2.根据权利要求1所述的一种基于稳定性准则的下肢康复外骨骼机器人步态规划方法,其特征在于康复外骨骼机器人的ZMP公式为:
其中:
-xzmp为康复外骨骼机器人ZMP在x轴方向的位置
-yzmp为康复外骨骼机器人ZMP在y轴方向的位置;
-mi为康复外骨骼机器人部件i的质量
-xi、yi、zi为康复外骨骼机器人部件i的质心坐标;
-n为康复外骨骼机器人部件数量;
-g为加速度;
康复外骨骼机器人ZMP轨迹通过康复外骨骼机器人的双脚运动轨迹(位置)进行计算,康复外骨骼机器人的双脚运动轨迹通过步长、步幅、步频获得。
3.根据权利要求2所述的一种基于稳定性准则的下肢康复外骨骼机器人步态规划方法,其特征在于通过式(1)计算出康复外骨骼机器人各个部件i的位姿
根据康复外骨骼机器人的运动学方程,获得康复外骨骼机器人的Jacobi矩阵,Jacobi矩阵表示康复外骨骼机器人各个部件i的位姿与康复外骨骼机器人各个关节信息的函数关系;康复外骨骼机器人运动学方程为:
其中:
-xi、yi、zi表示康复外骨骼机器人各个部件i的位姿;
-θi, 表示康复外骨骼机器人各个关节信息;
康复外骨骼机器人Jacobi矩阵J为:
其中:
-θi, 表示康复外骨骼机器人各个关节信息;
-J为康复外骨骼机器人Jacobi矩阵。
4.根据权利要求3所述的一种基于稳定性准则的下肢康复外骨骼机器人步态规划方法,其特征在于:
(1)假设康复外骨骼机器人的步长为Xl,步幅为Xs;
(2)假设康复训练中,外骨骼机器人的重心高度保持不变;
(3)把下肢康复外骨骼机器人简化为左小腿L1、左大腿L2、右小腿L3、右大腿L4四个部件进行数学建模;
(4)根据运动学式(2)和ZMP公式式(1)可计算出康复外骨骼机器人左腿步态为:
θ1=-β-α1
θ2=α1+α2
β=arctan(Xl/Xs)
L=(L1+L2)*cos(β)
其中:
-θ1表示左踝关节:
-θ2表示左膝关节
5.根据权利要求4所述的一种基于稳定性准则的下肢康复外骨骼机器人步态规划方法,其特征在于康复外骨骼机器人右腿步态为:
θ3=-β-α3
θ4=α1+α4
β=arctan(Xl/Xs)
L=(L3+L4)*cos(β)
其中:
-θ3表示右踝关节;
-θ4表示右膝关节。

说明书全文

一种基于稳定性准则的下肢康复外骨骼机器人步态规划方法

技术领域

[0001] 本发明涉及康复机器人领域,尤其涉及一种基于稳定性准则的下肢康复外骨骼机器人步态规划方法。

背景技术

[0002] 下肢康复外骨骼机器人,是能够帮助下肢残疾或下肢瘫痪患者像正常人一样行走的人机一体化系统。近年来,由于人口老龄化、脑中、交通事故等造成下肢肢体损伤或偏瘫的人数越来越多,因此,下肢康复外骨骼机器人产品对于人类福祉事业和老龄化社会保障体系具有现实的意义,并将产生明显的社会效益。
[0003] 步态规划是康复外骨骼机器人系统的关键技术之一,是能否实现康复训练与稳定行走的一个重要组成部分。步态规划主要有以下四种方法:(1)基于机器人质心的步态规划:将机器人向质量中心质点化,运用学原理,分析和优化其步态。(2)基于弹簧负载倒立摆模型的步态规划:把机器人视为倒立摆模型,腿的长度通过弹簧调节且可变。(3)基于最优控制的步态规划:规划一条满足约束条件的关节运动轨迹,使机器人的某些性能指标达到最优。(4)基于稳定性的步态规划:首先根据机器人运动过程中应满足的约束条件,设计关键点(通常为脚与髋部)的运动轨迹,然后由几何约束,计算其它各关节的运动。再用各阶段的稳定性判据加以约束,在可变参数的有效范围内通过遍历搜索,找到在满足各稳定判据的情况下稳定裕度最大的轨迹作为规划结果。
[0004] 康复机器人的稳定性主要依赖于运动环境的状况,机器人重心位于机器人的支撑多边形内,才能保证机器人的稳定性。稳定性指机器人在运动过程中,如果机器人的步态轨迹在某极限环上具有稳定性,则称这一运动过程是步态稳定的。也就是说在无外界干扰的情况下,每一个运动周期的步态均能复现上一周期的步态,机器人则能以稳定的周期性步态运动;在有干扰的情况下,通过控制作用,在有限步的调整后,又能恢复原稳定的周期性步态运动。稳定性准则有零力矩点(Zero Moment Point,ZMP)、足部旋转指示点(Foot Rotation Indication,FRI)、动量转轴(Centroidal Moment Pivot,CMP)等。ZMP是移动机器人研究领域应用最为广泛的稳定性判据。其核心思想是要确保支撑相内机器人与地面完全接触,使得各个自由度直接可控,避免出现翻转的情形。FRI是脚与地面接触面上的一点,可以位于支撑区域以内或以外,地面净反力将作用于FRI点以保证足部在该点处满足零力矩点的条件。当支撑脚处于静止时,FRI与ZMP是对应的;当支撑脚出现非零的转动加速度时,FRI与ZMP是不同的两个点。CMP是从质心引出的与地面反力平行线同外接触面的交点。为了使整个身体在平方向上的角动量保持不变,地面反力必须作用在CMP处。当绕质心的力矩为零时,CMP与ZMP对应;当绕质心的力矩不为零时,该力矩的水平分量值除以地面反力法向分量值的结果即为CMP与ZMP间隔的距离。

发明内容

[0005] 针对现有技术中康复外骨骼机器人步态规划中存在的上述问题,现提供一种基于稳定性准则来规划康复外骨骼机器人膝关节、髋关节的运动规划方法。
[0006] 一种基于稳定性准则的下肢康复外骨骼机器人步态规划方法,包含如下步骤:
[0007] (1)康复训练计划提供训练步长和步幅,步频由患者心率提供。若心率升高,说明训练量过大;若心率变化不大,说明患者训练强度不够,康复医生需要调整康复训练计划直到有效的训练量。
[0008] (2)康复外骨骼机器人根据步长、步幅、步频等输入参数,调用ZMP稳定性规则,计算出踝关节、膝关节角度角速度角加速度数据,然后康复外骨骼机器人的控制器根据关节数据进行伺服控制,从而指导患者进行康复训练。
[0009] 优选的,康复外骨骼机器人的ZMP公式为:
[0010]
[0011] 其中:xzmp为康复外骨骼机器人ZMP在x轴方向的位置;yzmp为康复外骨骼机器人ZMP在y轴方向的位置;mi为康复外骨骼机器人部件i的质量;xi、yi、zi为康复外骨骼机器人部件i的质心坐标;n为康复外骨骼机器人部件数量,g为重力加速度
[0012] 康复外骨骼机器人ZMP轨迹通过康复外骨骼机器人的双脚运动轨迹(位置)进行计算,康复外骨骼机器人的双脚运动轨迹通过步长、步幅、步频获得。
[0013] 优选的,通过式(1)计算出康复外骨骼机器人各个部件i的位姿(xi、yi、zi)。
[0014] 根据康复外骨骼机器人的运动学方程,获得康复外骨骼机器人的Jacobi矩阵,Jacobi矩阵表示康复外骨骼机器人各个部件i的位姿(xi、yi、zi)与康复外骨骼机器人各个关节信息 的函数关系。康复外骨骼机器人运动学方程为:
[0015]
[0016] 康复外骨骼机器人Jacobi矩阵J为:
[0017]
[0018] (1)假设康复外骨骼机器人的步长为Xl,步幅为Xs
[0019] (2)假设康复训练中,外骨骼机器人的重心高度保持不变
[0020] (3)把下肢康复外骨骼机器人简化为左小腿L1、左大腿L2、右小腿L3、右大腿L4四个部件进行数学建模。
[0021] (4)根据运动学式(2)和ZMP公式式(1)可计算出康复外骨骼机器人左腿步态(左踝关节θ1、左膝关节θ2)为:
[0022] θ1=-β-α1
[0023] θ2=α1+α2
[0024]
[0025]
[0026] β=arctan(Xl/Xs)
[0027] L=(L1+L2)*cos(β)
[0028] 康复外骨骼机器人右腿步态(右踝关节θ3、右膝关节θ4)为:
[0029] θ3=-β-α3
[0030] θ4=α1+α4
[0031]
[0032]
[0033] β=arctan(Xl/Xs)
[0034] L=(L3+L4)*cos(β)附图说明
[0035] 附图1是外骨骼机器人的康复流程。
[0036] 附图2是康复外骨骼机器人的步态规划框架
[0037] 附图3为康复外骨骼机器人的数学模型。

具体实施方式

[0038] 下面将结合本发明实施例中的附图1-3,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。
[0039] 图1是外骨骼机器人的康复流程。根据康复医生提供的康复计划,患者穿戴外骨骼机器人进行康复训练,康复外骨骼机器人根据患者的训练过程评估康复进程,康复医生获得评估报告后,及时调整患者的康复计划。
[0040] 图2是康复外骨骼机器人的步态规划框架。康复训练计划提供训练步长和步幅,步频由患者心率提供。若心率升高,说明训练量过大;若心率变化不大,说明患者训练强度不够,康复医生需要调整康复训练计划直到有效的训练量。康复外骨骼机器人根据步长、步幅、步频等输入参数,调用ZMP稳定性规则,计算出踝关节、膝关节角度、角速度、角加速度数据,然后康复外骨骼机器人的控制器根据关节数据进行伺服控制,从而指导患者进行康复训练。
[0041] 图3为康复外骨骼机器人的数学模型。
[0042] 康复外骨骼机器人的ZMP公式为:
[0043]
[0044] 其中:xzmp为康复外骨骼机器人ZMP在x轴方向的位置;yzmp为康复外骨骼机器人ZMP在y轴方向的位置;mi为康复外骨骼机器人部件i的质量:xi、yi、zi为康复外骨骼机器人部件i的质心坐标;n为康复外骨骼机器人部件数量,g为重力加速度。
[0045] 康复外骨骼机器人ZMP轨迹可以通过康复外骨骼机器人的双脚运动轨迹(位置)进行计算,康复外骨骼机器人的双脚运动轨迹可以通过步长、步幅、步频获得。
[0046] 通过式(1)可以计算出康复外骨骼机器人各个部件i的位姿(xi、yi、zi)。
[0047] 根据康复外骨骼机器人的运动学方程,可以获得康复外骨骼机器人的Jacobi矩阵,Jacobi矩阵表示康复外骨骼机器人各个部件i的位姿(xi、yi、zi)与康复外骨骼机器人各个关节信息 的函数关系。康复外骨骼机器人运动学方程为:
[0048]
[0049] 康复外骨骼机器人Jacobi矩阵J为:
[0050]
[0051] (1)假设康复外骨骼机器人的步长为Xl,步幅为Xs
[0052] (2)假设康复训练中,外骨骼机器人的重心高度保持不变
[0053] (3)把下肢康复外骨骼机器人简化为左小腿L1、左大腿L2、右小腿L3、右大腿L4四个部件进行数学建模。
[0054] (4)根据运动学式(2)和ZMP公式式(1)可计算出康复外骨骼机器人左腿步态(左踝关节θ1、左膝关节θ2)为:
[0055] θ1=-β-α1
[0056] θ2=α1+α2
[0057]
[0058]
[0059] β=arctan(Xl/Xs)
[0060] L=(L1+L2)*cos(β)
[0061] 康复外骨骼机器人右腿步态(右踝关节θ3、右膝关节θ4)为:
[0062] θ3=-β-α3
[0063] θ4=α1+α4
[0064]
[0065]
[0066] β=arctan(Xl/Xs)
[0067] L=(L3+L4)*cos(β)
[0068] 显然,本发明的上述实施例仅仅是为了说明本发明所作的举例,而并非对本发明的实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其他不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷例。而这些属于本发明的实质精神所引申出的显而易见的变化或变动仍属于本发明的保护范围。
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈