[发明专利]一种膝关节外骨骼角度的无模型自适应反演控制方法有效
申请号: | 201910833948.8 | 申请日: | 2019-09-04 |
公开(公告)号: | CN110647035B | 公开(公告)日: | 2022-07-22 |
发明(设计)人: | 唐昊;王浩平;田杨 | 申请(专利权)人: | 南京理工大学 |
主分类号: | G05B13/04 | 分类号: | G05B13/04 |
代理公司: | 南京理工大学专利中心 32203 | 代理人: | 陈鹏 |
地址: | 210094 江*** | 国省代码: | 江苏;32 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 膝关节 骨骼 角度 模型 自适应 反演 控制 方法 | ||
1.一种膝关节外骨骼角度的无模型自适应反演控制方法,其特征在于,包括以下步骤:
步骤1、建立膝关节外骨骼人机交互的阻抗模型:包括人体膝关节的阻抗模型和膝关节外骨骼的阻抗模型,将两者联立形成膝关节外骨骼人机交互的阻抗模型;具体为:
其中Jo、Jh分别为膝关节外骨骼、人体下肢转动惯量;θj为人体膝关节运动角度;Bo、Bh分别为膝关节外骨骼、人体下肢阻尼系数;Tj、Th分别为膝关节外骨骼、人体下肢的扭矩;Go(θj)、Gh(θj)分别为膝关节外骨骼、人体下肢的重力表达式;
步骤2、建立膝关节外骨骼无模型反演控制框架:采用极局部建模方式将系统的非线性和干扰统一地表达出来,建立包含干扰、控制通道增益的反演控制器;包括以下步骤:
步骤2.1、定义极局部模型:θj(v)(t)=F(t)+α(t)u(t) (2)
其中θj(t)和u(t)分别表示膝关节外骨骼系统的实际角度和信号输入;F(t)是系统的非线性和不确定性的总和;α(t)是控制通道增益;v表示系统的最高阶次,取1或者2;
步骤2.2、建立反演控制器:
其中表示对系统非线性和不确定性总和F(t)的估计;θref(t)表示膝关节外骨骼角度参考输入;z1表示膝关节外骨骼角度参考输入与实际角度状态的误差;z2表示膝关节外骨骼角加速度与虚拟控制a1表达式之间的误差;c1和c2表示两个大于0的参数;
步骤3、利用自适应时延估计方法估计出系统的非线性和干扰,从而补偿进入反演控制器中;具体包括以下步骤:
步骤3.1、采用极局部模型定义膝关节外骨骼人机交互的阻抗模型;
步骤3.2、对等式(2)进行延时比较:
其中表示F(t)的估计值;表示的前一段l时间内的状态;θj(t-l)分别表示θj(t)的前一段l时间内的状态;u(t-l)表示u(t)的前一段l时间内的状态;
步骤3.3、对等式(4)进行离散化处理并令v=1,将其转换成适用于计算机编程的离散形式:
其中表示的离散形式;θj(k-1)表示θj(t)的离散形式前一时刻;α(k)表示α(t)的离散形式;u(k-1)表示u(t)的离散形式前一时刻;k表示计数器的值;
步骤4、计算控制通道增益的估计值:利用递推最小二乘算法对控制通道增益进行估计,并将其代入时延估计中;包括以下步骤:
步骤4.1、对等式(2)的极局部模型进行离散化处理,保留自适应时延估计部分:
将等式(6)转换成如下形式:
其中
步骤4.2、基于最小二乘理论写出准则函数J的表达式:
其中p0=p(0)表示最小二乘递推因子p(k)的初始状态,p0-1表示p0的逆矩阵;表示的初始状态;每一个字符右上角的T表示矩阵的转置;
步骤4.3、根据等式(8)并使得经过矩阵的相关求解可以得到估计值的表达式:
其中,p(k)表示最小二乘递推因子,同时p(k-1)和p(k-2)表示p(k)前一时刻和前两个时刻的状态;
步骤4.4、由于α(k)在表达式的第二项,将其单独提取出来,可以得到α(k)的估计值的表达式;由于p(k)是一个矩阵,当内部成员都是实数时,矩阵p(k)退化成一个一维实数表达式,这里用p1(k)表示:
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于南京理工大学,未经南京理工大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910833948.8/1.html,转载请声明来源钻瓜专利网。