[发明专利]一种机械臂系统的鲁棒滑模自适应控制方法有效

专利信息
申请号: 201810741941.9 申请日: 2018-07-09
公开(公告)号: CN108983606B 公开(公告)日: 2021-04-27
发明(设计)人: 胡健;李向辉 申请(专利权)人: 南京理工大学
主分类号: G05B13/04 分类号: G05B13/04
代理公司: 南京理工大学专利中心 32203 代理人: 张祥
地址: 210094 *** 国省代码: 江苏;32
权利要求书: 查看更多 说明书: 查看更多
摘要: 发明公开了一种具有渐进跟踪性能的机械臂系统鲁棒滑模自适应控制方法,属于机械臂控制领域。该控制方法考虑了机械臂系统的参数等结构不确定性以及外干扰等非结构不确定性,并且针对参数等结构不确定性设计参数估计器;针对外干扰等非结构不确定性的上界设计出连续的鲁棒控制器;本发明所设计的鲁棒自适应控制器对同时存在参数等结构不确定性以及外干扰等非结构不确定性的机械臂系统有良好的作用,并能保证机械臂系统位置跟踪性能;本发明所设计的鲁棒滑模自适应控制器简单并且其控制输出连续,利于在工程实际中应用。
搜索关键词: 一种 机械 系统 鲁棒滑模 自适应 控制 方法
【主权项】:
1.一种机械臂鲁棒滑模自适应控制方法,其特征在于包括以下步骤:步骤1、建立机械臂系统的动力学模型,根据欧拉—拉格朗日方法,一个n自由度的机械臂系统动力学模型如下:公式(1)中q∈Rn分别为机械臂关节的速度、角速度和角加速度;H(q)∈Rn×n为机械臂系统的惯性矩阵;G(q)∈Rn,τ∈Rn分别表示向心科里奥利力、重力以及输入力矩:Fv为粘性摩擦系数,d∈Rn为外部干扰向量,包括系统的时变干扰和常值干扰,所述机械臂系统具有以下性质:性质1:H(q)是一个正定对称矩阵,满足:其中,m1和m2∈R是已知的有界正实数;性质2:机械臂惯性矩阵的微分矩阵和科里奥利矩阵的满足以下斜对称矩阵关系:性质3:机械臂动态模型相对于一组物理参数是线性的:其中,是机械臂关节回归矩阵,α=[κ,ρ,ε,μ]T是机械臂模型中的固有参数;所述机械臂系统还满足以下条件和引理:条件1:机械臂系统期望位置指令qd,它的一阶微分和二阶微分均是连续有界信号;条件2:机械臂不确定项干扰d有界,即||d||≤d0   (5)其中,d0是一个已知有界正常数;引理1.考虑一阶系统如下控制律在上述系统中达到有限时间稳定:θ=‑θ‑λθ‑μθq/p   (7)其中,θ为系统状态变量,λ和μ为正常数,q>0和p>0且q和p都为奇整数,满足q/p<1;因此,收敛时间ts为:引理2.有0≤xtanh(x/a)≤|x|   (8)引理3.或x>,y≥0有x/x+y≤1   (9);步骤2、设计机械臂滑模自适应鲁棒控制步骤如下:步骤2.1、定义所以qd是系统期望跟踪的位置指令且该指令二阶可微,设计一个滑模面,限制跟踪误差,保证误差收敛至0,其中Λ是一个常值矩阵,并且它的特征值严格位于右复半平面,设计虚拟参考轨迹qr代替期望轨迹qd,因此,就被替换为定义其中s=[s1,s2,…sn]T,为了避免滑模控制的抖动,设计控制律:其中λ1和μ1是正常数,q1>0和p1>0且同为整数奇数,并且满足q1/p1<1,根据公式(1)、(14)和(15)得到:根据式(16)可得:步骤2.2、设计控制律,结合公式(17)和性质1,基于机械臂系统动力学模型的控制律设计为:τ=τa+τs   (18)τs=τs1+τs2   (20)τs1=‑KDs   (21)其中,τa为模型前馈补偿项;τs1为线性反馈项;τs2为连续鲁棒项;KD是一个对称正定矩阵,为对角矩阵;是H(q),G(q)和Fv的估计值;步骤2.3、设计参数回归器及参数估计器,采用参数回归器的参数自适应律为:其中Γ为对角自适应律矩阵且Γ>0,γ为正常数,Γ和γ影响参数的自适应率;步骤2.4、根据条件2设计连续鲁棒项,克服系统干扰τs2=[τs21,τs22,…τs2n]T   (24)其中τs2i形式如下式(25)中,ki为已知正常数,ξ(t)满足以下条件其中δi*和δi都是正常数;步骤3、分析机械臂系统的稳定性,根据步骤2中设计的滑模自适应鲁棒控制方法,利用李雅普诺夫稳定性理论对系统进行稳定性证明,得到系统渐进稳定的结果:定义李雅普诺夫函数如下:其中并且Fv>0,对(27)式求导,得到将公式(16)、(18)‑(21)带入(28)根据机械臂性质2、3得到将自适应律(22)、(23)带入式(29)得将式(24)、(25)带入(30)根据引理2可得根据引理3可得其中,W是一个正函数,同时对公式(33)两侧积分,得到根据式(34)可得V(t)∈L,W∈L2,所以s,都有界,根据条件1,可知系统状态q有界,根据式(26),系统输出τ有界,并且可以得到W有界,因此W一致连续,根据Barbalat引理可知系统渐进稳定,根据引理1可得si∈s分别在有限时刻ti收敛至0,ti时刻如下证明:设计李雅普诺夫函数对(36)求导得到将公式(15)带入(37)得其中λ1和μ1为正常数,q1>0,q1>0且同为奇整数,所以在有限时刻ti时,si收敛至0。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。

该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于南京理工大学,未经南京理工大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服

本文链接:http://www.vipzhuanli.com/patent/201810741941.9/,转载请声明来源钻瓜专利网。

×

专利文献下载

说明:

1、专利原文基于中国国家知识产权局专利说明书;

2、支持发明专利 、实用新型专利、外观设计专利(升级中);

3、专利数据每周两次同步更新,支持Adobe PDF格式;

4、内容包括专利技术的结构示意图流程工艺图技术构造图

5、已全新升级为极速版,下载速度显著提升!欢迎使用!

请您登陆后,进行下载,点击【登陆】 【注册】

关于我们 寻求报道 投稿须知 广告合作 版权声明 网站地图 友情链接 企业标识 联系我们

钻瓜专利网在线咨询

周一至周五 9:00-18:00

咨询在线客服咨询在线客服
tel code