[发明专利]一种基于有限时间扰动观测器的反演滑模机械臂控制器设计方法有效
申请号: | 201910810166.2 | 申请日: | 2019-08-29 |
公开(公告)号: | CN110421569B | 公开(公告)日: | 2023-01-31 |
发明(设计)人: | 赵静;郦泽云;王弦;牛友臣 | 申请(专利权)人: | 南京邮电大学 |
主分类号: | B25J9/16 | 分类号: | B25J9/16;G05B13/04 |
代理公司: | 南京正联知识产权代理有限公司 32243 | 代理人: | 张玉红 |
地址: | 210023 *** | 国省代码: | 江苏;32 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 基于 有限 时间 扰动 观测器 反演 机械 控制器 设计 方法 | ||
1.一种基于有限时间扰动观测器的反演滑模机械臂控制器设计方法,其特征在于:包括如下步骤:
步骤1:建立空间机械臂动力学通用模型;
步骤1中,所述通用模型具体如下:
其中q∈Rn,分别代表了位置矢量、速度矢量、加速度矢量;Rn表示n维向量空间;M(q)∈Rn×n为对称正定惯性矩阵,代表了哥氏力和离心力矩阵,G(q)∈Rn×1表示重力矢量,表示外部扰动引起的不确定项,τ代表了控制力矩矢量;
步骤2:为了方便控制律的应用,将该模型转化;
步骤2中,将该模型转化为如下的具体形式:
其中,x=[q1 q2]T,X=[x z]T,h(x)=M-1,u=τ,D为外部扰动;
步骤3:根据步骤2中转化后的模型中的外部扰动,建立有限时间扰动观测器;
步骤3中,假设D是有界的,并且假设D<ι,ι>0,针对具有上界的扰动,建立有限时间扰动观测器,具体如下:
其中,l1>0,是ι的估计值,并且其中的κ>0,而p,q都是正奇数,且p<q,是对D的估计值;
步骤4:对机械臂的扰动观测器稳定性采用Lyapunov稳定性理论进行验证;
步骤5:对于机械臂的全局稳定性采用Lyapunov稳定性理论进行验证。
2.根据权利要求1所述的一种基于有限时间扰动观测器的反演滑模机械臂控制器设计方法,其特征在于:步骤4中,利用Lyapunov稳定性理论,设计Lyapunov函数证明观测器的稳定性,具体包括以下步骤:
定义Lyapunov函数:
其中对Lyapunov函数进行求导,则:
引理1:对于任意数字xi,i=1,…n并且0b1,下面不等式成立:
(∣x1∣+···+∣xn∣)b≤∣x1∣b+···+∣xn∣b
根据引理1得:当正标量时,以下的不等式成立:
所以,
其中
因为κ>0,0<p<q,所以ζ>0,且再根据引理1,以下的不等式成立:
得所以
其中所以上述式子写为:则假设有限时间稳定性即可被保证;
再根据引理2:
其中ψ∈(0,1),ζ∈R+,V(x0)是V(x)的初值;
得当初试时间定义为T1,并且时间大于初始时间时,该值将收敛于
最终得证由此得到扰动观测器部分是稳定的。
3.根据权利要求1所述的一种基于有限时间扰动观测器的反演滑模机械臂控制器设计方法,其特征在于:步骤5中,利用Lyapunov稳定性理论,设计Lyapunov函数证明系统全局的稳定性,具体包括以下步骤:
步骤5-1,提出e1=x-xd,e2=z-ε;
其中,J是正常数,xd是期望关节位置向量;
步骤5-2,同时为了提高系统状态远离滑模平面时的到达性能,设计趋近律为
其中,θ1>0,θ2>0,c>0,0<β<1,γ>1;
步骤5-3,定义动态滑模面的Lyapunov函数:
其中,是滑模面,其中λ=diag(λ1,λ2)是正常数,对Lyapunov函数进行求导,则:
将h(x)u代入得:
得
因为r和c都是正的常数,所以得证即可证明系统的全局稳定性。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于南京邮电大学,未经南京邮电大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910810166.2/1.html,转载请声明来源钻瓜专利网。