首页> 中国专利> 基于神经网络动态面滑模控制的机械臂系统饱和补偿控制方法

基于神经网络动态面滑模控制的机械臂系统饱和补偿控制方法

摘要

一种基于神经网络动态面滑模控制的机械臂系统饱和补偿控制方法,包括:建立机械臂伺服系统的动态模型,初始化系统状态、采样时间以及控制参数;根据微分中值定理,将系统中的非线性输入饱和线性化处理,推导出带有未知饱和的机械臂伺服系统模型;基于动态面滑模控制方法,计算控制系统跟踪误差,滑模面及微分。本发明提供一种能够有效补偿未知饱和,避免反演法带来的复杂度爆炸问题的神经网络动态面滑模控制方法,实现系统的稳定快速跟踪。

著录项

  • 公开/公告号CN105223808A

    专利类型发明专利

  • 公开/公告日2016-01-06

    原文格式PDF

  • 申请/专利权人 浙江工业大学;

    申请/专利号CN201510351699.0

  • 发明设计人 陈强;施琳琳;

    申请日2015-06-24

  • 分类号G05B13/04(20060101);

  • 代理机构33241 杭州斯可睿专利事务所有限公司;

  • 代理人王利强

  • 地址 310014 浙江省杭州市下城区朝晖六区潮王路18号浙江工业大学

  • 入库时间 2023-12-18 13:18:56

法律信息

  • 法律状态公告日

    法律状态信息

    法律状态

  • 2017-12-05

    授权

    授权

  • 2016-02-03

    实质审查的生效 IPC(主分类):G05B13/04 申请日:20150624

    实质审查的生效

  • 2016-01-06

    公开

    公开

说明书

技术领域

本发明涉及一种基于神经网络动态面滑模控制的机械臂系统饱和补偿控制 方法,特别是带有输入饱和约束的机械臂伺服系统的控制方法。

背景技术

机械臂伺服系统在机器人、航空飞行器等高性能系统中得到了广泛的应用, 如何实现机械臂伺服系统的快速精确控制已经成为了一个热点问题。机器臂的轨 迹跟踪控制系统与柔性机械臂问题受到越来越多的重视。然而,未知饱和非线性 环节广泛存在于机械臂伺服系统中,往往会导致控制系统的效率降低甚至是失 效。因此,输入饱和的约束必须考虑在控制器设计过程中。针对机械臂伺服系统 的控制问题,存在很多控制方法,例如PID控制,自适应控制,滑模控制等。

滑模控制在解决系统不确定性和外部扰动方面被认为是一个有效的鲁棒控 制方法。滑模控制方法具有算法简单、响应速度快、对外界噪声干扰和参数摄动 鲁棒性强等优点。然而,滑模控制在设计过程中需要满足匹配条件,实际系统匹 配条件的不确定性成为了滑模控制设计的障碍。反演法具有改善滑模控制器性 能,放松匹配条件的优点。将滑模控制与反演法相结合,在控制器的每一步设计 中引入虚拟控制变量。然而,反演法将引入复杂度爆炸的问题。因此,采用动态 面滑模控制,使系统的控制器输入变得简单,成为了一个重要的研究方向。

饱和非线性环节广泛存在于机械臂伺服系统、液压伺服系统以及其他工业工 程领域。饱和的存在往往会导致控制系统的效率降低甚至是失效。因此,为提高 控制性能,针对饱和的补偿和控制方法必不可少。传统的饱和补偿方法一般是建 立饱和的逆模型或近似逆模型,并通过估计饱和的上下界参数设计自适应控制 器,以补偿饱和的影响。然而,在机械臂伺服系统等非线性系统中,饱和的逆模 型往往不易精确获得。对于系统中存在的未知饱和输入,基于微分中值定理经行 线性化,使其成为一个简单的时变系统,避免了附加补偿。神经网络广泛应用于 处理系统的非线性和不确定性,并取得了良好的控制效果。从而可以利用神经网 络逼近未知函数和系统模型的未知参数,同时避免反演法带来的复杂度爆炸问题 提高系统的跟踪控制性能。

发明内容

为了克服现有的机械臂伺服系统的无法有效地饱和补偿,模型参数不确定 性,以及反演法带来的复杂度爆炸等的不足,本发明提供一种基于神经网络动态 面滑模控制的机械臂系统饱和补偿控制方法,简化了控制器的设计结构,实现了 带饱和输入的机械臂系统位置跟踪控制,保证系统稳定快速跟踪。

为了解决上述技术问题提出的技术方案如下:

一种基于动态面滑模控制的机械臂系统饱和补偿控制方法,包括以下步骤:

步骤1,建立机械臂伺服系统的动态模型,初始化系统状态、采样时间以 及控制参数,过程如下:

1.1机械臂伺服系统的动态模型表达形式为

Iq··+K(q-θ)+MgLsin(q)=0Jθ··-K(q-θ)=v(u)---(1)

其中,q和θ分别为机械臂连杆和电机的角度;g为重力加速度;I为连杆的惯量; J是电机的惯量;K为弹簧刚度系数;M和L分别是连杆的质量和长度;u是控 制信号;v(u)为饱和,表示为:

v(u)=sat(u)=vmaxsgn(u),|u|vmaxu,|u|vmax---(2)

其中sgn(u),为未知非线性函数;vmax为未知饱和参数,满足vmax>0;

定义x1=q,x3=θ,式(1)改写为

x·1=x2x·2=-MgLIsin(x1)-KI(x1-x3)x·3=x4x·4=1Jv(u)+KJ(x1-x3)y=x1.---(3)

其中,y为系统输出轨迹;

1.2定义变量z1=x1,z2=x2z4=-x2MgLIcos(x1)-KI(x2-x4),则式(3)改写成

z·1=z2z·2=z3z·3=z4z·4=f1(z)+b1v(u)y=z1---(4)

其中,z=[z1,z2,z3]T,f1(z)=MgLIsin(z1)(z22-KJ)-(MgLIcos(z1)+KJ+KI)z3,b1=KIJ;

步骤2,根据微分中值定理,将系统中的非线性输入饱和进行线性化处理, 推导出带有未知饱和的机械臂伺服系统模型,过程如下:

2.1对饱和模型进行光滑处理

g(u)=vmax×tanh(uvmax)=vmax×eu/vmax-e-u/vmaxeu/vma×+e-u/vmax---(5)

v(u)=sat(u)=g(u)+d(u)(6)

其中,d(u)表示光滑函数与饱和模型之间存在的误差;

2.2根据微分中值定理,存在δ∈(0,1)使

g(u)=g(u0)+guξ(u-u0)---(7)

其中guξ=g(u)u|u=uξ>0,uξ=ξu+(1-ξ)u0,u0∈(0,u);

选择u0=0,将式(7)改写为

g(u)=guξu---(8)

2.2由式(6)和式(8),将式(4)改写为以下等效形式:

z·1=z2z·2=z3z·3=z4z·4=f2(z)+b2uy=z1---(9)

其中,f2(z)=f1(z)+d(u),b2=b1×guξ;

步骤3,计算控制系统跟踪误差,滑模面及微分,过程如下:

3.1定义控制系统的跟踪误差,滑模面为

e=y-yds1=e+λe>dt---(10)

其中,yd为二阶可导期望轨迹,λ为常数,且λ>0;

3.2对式(10)求导得:

{e·=y·-y·d=z2-y·ds·1=e·+λe=z2-y·d+λe---(11)

3.3设计虚拟控制量

z2=-k1s1+y·d-λe---(12)

其中,k1为常数,且k1>0;

3.4定义一个新的变量β2,让虚拟控制量通过时间常数为τ2的一阶滤波 器:

τ2β·2+β2=z2,β2(0)=z2(0)---(13)

3.5定义则

β·2=z2-β2τ2=-y2τ2---(14)

步骤4,针对式(4),设计虚拟控制量,过程如下:

4.1定义误差变量

si=zii,i=2,3(15)

式(15)的一阶微分为

s·i=zi+1-β·i,i=2,3---(16)

4.2设计虚拟控制量

zi+1=-kisi-si-1+β·i---(17)

其中,ki为常数,且ki>0;

4.3定义一个新的变量βi+1,让虚拟控制量通过时间常数为τ2的一阶滤波 器:

τi+1β·i+1+βi+1=zi+1,βi+1(0)=zi+1(0)---(18)

4.4定义yi+1=βi+1-zi+1,

β·i+1=zi+1-βi+1τi+1=-yi+1τi+1---(19)

步骤5,设计控制器输入,过程如下:

5.1定义误差变量

s4=z44(20)

计算式(20)的一阶微分为

s·4=f2(z)+b2u-β·4---(21)

5.2为了逼近不能直接得到的非线性不确定项以及b2,定义以 下神经网络

其中,W*为理想权重,ε*为神经网络理想误差 值,满足|ε*|≤εN,表达式为:

其中,a,b,c,d为常数;

5.3设计控制器输入u:

其中,为理想权重W的估计值,为理想误差上界ε*的估计值;

5.4设计自适应率:

其中,Γ=ΓT>0,Γ3是自适应增益矩阵,σ,vεN都 是常数,且σ>0,vεN>0;

步骤6,设计李雅普诺夫函数

V=12Σi=13(si2+yi+12)+12b2s42+12W~TΓ-1W~+12vϵNϵ~N2---(26)

对式(26)进行求导得:

V·=Σi=13(sis·i+yi+1y·i+1)+1b2s4s·4+W~TΓ-1W^·+1vϵNϵ~Nϵ^·N---(27)

如果则判定系统是稳定的。

本发明基于神经网络,动态面滑模控制方法,考虑输入未知饱和情况下,设 计机械臂伺服系统的饱和补偿的控制方法,实现系统的稳定跟踪,保证跟踪误差 在有限时间收敛。

本发明的技术构思为:针对状态不可测,并且带有未知饱和输入的机械臂伺 服系统,利用微分中值定理优化饱和结构,提出基于饱和模型的机械臂伺服系统。 再结合神经网络、自适应控制以及动态面滑模控制,设计一种机械臂伺服系统的 饱和补偿控制方法。通过微分中值定理,使饱和连续可微,再通过神经网络逼近 未知函数,取消了传统饱和的附加补偿。并且利用动态面滑模设计虚拟误差变量, 避免了反演法所带来的复杂度爆炸问题,实现系统的位置跟踪控制。本发明提供 一种能够有效补偿未知饱和,避免反演法带来的复杂度爆炸问题的神经网络动态 面滑模控制方法,实现系统的稳定快速跟踪。

本发明的优点为:避免未知饱和输入对系统位置跟踪控制性能的影响,以及 反演法带来的复杂度爆炸问题,补偿系统未知模型不确定项,实现系统的位置跟 踪。

附图说明

图1为本发明的非线性饱和的示意图;

图2为本发明的跟踪效果的示意图;

图3为本发明的跟踪误差的示意图;

图4为本发明的控制器输入的示意图;

图5为本发明的控制流程图。

具体实施方式

下面结合附图对本发明做进一步说明。

参照图1-图5,一种基于神经网络动态面滑模控制的机械臂系统饱和补偿控制 方法,包括以下步骤:

步骤1,建立机械臂伺服系统的动态模型,初始化系统状态、采样时间以 及控制参数,过程如下:

1.1机械臂伺服系统的动态模型表达形式为

Iq··+K(q-θ)+MgLsin(q)=0Jθ··-K(q-θ)=v(u)---(1)

其中,q和θ分别为机械臂连杆和电机的角度;g为重力加速度;I为连杆的惯量; J是电机的惯量;K为弹簧刚度系数;M和L分别是连杆的质量和长度;u是控 制信号;v(u)为饱和,表示为:

v(u)=sat(u)=vmaxsgn(u),|u|vmaxu,|u|vmax---(2)

其中sgn(u),为未知非线性函数;vmax为未知饱和参数,满足vmax>0;

定义x1=q,x3=θ,式(1)改写为

x·1=x2x·2=-MgLIsin(x1)-KI(x1-x3)x·3=x4x·4=1Jv(u)+KJ(x1-x3)y=x1.---(3)

其中,y为系统输出轨迹;

1.2定义变量z1=x1,z2=x2z4=-x2MgLIcos(x1)-KI(x2-x4),则式(3)改写成

z·1=z2z·2=z3z·3=z4z·4=f1(z)+b1v(u)y=z1---(4)

其中,z=[z1,z2,z3]T,f1(z)=MgLIsin(z1)(z22-KJ)-(MgLIcos(z1)+KJ+KI)z3,b1=KIJ;

步骤2,根据微分中值定理,将系统中的非线性输入饱和进行线性化处理, 推导出带有未知饱和的机械臂伺服系统模型,过程如下:

2.1对饱和模型进行光滑处理

g(u)=vmax×tanh(uvmax)=vmax×eu/vmax-e-u/vmaxeu/vma×+e-u/vmax---(5)

v(u)=sat(u)=g(u)+d(u)(6)

其中,d(u)表示光滑函数与饱和模型之间存在的误差;

2.2根据微分中值定理,存在δ∈(0,1)使

g(u)=g(u0)+guξ(u-u0)---(7)

其中guξ=g(u)u|u=uξ>0,uξ=ξu+(1-ξ)u0,u0∈(0,u);

选择u0=0,将式(7)改写为

g(u)=guξu---(8)

2.2由式(6)和式(8),将式(4)改写为以下等效形式:

z·1=z2z·2=z3z·3=z4z·4=f2(z)+b2uy=z1---(9)

其中,f2(z)=f1(z)+d(u),b2=b1×guξ;

步骤3,计算控制系统跟踪误差,滑模面及微分,过程如下:

3.1定义控制系统的跟踪误差,滑模面为

e=y-yds1=e+λe>dt---(10)

其中,yd为二阶可导期望轨迹,λ为常数,且λ>0;

3.2对式(10)求导得:

{e·=y·-y·d=z2-y·ds·1=e·+λe=z2-y·d+λe---(11)

3.3设计虚拟控制量

z2=-k1s1+y·d-λe---(12)

其中,k1为常数,且k1>0;

3.4定义一个新的变量β2,让虚拟控制量通过时间常数为τ2的一阶滤波 器:

τ2β·2+β2=z2,β2(0)=z2(0)---(13)

3.5定义y2=β2-z2,

β·2=z2-β2τ2=-y2τ2---(14)

步骤4,针对式(4),设计虚拟控制量,过程如下:

4.1定义误差变量

si=zii,i=2,3(15)

式(15)的一阶微分为

s·i=zi+1-β·i,i=2,3---(16)

4.2设计虚拟控制量

zi+1=-kisi-si-1+β·i---(17)

其中,ki为常数,且ki>0;

4.3定义一个新的变量βi+1,让虚拟控制量通过时间常数为τ2的一阶滤波 器:

τi+1β·i+1+βi+1=zi+1,βi+1(0)=zi+1(0)---(18)

4.4定义yi+1=βi+1-zi+1,

β·i+1=zi+1-βi+1τi+1=-yi+1τi+1---(19)

步骤5,设计控制器输入,过程如下:

5.1定义误差变量

s4=z44(20)

计算式(20)的一阶微分为

s·4=f2(z)+b2u-β·4---(21)

5.2为了逼近不能直接得到的非线性不确定项以及b2,定义以 下神经网络

其中,W*为理想权重,ε*为神经网络理想误差 值,满足|ε*|≤εN,表达式为:

其中,a,b,c,d为常数;

5.3设计控制器输入u:

其中,为理想权重W的估计值,为理想误差上界ε*的估计值;

5.4设计自适应率:

其中,Γ=ΓT>0,Γ3是自适应增益矩阵,σ,vεN都 是常数,且σ>0,vεN>0;

步骤6,设计李雅普诺夫函数

V=12Σi=13(si2+yi+12)+12b2s42+12W~TΓ-1W~+12vϵNϵ~N2---(26)

对式(26)进行求导得:

V·=Σi=13(sis·i+yi+1y·i+1)+1b2s4s·4+W~TΓ-1W^·+1vϵNϵ~Nϵ^·N---(27)

如果则判定系统是稳定的。

为验证所提方法的有效性,本发明给出了三种控制方法的对比:带饱和补偿 的动态面滑模控制方法(S1)、不带饱和补偿的动态面滑模控制方法(S2)以及 不带饱和补偿的动态面控制方法(S3)。

为了更有效的进行对比,所有参数设置都是一致的系统初始化参数为 [x1,x2,x3,x4]T=[0,0,0,0]T,[β234]T=[0,0,0]T;神经网络参数为Γ=diag{5},a=10, b=10,c=1,d=-1;自适应控制率参数为vεN=0.1,σ=0.01,δ=0.1;一阶滤波 器的时间常数参数为t2=t3=t4=0.02;系统模型参数为Mgl=5,I=1,J=1,K=40, I=1;控制器参数为k1=0.5,k2=8,k3=8,k4=2,λ=7。

跟踪梯形波输入,其表达式如式(28)。S1的控制器饱和输入vmax=75,S2、S3 控制器输入为vmax=295。由图2可以看出,S1的跟踪效果比S2、S3更好,S2最后 不能实现系统的稳定收敛;从图3可以看出,S1方法的跟踪稳态误差最小。从图4 可以看出,在带有饱和输入控制器情况下,即使饱和限制较大,仍能实现系统的 稳定跟踪。因此,本发明提供一种能够有效补偿未知饱和,避免反演法带来的复 杂度爆炸问题的神经网络动态面滑模控制方法,实现系统的稳定快速跟踪。

yd={0,0t<25(t-2),2t<410,4t<6-5(t-8),6t<10-10,10t<12-5(t-14),12t<1610,16t<18-5(t-20),18t20---(28)

以上阐述的是本发明给出的一个实施例表现出的优良优化效果,显然本发明 不只是限于上述实施例,在不偏离本发明基本精神及不超出本发明实质内容所涉 及范围的前提下对其可作种种变形加以实施。

去获取专利,查看全文>

相似文献

  • 专利
  • 中文文献
  • 外文文献
获取专利

客服邮箱:kefu@zhangqiaokeyan.com

京公网安备:11010802029741号 ICP备案号:京ICP备15016152号-6 六维联合信息科技 (北京) 有限公司©版权所有
  • 客服微信

  • 服务号