CN110244561B - 一种基于干扰观测器的二级倒立摆自适应滑模控制方法 - Google Patents
一种基于干扰观测器的二级倒立摆自适应滑模控制方法 Download PDFInfo
- Publication number
- CN110244561B CN110244561B CN201910501117.0A CN201910501117A CN110244561B CN 110244561 B CN110244561 B CN 110244561B CN 201910501117 A CN201910501117 A CN 201910501117A CN 110244561 B CN110244561 B CN 110244561B
- Authority
- CN
- China
- Prior art keywords
- sliding mode
- equation
- disturbance
- inverted pendulum
- control
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Abstract
本发明提供了一种基于干扰观测器的二级倒立摆自适应滑模控制方法。该方法针对存在外部扰动的二级倒立摆系统稳定控制问题,首先根据拉格朗日方程建立二级倒立摆系统的微分方程,并在平衡位置附近进行线性化处理,推导出带有外部扰动的线性状态方程和输出方程。然后设计滑动模态,并利用非线性干扰观测器对滑动模态中的系统未知模型进行补偿,使得控制器的设计无需知道系统的结构和参数,并考虑到观测器的估计误差界限未知,在控制器中设计自适应律对未知估计进行调节。同时采用LMI求解滑模参数,并利用sigmoid函数代替控制器中的符号函数,消除抖振现象。
Description
技术领域
本发明涉及一种运动控制器设计方法,特别涉及一种基于干扰观测器的二级倒立摆自适应滑模控制方法,属于控制科学与控制工程领域。
背景技术
倒立摆是控制系统理论研究的一个具有挑战性的问题。它是一个强耦合、不稳定和欠驱动的非线性机械系统,被视为开发和研究与鲁棒系统相关的思想的基准。它具有广泛的工业应用,例如两轮自平衡车辆、火箭、导弹、智能机器人和其他欠驱动非线性系统。滑模控制是一种用于处理存在不确定性和干扰的复杂系统的鲁棒控制技术。但是,滑模控制需要依赖系统的数学模型来建立鲁棒控制律。而未知的外部干扰和系统的不确定性,会导致系统实际模型和建立的数学模型之间存在差异。近几年来,为了避免系统模型未知和外部扰动问题,基于扰动观测器的控制方法被提出。但多数扰动观测器都存在扰动的估计效果完全依赖于对扰动先验知识的了解的缺点,而实际中很难获得扰动的先验知识。同时,未考虑观测器的估计误差对系统带来的影响。
发明内容
本发明的技术解决问题是:针对带有不确定性和外部扰动的二级倒立摆系统稳定问题,滑模控制需要依赖系统的数学模型,且多数扰动观测器都存在扰动的估计效果完全依赖于对扰动先验知识的了解的缺点,同时,未控制过程中未考虑观测器的估计误差对系统带来的影响。提供一种基于干扰观测器的二级倒立摆自适应滑模控制方法,使得控制器的设计无需知道系统的结构和参数,并且自适应调节估计误差的影响。
本发明的技术解决方案为:一种基于干扰观测器的二级倒立摆自适应滑模控制方法。首先根据拉格朗日方程建立二级倒立摆系统的微分方程,并在平衡位置附近进行线性化处理,推导出带有外部扰动的线性状态方程和输出方程。然后设计滑动模态,并利用非线性干扰观测器对滑动模态中的系统未知模型进行补偿,使得控制器的设计无需知道系统的结构和参数,并考虑到观测器的估计误差界限未知,在控制器中设计自适应律对未知估计进行调节。同时采用LMI求解滑模参数,并利用sigmoid函数代替控制器中的符号函数,消除抖振现象。具体实施步骤如下:
1)根据拉格朗日方程建立二级倒立摆系统的微分方程:
式中,x为小车的位置,θ1和θ2分别为摆杆的上下摆角,由于实际控制过程中的θ1和θ2值很小,不失一般性在平衡位置对上式进行线性化处理可得:
将上式进一步变换,并考虑控制干扰的直线二级倒立摆系统状态方程和输出方程如下所示:
式中,d为系统控制扰动,矩阵A,B,C,D如下所示:
其中:
2)根据二级倒立摆系统的状态空间表达式,定义滑模函数为:
s=BTPX
式中,P为6×6阶的正定矩阵,考虑控制扰动的情况下,对滑模面s求导:
式中,f=BTPAX+BTPBd,b=BTPB,由于f+(b-1)u中控制输入u存在,会导致代数环问题,利用低通滤波器,上式可写成:
式中,uf=BL(s)u为低通滤波器的输出信号,避免代数环问题,BL(s)为低通滤波器,ΔG=(b-1)u-(b-1)uf,然后设计一种双曲正切非线性干扰观测器,对系统的未知模型进行处理,将函数f+(b-1)uf定义为系统的干扰项D,设计如下非线性干扰观测器:
式中,μ为估计误差,设计如下控制器:
考虑到系统控制存在的估计误差,设计自适应律对其进行调整控制器设计为如下形式:
3)为了求解滑模面中的对称正定矩阵P,将控制律写成如下形式:
u=-KX+v
式中,v=KX+u,则上式可变为:
V2=XTPX
对上式求关于时间导数可得:
由定理1的分析可知,存在t≥t0,s=BTPX=0成立,即sT=XTPB=0成立,则上式可变成:
定义x=P-1,上述不等式可变为:
定义L=Kx,则上述不等式变为:
为了确保矩阵P为对称正定矩阵,需满足:
P=PT>0或x=xT
结合上述不等式,利用matlab的LMI工具箱求解P矩阵,并采用Sigmoid函数替代控制器中的符号函数,其表达式如下所示:
与现有技术相比,本发明的优点在于:本发明根据拉格朗日方程建立了带有不确定性和外部扰动的二级倒立摆系统状态方程。提出了一种基于双曲正切跟踪微分器,设计双曲正切非线性干扰观测器,克服了扰动先验知识的缺点,并且结构简单,对扰动的估计效果优秀,利用所设计的非线性干扰观测器对滑动模态中的系统未知模型进行补偿,使得控制器的设计无需知道系统的结构和参数。同时,对系统控制存在的估计误差设计自适应律对其进行调整,增强系统的鲁棒性。并且,采用LMI求解滑模参数,并利用sigmoid函数代替控制器中的符号函数,消除滑模抖振现象。
附图说明
图1为系统控制框图。
具体实施方式
下面结合附图对本发明进一步说明。
如图1所示,本发明具体实现步骤如下:
1)根据拉格朗日方程建立二级倒立摆系统的微分方程:
式中,x为小车的位置,θ1和θ2分别为摆杆的上下摆角,由于实际控制过程中的θ1和θ2值很小,不失一般性在平衡位置对上式进行线性化处理可得:
将上式进一步变换,并考虑控制干扰的直线二级倒立摆系统状态方程和输出方程如下所示:
式中,d为系统控制扰动,矩阵A,B,C,D如下所示:
其中:
2)根据二级倒立摆系统的状态空间表达式,定义滑模函数为:
s=BTPX
式中,P为6×6阶的正定矩阵,考虑控制扰动的情况下,对滑模面s求导:
式中,f=BTPAX+BTPBd,b=BTPB,由于f+(b-1)u中控制输入u存在,会导致代数环问题,利用低通滤波器,上式可写成:
式中,uf=BL(s)u为低通滤波器的输出信号,避免代数环问题,BL(s)为低通滤波器,ΔG=(b-1)u-(b-1)uf,然后设计一种双曲正切非线性干扰观测器,对系统的未知模型进行处理,将函数f+(b-1)uf定义为系统的干扰项D,设计如下非线性干扰观测器:
式中,μ为估计误差,设计如下控制器:
考虑到系统控制存在的估计误差,设计自适应律对其进行调整控制器设计为如下形式:
3)为了求解滑模面中的对称正定矩阵P,将控制律写成如下形式:
u=-KX+v
式中,v=KX+u,则上式可变为:
V2=XTPX
对上式求关于时间导数可得:
由定理1的分析可知,存在t≥t0,s=BTPX=0成立,即sT=XTPB=0成立,则上式可变成:
定义x=P-1,上述不等式可变为:
定义L=Kx,则上述不等式变为:
为了确保矩阵P为对称正定矩阵,需满足:
P=PT>0或x=xT
结合上述不等式,利用matlab的LMI工具箱求解P矩阵,并采用Sigmoid函数替代控制器中的符号函数,其表达式如下所示:
本发明说明书中未作详细说明部分属于本领域专业技术人员公知的现有技术。
Claims (1)
1.一种基于非线性干扰观测器的二级倒立摆自适应滑模控制方法,其特征在于,步骤如下:
1)根据拉格朗日方程建立二级倒立摆系统的微分方程:
式中,x为小车的位置,θ1和θ2分别为摆杆的上下摆角,由于实际控制过程中的θ1和θ2值很小,不失一般性在平衡位置对上式进行线性化处理可得:
将上式进一步变换,并考虑控制干扰的直线二级倒立摆系统状态方程和输出方程如下所示:
式中,d为系统控制扰动,矩阵A,B,C,D如下所示:
其中:
2)根据二级倒立摆系统的状态空间表达式,定义滑模函数为:
s=BTPX
式中,P为6×6阶的正定矩阵,X为系统状态, 考虑控制扰动的情况下,对滑模面s求导:
式中,d为系统控制扰动;f=BTPAX+BTPBd,b=BTPB,由于f+(b-1)u中控制输入u存在,会导致代数环问题,利用低通滤波器,上式可写成:
式中,uf=BL(s)u为低通滤波器的输出信号,避免代数环问题,BL(s)为低通滤波器,ΔG=(b-1)u-(b-1)uf,然后设计一种双曲正切非线性干扰观测器,对系统的未知模型进行处理,将函数f+(b-1)uf定义为系统的干扰项D,设计如下非线性干扰观测器:
式中,μ为估计误差,设计如下控制器:
考虑到系统控制存在的估计误差,设计自适应律对其进行调整控制器设计为如下形式:
3)为了求解滑模面中的对称正定矩阵P,将控制律写成如下形式:
u=-KX+v
式中,K为增益矩阵,v=KX+u,则上式可变为:
V2=XTPX
对上式求关于时间导数可得:
当t≥t0,s=BTPX=0成立,即sT=XTPB=0成立,则上式可变成:
定义x=P-1,上述不等式可变为:
定义L=Kx,则上述不等式变为:
为了确保矩阵P为对称正定矩阵,需满足:
P=PT>0或x=xT
结合上述不等式,利用matlab的LMI工具箱求解P矩阵,并采用Sigmoid函数替代控制器中的符号函数,其表达式如下所示:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910501117.0A CN110244561B (zh) | 2019-06-11 | 2019-06-11 | 一种基于干扰观测器的二级倒立摆自适应滑模控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910501117.0A CN110244561B (zh) | 2019-06-11 | 2019-06-11 | 一种基于干扰观测器的二级倒立摆自适应滑模控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110244561A CN110244561A (zh) | 2019-09-17 |
CN110244561B true CN110244561B (zh) | 2022-11-08 |
Family
ID=67886675
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910501117.0A Active CN110244561B (zh) | 2019-06-11 | 2019-06-11 | 一种基于干扰观测器的二级倒立摆自适应滑模控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110244561B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111290419A (zh) * | 2020-03-03 | 2020-06-16 | 集美大学 | 具有时变时滞输入的二轮自平衡车自适应滑模控制方法 |
CN112083653B (zh) * | 2020-09-09 | 2022-11-11 | 中国人民解放军火箭军工程大学 | 一种基于微分平坦的倒立摆系统自抗扰控制设计方法 |
CN112643670B (zh) * | 2020-12-07 | 2022-07-29 | 洛阳尚奇机器人科技有限公司 | 一种基于滑模观测器的柔性关节控制方法 |
CN113359481B (zh) * | 2021-07-21 | 2022-07-15 | 上海交通大学 | 基于滑模控制的倒立摆系统自适应鲁棒h∞控制方法 |
CN113419433B (zh) * | 2021-07-23 | 2022-07-05 | 合肥中科深谷科技发展有限公司 | 一种自平衡电动轮椅欠驱动系统跟踪控制器的设计方法 |
CN113625568A (zh) * | 2021-08-11 | 2021-11-09 | 上海交通大学 | 基于广义系统模型的倒立摆无源自适应滑模控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105573124A (zh) * | 2016-03-16 | 2016-05-11 | 河南理工大学 | 不确定性平面倒立摆系统的自适应滑模控制器生成方法 |
CN105843041A (zh) * | 2016-04-08 | 2016-08-10 | 浙江工业大学 | 一种带有未知滞环的小车倒立摆系统积分滑模控制方法 |
CN106598058A (zh) * | 2016-12-20 | 2017-04-26 | 华北理工大学 | 内在动机驱动的极限学习机自发育系统及其运行方法 |
CN108958034A (zh) * | 2018-07-27 | 2018-12-07 | 南宁学院 | 一种二级倒立摆动态修正控制方法 |
-
2019
- 2019-06-11 CN CN201910501117.0A patent/CN110244561B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105573124A (zh) * | 2016-03-16 | 2016-05-11 | 河南理工大学 | 不确定性平面倒立摆系统的自适应滑模控制器生成方法 |
CN105843041A (zh) * | 2016-04-08 | 2016-08-10 | 浙江工业大学 | 一种带有未知滞环的小车倒立摆系统积分滑模控制方法 |
CN106598058A (zh) * | 2016-12-20 | 2017-04-26 | 华北理工大学 | 内在动机驱动的极限学习机自发育系统及其运行方法 |
CN108958034A (zh) * | 2018-07-27 | 2018-12-07 | 南宁学院 | 一种二级倒立摆动态修正控制方法 |
Non-Patent Citations (5)
Title |
---|
"Multirate Output Feedback with Discrete Time Sliding Mode Control for Inverted Pendulum System";R. Ngadengon等;《Procedia Computer Science》;20151231;全文 * |
"Sliding mode control of a Rotary Inverted Pendulum using higher order differential observer";Philippe Faradja等;《2014 14th International Conference on Control, Automation and Systems (ICCAS 2014)》;20141231;全文 * |
"基于非线性干扰观测器的一类欠驱动系统跟踪控制";黄辉先等;《控制与决策》;20190331;第34卷(第3期);第1页第1段摘要 * |
基于干扰观测器的倒立摆自适应滑模控制及仿真研究(英文);王洪斌等;《系统仿真学报》;20100630(第06期);第2页第1栏第1段和第3页第3段 * |
基于滑模变结构的二级倒立摆系统设计与实验;韩莉等;《科技信息(科学教研)》;20070920(第27期);第1页第1栏第1段-第2栏倒数第1段 * |
Also Published As
Publication number | Publication date |
---|---|
CN110244561A (zh) | 2019-09-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110244561B (zh) | 一种基于干扰观测器的二级倒立摆自适应滑模控制方法 | |
CN108828955B (zh) | 基于有限时间扩张状态观测器的精准航迹跟踪控制方法 | |
Zhang et al. | Fixed-time output feedback trajectory tracking control of marine surface vessels subject to unknown external disturbances and uncertainties | |
Zhang et al. | Fuzzy adaptive output feedback control of uncertain nonlinear systems with prescribed performance | |
CN106773713B (zh) | 针对欠驱动海洋航行器的高精度非线性路径跟踪控制方法 | |
CN108415249B (zh) | 一种基于低频学习的电液伺服系统自适应鲁棒控制方法 | |
CN107272677B (zh) | 一种移动机器人的变结构自适应轨迹跟踪控制方法 | |
CN107121932B (zh) | 电机伺服系统误差符号积分鲁棒自适应控制方法 | |
Zhao et al. | Finite‐time tracking control for pneumatic servo system via extended state observer | |
CN110572093B (zh) | 基于电机位置伺服系统期望轨迹和干扰补偿的arc控制方法 | |
CN109828468B (zh) | 一种针对磁滞非线性机器人系统的控制方法 | |
CN110716566A (zh) | 一种欠驱动无人艇的有限时间轨迹跟踪控制方法 | |
CN107247411A (zh) | 基于扰动观测器的非奇异终端滑模航迹跟踪控制方法 | |
CN110362110B (zh) | 一种固定时自适应神经网络无人机航迹角控制方法 | |
CN111740658B (zh) | 基于策略迭代的电机系统最优调节控制方法 | |
An et al. | Robust fixed-time tracking control for underactuated AUVs based on fixed-time disturbance observer | |
Wang et al. | Robust trajectory tracking control of underactuated surface vehicles with prescribed performance | |
CN110262484B (zh) | 基于自适应事件触发的轮式机器人匀速直线编队控制方法 | |
Dai et al. | Finite-time trajectory tracking for marine vessel by nonsingular backstepping controller with unknown external disturbance | |
Shao et al. | Robust discrete‐time fractional‐order control for an unmanned aerial vehicle based on disturbance observer | |
Tong | An adaptive error constraint line-of-sight guidance and finite-time backstepping control for unmanned surface vehicles | |
CN112061979A (zh) | 桥式吊车控制方法、运行控制装置及计算机可读存储介质 | |
Liu et al. | Robust adaptive self-Structuring neural network bounded target tracking control of underactuated surface vessels | |
CN110109357A (zh) | 针对非标准型非线性航空器的半全局自适应控制方法 | |
CN112731801B (zh) | 一种对称死区非线性的自适应动态面输出反馈控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |