一种带有未知滞环的小车倒立摆系统积分滑模控制方法
【专利摘要】一种带有未知滞环的小车倒立摆系统积分滑模控制方法，包括：建立倒立摆系统的动态模型，结合滞环并将其进行等效变换，初始化系统状态、采样时间以及控制参数；结合滑模控制及反演法，在每一步设计中引入虚拟控制变量，最后推导出自适应控制器输入；同时，利用Nussbaum函数的特性，解决了控制方向未知的问题；计算控制系统跟踪误差，积分滑模面，误差变量及微分。本发明提供一种能够有效改善倒立摆系统位置的滑模控制方法，保证系统的倒立摆系统快速稳定收敛至零点，有效消除滑模控制中的抖振问题。
【专利说明】
一种带有未知滞环的小车倒立摆系统积分滑模控制方法
技术领域
[0001] 本发明涉及一种倒立摆系统滑模控制方法，特别是带有未知滞环的小车倒立摆系 统的积分滑模控制方法。
【背景技术】
[0002] 倒立摆是一种典型的多变量、强耦合非线性系统。然而，近年来的研究表明，倒立 摆控制方向在一定条件下是未知的，未知的控制方向使控制器的设计成为了难题。因此，如 何设计控制方向未知的非线性系统的控制器已成为控制中亟待解决的关键问题之一。
[0003] 滑模变结构控制（Sliding Mode Control，SMC)由于对系统数学模型要求不高，且 对系统参数摄动、外部扰动具有较强的鲁棒性，被广泛应用于混沌控制研究中。但传统的滑 模控制方法中由于控制增益的过高以及符号函数的存在，导致其存在一定的抖振问题，影 响了实际应用。目前，在消除抖振研究方面，各种改进的滑模控制方法已被提出，如用积分 滑模控制器，取得了良好的效果。
【发明内容】
[0004] 为了克服现有倒立摆系统在一定参数条件下控制方向未知、无法消除滑模控制中 的抖振问题的不足，本发明提供一种基于扩张状态观测器的倒立摆系统积分滑模控制方 法，取消系统所有状态完全可测的限制，采用扩张状态观测器估计系统状态以及不确定项， 并基于估计值设计积分滑模控制器，结合Nussbaum函数，解决控制方向未知的问题，保证系 统快速稳定收敛至零点。
[0005] 为了解决上述技术问题提出的技术方案如下：
[0006] -种带有未知滞环的小车倒立摆系统积分滑模控制方法，所述控制方法包括以下 步骤：
[0007] 步骤1，建立倒立摆系统的模型，初始化系统状态以及控制参数，所述的倒立摆系 统能描述为：
[0008] (1)
[0009]
[0010] "、 (2)
[0011] 其中，X1 =么，7 = 1(〇却，11(〇卽分别表示系统状态，倒立摆状态和倒立摆 控制信号；Θ表示位置，m表示倒立摆质量，m。表示小车质量，1表示倒立摆长度，d (t)表示未 知干扰，H(U)表示滞环，即Η(?!)=μη!+μ2ζ，其中是符号相同的常数；
[0012] 步骤2,将倒立摆模型转变为更适宜自适应扩张状态观测器设计的形式，过程如 下：
[0013] 2.1，将式(2)转换成如下形式：
[0014]
[0015]
[0016] 2.2,令ao = a(x)+ Δ bu，Δ b = g〇-bo,其中bo为go的估计值，基于扩张状态观测器的 设计思想，通过定义扩展状态X3 = ao,则式(3)改写为以下等效形式：
[0017] (4)
[0018]
[0019] 步骤3，设计滤波器，过程如下：
[0020] 令yi = n〇,i+g()ni,i+ei，i = l，2,3分别为式(4)中状态变量Xi的观测值，定义观测误 差为yi_Xl，则自适应扩张状态观测器表达式为：
[0021]
[0022]
[0023]
[0024]
[0025] 步骤4，基于扩张状态观测器，设计滑模控制器，过程如下：
[0026] 4.1，定义跟踪误差e为
[0027] e = yi-yd (8)
[0028] 其中yd为期望轨迹；
[0029] 4.2,根据式(8)，设计如下滑模面：
[0030] si = e+Ajedt (9)其中，λ 为控制参数，λ>〇;
[0031] 对(8)和(9)求导得到： _2] _
[0033] 由（5)和(6)的定义得：
[0034] (U)
[0035]
[0036] (12)
[0037] 4.3设计虚拟控制率：
[0038]
[0039]
[0040]
[0041 ] 其中Φ满足
[0042]
[0043]
[0044]
[0045]
[0046]
[0047]
[0048]
[0049] 将(17)代入(12)得：
[0055] P〇Ao+AoPo = -I (21)[0056] 计算(19)的微分，得到：
[0050]
[0051]
[0052]
[0053]
[0054]
如果A s ο，则系统是稳定的。
[0072] 本发明结合扩张状态观测器技术和积分滑模控制技术，设计带有未知滞环的小车 倒立摆系统积分滑模控制方法，抑制滑模控制中的抖振问题，结合Nussbaum函数，解决控制 方向未知的问题，保证系统的混沌状态快速稳定收敛至零点。
[0073] 本发明的技术构思为:倒立摆在一定条件下控制方向不可知。针对部分控制方向 未知的倒立摆系统，结合积分滑模控制和扩张状态观测器理论，设计一种倒立摆系统积分 滑模控制方法，取消了系统所有状态完全可测的限制。利用Nussbaum函数，解决了滞环方向 未知的问题。在系统部分状态和非线性不确定项上界均未知的情况下，基于扩张状态观测 器估计系统未知状态及不确定项，并设计积分滑模控制器保证系统状态快速稳定收敛至零 点。本发明提供一种能够改善滑模控制抖振问题并提高系统控制精度及鲁棒性的倒立摆系 统积分滑模控制方法。确保在系统部分状态不可测的情况下，并保证系统的混沌状态快速 稳定收敛至零点。
[0074] 本发明的优点为:保证系统的倒立摆系统快速稳定收敛至零点，有效消除滑模控 制中的抖振问题。
【附图说明】
[0075] 图1为本发明的控制算法流程图；
[0076]图2为本发明的信号跟踪效果示意图；
[0077]图3为本发明的信号估计误差示意图；
[0078]图4为本发明的估计参数示意图；
[0079]图5为本发明的控制信号示意图。
【具体实施方式】
[0080]下面结合附图对本发明做进一步说明。
[0081 ]参照图1-图5，一种带有未知滞环的倒立摆系统积分滑模控制方法，
[0082]所述控制方法包括以下步骤：
[0083]步骤1，建立倒立摆系统的模型，初始化系统状态以及控制参数，所述的倒立摆系 统能描述为：
[0084]
[0085]
[0086]
[0087] 其中= 6>,ι =4,7 =奴〇三1?，11(〇三1?分别表示系统状态，倒立摆状态和倒立摆 控制信号；Θ表示位置，m表示倒立摆质量，m。表示小车质量，I表示倒立摆长度，d (t)表示未 知干扰，H(U)表示滞环，即Η(?!)=μη!+μ2ζ，其中是符号相同的常数；
[0088] 步骤2，将倒立摆模型转变为更适宜自适应扩张状态观测器设计的形式，过程如 下：
[0089] 2.1，将式(2)转换成如下形式：
[0090]
[0091]
[0092 ] 2 · 2，令ao = a(x)+Abu，Ab = gQ-bo，其中bo为go的估计值，基于扩张状态观测器的 设计思想，通过定义扩展状态X3 = ao,则式(3)改写为以下等效形式：
[0093] (4)
[0094]
[0095] 步骤3，设计滤波器，过程如下：
[0096]令yi = n〇,i+g()ni,i+ei，i = l，2,3分别为式(4)中状态变量Xi的观测值，定义观测误 差为yi_Xl，则自适应扩张状态观测器表达式为：
[0097]
[0098]
[0099]
[0100]
[0101 ]步骤4，基于扩张状态观测器，设计滑模控制器，过程如下：
[0102] 4.1，定义跟踪误差e为
[0103] e = yi-yd (8)
[0104] 其中yd为期望轨迹；
[0105] 4.2,根据式(8)，设计如下滑模面：
[0106] si = e+Ajedt (9)
[0107] 其中，λ为控制参数，λ>〇;
[0108] 对(8)和(9)求导得到：
如果& S O，则系统是稳定的。
[0149] 为验证所提方法的有效性，本发明对由式(24)表示的基于扩张状态观测器的积分 滑模控制器的控制效果进行仿真实验。仿真中采用的倒立摆系统、扩张状态观测器以及滑 模控制器的部分参数设计如下:倒立摆系统参数m。= I，1 = 0.5，m = 0.1，滞环参数μι = 1，μ2 =I，采样时间Ts = 0.01 s，初始条件(X1 (0)，X2 (0)) = (0.1，0.1)，滑模与扩张观测器的参数 设置为:让1 = 6，1? = 12，1? = 27，人=8，(31 = 150,〇2=150，(11 = 0.1，(12 = 0.1，「=1〇，〇1中区〇初 始条件为1，C2中go初始条件为-1。
[0150] 从图2-图5的实验结果对比能看出：go的初始估计符号不同时，两种控制方法的镇 定效果对比。从图中可以看出，无论go的符号估计是否正确，最终都能使倒立摆系统达到镇 定。整体来看，在基于扩张状态观测器的积分滑模控制器的作用下，不仅能有效消除滑模控 制中的抖振问题，而且保证系统状态快速稳定收敛至零点。
[0151]以上阐述的是本发明给出的一个实施例表现出的优良优化效果，显然本发明不只 是限于上述实施例，在不偏离本发明基本精神及不超出本发明实质内容所涉及范围的前提 下对其可作种种变形加以实施。所提出的控制方案对带有未知滞环和模型不确定项的倒立 摆系统是有效的，在所提出的控制器的作用下，抑制滑模控制中的抖振问题，保证系统快速 稳定收敛至零点。
【主权项】
1. 一种带有未知滞环的小车倒立摆系统积分滑模控制方法，其特征在于:所述控制方 法包括W下步骤： 步骤1，建立倒立摆系统的模型，初始化系统状态W及控制参数，所述的倒立摆系统能 描述为：其中一'1二0，_χ:二皆，y = x(t)eR，U(t)ER分别表示系统状态，倒立摆状态和倒立摆控制 信号；目表示位置，m表示倒立摆质量，m。表示小车质量，1表示倒立摆长度，d( t)表示未知干 扰，H(U)表示滞环，即Η(11)=μι11+μ2ζ，其中μL，μ2是符号相同的常数； 步骤2，将倒立摆模型转变为更适宜自适应扩张状态观测器设计的形式，过程如下： 2.1，将式(2)转换成如下形式：2.2,令日日= a(x)+Abu，Ab = g日-b日，其中b日为g日的估计值，基于扩张状态观测器的设计 思想，通过定义扩展状态X3 = ao,则式(3)改写为W下等效形式：(4) 其中，/τ=4; 步骤3，设计滤波器，过程如下： 令yi = n〇,i+g饥i,i+ei，i = l，2,3分别为式(4)中状态变量XI的观测值，定义观测误差为 yi-xi，则自适应扩张状态观测器表达式为：㈱作） 其中，ki，k2，k3均为增益向量，且巧 步骤4，基于扩张状态观测器，设计滑模控制器，过程如下： 4.1，定义跟踪误差e为 e = y 广 yd (8) 其中yd为期望轨迹； 4.2，根据式(8)，设计如下滑模面： si = e+入 Jedt (9) 其中，λ为控制参数，λ>〇; 对(8)和(9)求导得到：其中ci，di为大于零的常数； 4.4定义误差 S2 = ru,2-ai (17) 将(17)代入(12)得：其中C2，d2是大于零的实数； 设计自适应率 -'),、=Γτ (25) 其中τ =.s',(.V-^口I.:!)，Γ是大于零的常数； ον 4.8设计李雅普诺夫函数(2(1) 其中误差复=6-若; 对(26)微分，得到其中0是大于零的常数如果^ < 0，:则系统是稳定的。
【文档编号】G05B13/04GK105843041SQ201610218626
【公开日】2016年8月10日
【申请日】2016年4月8日
【发明人】陈强, 郑恒火, 陶亮, 董方
【申请人】浙江工业大学