首页> 中国专利> 一种小车倒立摆系统的有限时间解耦控制方法

一种小车倒立摆系统的有限时间解耦控制方法

摘要

小车倒立摆系统的有限时间解耦控制方法,包括:建立四阶的小车倒立摆系统的动态模型,初始化系统状态、采样时间一集相关控制参数;将系统中的饱和函数近似为一个简单的时变系统,推导出带有饱和函数的系统模型;将小车倒立摆系统划分为两个二阶子系统,计算控制系统的跟踪误差、非奇异终端滑模面及其一阶导数;针对小车倒立摆系统,选择神经网络逼近未知函数,并根据系统跟踪误差、非奇异终端滑模面,设计神经网络有限时间解耦控制器,更新神经网络权值矩阵;本发明不仅能够避免饱和函数的影响,降低控制器的复杂程度,而且可以实现小车倒立摆系统在有限时间内的快速稳定。

著录项

  • 公开/公告号CN104267596A

    专利类型发明专利

  • 公开/公告日2015-01-07

    原文格式PDF

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

    申请/专利号CN201410403464.7

  • 发明设计人 陈强;汤筱晴;

    申请日2014-08-15

  • 分类号G05B13/04(20060101);

  • 代理机构33201 杭州天正专利事务所有限公司;

  • 代理人王兵;黄美娟

  • 地址 310014 浙江省杭州市下城区潮王路18号

  • 入库时间 2023-12-17 03:53:39

法律信息

  • 法律状态公告日

    法律状态信息

    法律状态

  • 2017-06-13

    授权

    授权

  • 2015-02-04

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

    实质审查的生效

  • 2015-01-07

    公开

    公开

说明书

技术领域

本发明涉及一种四阶非线性系统的有限时间解耦控制方法,特别是带有系统模型不确定 和饱和输入的四阶非线性系统的有限时间解耦控制方法。

背景技术

小车倒立摆系统作为受控对象是一种响应快、多变量、非线性、强耦合的自然不稳定系 统,是检验各种控制理论的理想模型。在控制过程中小车倒立摆系统能有效反映如稳定性、 鲁棒性以及跟踪性等许多控制中的问题。因此,对于小车倒立摆的研究长期以来都是国内外 学者研究的热门课题之一。

滑模控制也叫变结构控制,本质上是一类特殊的非线性控制,且非线性表现为控制的不 连续性。作为一种常用的非线性控制方法,滑模控制方法具有算法简单、响应速度快、对外 界噪声干扰和参数摄动鲁棒性强等优点。滑模控制系统的动态性能主要取决于滑动面的选 择,传统的滑模控制器设计只能保证系统状态在滑动面上的渐近收敛性。为了改善闭环系统 的收敛性能和抗扰动性能,一般在线性滑模的基础上增加非线性项,通过设计动态非线性滑 模面,即终端滑模面,实现系统的快速跟踪控制。当系统状态到达滑动面后可在有限时间内 滑动到原点,从而实现系统状态的有限时间收敛性。

然而,传统有限时间滑模控制一般针对二阶系统,因此对于四阶的小车倒立摆系统,需 要至少分别设计两个滑模控制器。目前的控制器设计方法分别针对小车和摆杆进行设计,增 加控制器的复杂程度。

发明内容

本发明要克服现有技术的上述缺点,提供一种有限时间解耦控制方法,首先将小车倒立 摆系统解耦为摆杆和小车两个二阶子系统,分别设计终端滑模面,其中第一个滑模面含有与 第二个滑模面相关的中间变量。然后,基于第一个滑模面设计控制器,降低控制器的复杂度, 同时保证摆杆和小车子系统在有限时间内稳定。

本发明所述的小车倒立摆系统的有限时间解耦控制方法,包含以下步骤:

步骤1,建立如式(1)所示四阶的小车倒立摆系统的动态模型,初始化系统状态、采样时 间一集相关控制参数;

x·1(t)=x2(t)x·2(t)=a1(x,t)+c1(x,t)v1(t)+d1(t)x·3(t)=x4(t)x·4(t)=a2(x,t)+c2(x,t)v2(t)+d2(t)---(1)

其中,x=[x1,x2,x3,x4]T是状态向量;a1(x,t),a2(x,t)≠0和是未知非线性函数;c1(x,t), c2(x,t)为以下非线性函数:

c1(x,t)=cos(x1)L(43mt-mpcos2(x1))---(2)

c2(x,t)=43(43mt-mpcos2(x1));---(3)

d1(t)和d2(t)表示外部干扰,并且,|d1(t)|≤D1(t),|d2(t)|≤D2(t);v1(t),v2(t)为饱 和函数输出值,表示为:

v(t)=sat(u)=sign(u)vmaxif|u(t)|vmaxuif|u(t)|<vmax---(4)

其中,u(t)∈R是实际控制信号;vmax为饱和函数宽度参数。

步骤2,将系统中的饱和函数近似为一个简单的时变系统,推导出带有饱和函数的系统 模型;

2.1将饱和函数近似为一双曲正切函数,定义为:

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

然后,sat(u)可被定义为:

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

2.2根据微分中值定理,可得

g(u)=g(u0)+g′(u)×(u-u0)         (7)

其中,g′(u)为g(u)在u处的一阶导数。

因此,当取u0=0时

g(u)=g′(u)×u          (8)

将式(8)代入式(6)得:

v=g(u)u+d(u),t0---(9)

2.3将简化后的饱和函数式(9)代入式(1)可得:

x·1(t)=x2(t)x·2(t)=f1(x,t)+b1(x,t)u1(t)+d1(t)x·3(t)=x4(t)x·4(t)=f2(x,t)+b2(x,t)u2(t)+d2(t)---(10)

其中,x1(t)是摆杆角位移,x2(t)是摆杆角速度;x3(t)是小车位移,x4(t)是小车速度;

x=[x1,x2,x3,x4]T为输入向量;f1(x,t),f2(x,t)≠0是未知非线性函数;

b1(x,t)=a1(x,t)×g′(u1),b2(x,t)=a2(x,t)×g′(u2)。

步骤3,将式(10)表示的小车倒立摆系统划分为两个二阶子系统,计算控制系统的跟踪 误差、非奇异终端滑模面及其一阶导数;

3.1将式(10)表示的小车倒立摆系统划分为两个二阶子系统

subsystem1:x·1(t)=x2(t)x·2(t)=f1(x,t)+b1(x,t)u1(t)+d1(t)---(11)

subsystem2:x·3(t)=x4(t)x·4(t)=f2(x,t)+b2(x,t)u2(t)+d2(t)---(12)

3.2定义如式(13)和(14)所示非线性滑模面:

S1=λ1|x1-z|γ1sign(x1-z)+x2---(13)

S2=λ2|x3|γ2sign(x3)+x4---(14)

其中,λ1和λ2是正常数;z是一个中间变量定义为z=sat(S2z)zu,0<zu<1,φz是 S2的界;0<(γ1=q1p1)<1,0<(γ2=q2p2)<1,p1,q1,p2和q2是正奇数满足p1>q1和p2>q2。因为(x1-z)<0和x3<0,分数γ1和γ2使得和因 此,不会产生奇异值问题。

3.3对式(13)进行微分,可得

S·1=γ1λ1|x1-z|γ1-1(x·1-z·)+x·2---(15)

为使系统在有限时间内趋于稳定,需要满足以下条件

S·1=k1S1+k2|S1|ρsign(S)---(16)

其中,0<ρ<1,k1>0并且k2>0。

根据有限时间稳定性定理可得,平衡点为x1=z并且x3=0。

步骤4,针对式(10)表示的小车倒立摆系统,选择神经网络逼近未知函数,并根据系统 跟踪误差、非奇异终端滑模面,设计神经网络有限时间解耦控制器,更新神经网络权值矩阵;

4.1将和式(15)代入式(16),解得控制信号u1(t)的 表达式为

u1(t)=-1b1(x,t)[f1(x,t)+γ1λ1|x1-z|γ1-1(x·1-z·)+k1S1+k2|S1|ρsign(S1)]---(17)

4.2设计神经网络逼近未知函数则有

f1(x,t)b1(x,t)=WTφ(X)+ϵ---(18)

其中,其中W为理想权重,φ(X)为神经网络基函数,X为神经网络输入向量,ε表示神 经网络逼近误差。φ(x)通常取为以下函数:

φ(X)=ab+exp(-Xc)+d---(19)

其中,a,b,c和d均为正常数;

将式(18)和式(19)代入式(17),可得

u1(t)=-W^Tφ(X)+μ^tanh(S1/δ)+-1b1(x,t)[γ1λ1|x1-z|γ1-1(x·1-z·)+k1S1+k2|S1|ρsign(S1)]---(20)

其中,为理想权重W的估计值,为自适应控制参数,δ为正常数;

其中,εN为一个正常数,表示神经网络逼近误差的上限。

4.3设计u2(t)=u1(t),则式(10)可转化为

x·1(t)=x2(t)x·2(t)=f1(x,t)+b1(x,t)u1(t)+d1(t)x·3(t)=x4(t)x·4(t)=f2(x,t)+b2(x,t)u1(t)+d2(t)---(21)

此时,摆杆与小车之间已解耦。

4.4设计神经网络权重和自适应控制参数的更新律为:

W^·=KCφ(X)S1T---(22)

其中,KC一个正常数;

μ^·=vμS1tanh(S1/δ)---(23)

其中,vμ一个正常数。

步骤5,设计李雅普诺夫函数则可以证明S1趋向于零,即 x1趋向于z;同时,式(13)中,z是一个有界衰减函数,根据以上设计可得,当S2=0时, z=0,x3=0;因此,可以证明闭环控制系统的稳定性。

本发明的技术构思为:针对带有模型不确定和饱和输入的四阶的小车倒立摆系统,简化 饱和函数结构,结合解耦的非奇异终端滑模和神经网络,设计一种小车倒立摆系统的有限时 间解耦控制方法。通过变换饱和函数模型,使饱和函数连续可微,再通过神经网络逼近未知 函数。同时,设计有限时间解耦控制器保证系统快速稳定。本发明提供一种能够使系统在有 限时间内快速趋于稳定,降低控制器的复杂程度,且有效避免饱和输入对系统影响的有限时 间解耦控制方法,可以实现小车倒立摆系统的快速稳定控制。

本发明的优点为:避免饱和影响,实现系统有限时间收敛,降低控制器的复杂程度。

附图说明

图1为本发明的饱和函数

图2为本发明的控制算法流程图

图3为本发明的四阶系统动态量x1的稳定效果

图4为本发明的四阶系统动态量x3的稳定效果

图5为本发明的控制器信号

具体实施方式

参照附图1-5,本发明所述的小车倒立摆系统的有限时间结耦控制方法,包括以下步 骤:

步骤1,建立如式(1)所示四阶的小车倒立摆系统的动态模型,初始化系统状态、采样时间一 集相关控制参数;

x·1(t)=x2(t)x·2(t)=a1(x,t)+c1(x,t)v1(t)+d1(t)x·3(t)=x4(t)x·4(t)=a2(x,t)+c2(x,t)v2(t)+d2(t)---(1)

其中,x=[x1,x2,x3,x4]T是状态向量;a1(x,t),a2(x,t)≠0和是未知非线性函数;c1(x,t), c2(x,t)为以下非线性函数:

c1(x,t)=cos(x1)L(43mt-mpcos2(x1))---(2)

c2(x,t)=43(43mt-mpcos2(x1));---(3)

d1(t)和d2(t)表示外部干扰,并且,|d1(t)|≤D1(t),|d2(t)|≤D2(t);v1(t),v2(t)为饱 和函数输出值,表示为:

v(t)=sat(u)=sign(u)vmaxif|u(t)|vmaxuif|u(t)|<vmax---(4)

其中,u(t)∈R是实际控制信号;vmax为饱和函数宽度参数。

步骤2,将系统中的饱和函数近似为一个简单的时变系统,推导出带有饱和函数的系统 模型;

2.1将饱和函数近似为一双曲正切函数,定义为:

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

然后,sat(u)可被定义为:

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

2.2根据微分中值定理,可得

g(u)=g(u0)+g′(u)×(u-u0)         (7)

其中,g′(u)为g(u)在u处的一阶导数。

因此,当取u0=0时

g(u)=g′(u)×u          (8)

将式(8)代入式(6)得:

v=g(u)u+d(u),t0---(9)

2.3将简化后的饱和函数式(9)代入式(1)可得:

x·1(t)=x2(t)x·2(t)=f1(x,t)+b1(x,t)u1(t)+d1(t)x·3(t)=x4(t)x·4(t)=f2(x,t)+b2(x,t)u2(t)+d2(t)---(10)

其中,x1(t)是摆杆角位移,x2(t)是摆杆角速度;x3(t)是小车位移,x4(t)是小车速度;

x=[x1,x2,x3,x4]T为输入向量;f1(x,t),f2(x,t)≠0是未知非线性函数;

b1(x,t)=a1(x,t)×g′(u1),b2(x,t)=a2(x,t)×g′(u2)。

步骤3,将式(10)表示的小车倒立摆系统划分为两个二阶子系统,计算控制系统的跟踪 误差、非奇异终端滑模面及其一阶导数;

3.1将式(10)表示的小车倒立摆系统划分为两个二阶子系统

subsystem1:x·1(t)=x2(t)x·2(t)=f1(x,t)+b1(x,t)u1(t)+d1(t)---(11)

subsystem2:x·3(t)=x4(t)x·4(t)=f2(x,t)+b2(x,t)u2(t)+d2(t)---(12)

3.2定义如式(13)和(14)所示非线性滑模面:

S1=λ1|x1-z|γ1sign(x1-z)+x2---(13)

S2=λ2|x3|γ2sign(x3)+x4---(14)

其中,λ1和λ2是正常数;z是一个中间变量定义为z=sat(S2z)zu,0<zu<1,φz是 S2的界;0<(γ1=q1p1)<1,0<(γ2=q2p2)<1,p1,q1,p2和q2是正奇数满足p1>q1和p2>q2。因为(x1-z)<0和x3<0,分数γ1和γ2使得和因 此,不会产生奇异值问题。

3.3对式(13)进行微分,可得

S·1=γ1λ1|x1-z|γ1-1(x·1-z·)+x·2---(15)

为使系统在有限时间内趋于稳定,需要满足以下条件

S·1=k1S1+k2|S1|ρsign(S)---(16)

其中,0<ρ<1,k1>0并且k2>0。

根据有限时间稳定性定理可得,平衡点为x1=z并且x3=0。

步骤4,针对式(10)表示的小车倒立摆系统,选择神经网络逼近未知函数,并根据系统 跟踪误差、非奇异终端滑模面,设计神经网络有限时间解耦控制器,更新神经网络权值矩阵;

4.1将和式(15)代入式(16),解得控制信号u1(t)的 表达式为

u1(t)=-1b1(x,t)[f1(x,t)+γ1λ1|x1-z|γ1-1(x·1-z·)+k1S1+k2|S1|ρsign(S1)]---(17)

4.2设计神经网络逼近未知函数则有

f1(x,t)b1(x,t)=WTφ(X)+ϵ---(18)

其中,其中W为理想权重,φ(X)为神经网络基函数,X为神经网络输入向量,ε表示神 经网络逼近误差。φ(x)通常取为以下函数:

φ(X)=ab+exp(-Xc)+d---(19)

其中,a,b,c和d均为正常数;

将式(18)和式(19)代入式(17),可得

u1(t)=-W^Tφ(X)+μ^tanh(S1/δ)+-1b1(x,t)[γ1λ1|x1-z|γ1-1(x·1-z·)+k1S1+k2|S1|ρsign(S1)]---(20)

其中,为理想权重W的估计值,为自适应控制参数,δ为正常数;

其中,εN为一个正常数,表示神经网络逼近误差的上限。

4.3设计u2(t)=u1(t),则式(10)可转化为

x·1(t)=x2(t)x·2(t)=f1(x,t)+b1(x,t)u1(t)+d1(t)x·3(t)=x4(t)x·4(t)=f2(x,t)+b2(x,t)u1(t)+d2(t)---(21)

此时,摆杆与小车之间已解耦。

4.4设计神经网络权重和自适应控制参数的更新律为:

W^·=KCφ(X)S1T---(22)

其中,KC一个正常数;

μ=vμ^·S1tanh(S1/δ)---(23)

其中,vμ一个正常数。

步骤5,设计李雅普诺夫函数则可以证明S1趋向于零,即 x1趋向于z;同时,式(13)中,z是一个有界衰减函数,根据以上设计可得,当S2=0时, z=0,x3=0;因此,可以证明闭环控制系统的稳定性。

为验证所提方法的有效性,进行了如下实验:

式(1)表示的小车倒立摆模型为:

x·1(t)=x2(t)x·2(t)=a1(x,t)+c1(x,t)v1(t)+d1(t)x·3(t)=x4(t)x·4(t)=a2(x,t)+c2(x,t)v2(t)+d2(t)---(1)

其中,

a1(x,t)=mtgsin(x1)_mpLsin(x1)cos(x1)x22L(43mt-mpcos2(x1))

a2(x,t)=-43mpLx22sin(x1)+mpgsin(x1)cos(x1)43mt-mpcos2(x1)

c1(x,t)=cos(x1)L(43mt-mpcos2(x1))

c2(x,t)=43(43mt-mpcos2(x1));

其中,mp=0.1kg,mt=1kg,L=1m,g=9.8m/s2

控制器设计中的相关参数选择为:在式(13)和式(14)表示的滑模面中,λ1=5,λ2=0.5, zu=0.9425,φz=15;在控制器式(20)中ρ=0.8,k1=10 并且k2=10。神经网络中函数式(19)的参数a=2,b=10,c=1和d=-10;更新律中 KC=0.1,vμ=0.01。

图3为四阶系统动态量x1的稳定效果;图4为四阶系统动态量x3的稳定效果;图5为控制 器信号。从图3和图4可以看出,根据式(21)设计的有限时间解耦控制器可以使摆杆角在7s左 右稳定,使小车在15s左右稳定。从图5可以看出,饱和函数对控制器有限制作用,实际控制 信号在20秒后抖振减小,幅值减小。因此本发明所提供的有限时间解耦控制器不仅能够避免 饱和函数的影响,降低控制器的复杂程度,而且可以实现小车倒立摆系统在有限时间内的快 速稳定。

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

去获取专利,查看全文>

相似文献

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

客服邮箱:kefu@zhangqiaokeyan.com

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

  • 服务号