武汉绘芯科技有限公司欢迎您!
10余年经验沉淀展览展示运动控制的专家
全国咨询热线:027-87052087
联系我们
武汉绘芯科技有限公司
电话:027-87052087
手机:13329706647
邮箱:956693667@qq.com
地址:武汉市江夏区藏龙岛谭湖一路8号
联系人:黄先生
您的位置: 滑轨屏|绘芯科技 > 知识库 >
知识库

一级旋转倒立摆的模糊控制

日期:2016-07-30 14:48:04 来源:未知 点击

一级旋转倒立摆的模糊控制

 

摘 要该文针对一级旋转倒立摆系统进行研究。基于Lagrange方程进行了对旋转倒立摆的系统建模并在Matlab环境下使用了模糊控制实现了倒立摆的良好控制采用积分消除了稳态误差。实验证明此种模糊控制方法有一定的鲁棒性并且控制效果较好。

 

关键词一级旋转倒立摆模糊控制Matlab

 

一、控制对象

     一级旋转倒立摆

  

    倒立摆系统是自动控制理论中比较典型的控制对象,许多抽象的控制理论概念如系统稳定性、可控性和系统抗干扰能力等,都可以通过倒立摆系统直观地表现出来。因此它成为自动控制理论研究的一个较为普遍的研究对象。倒立摆系统作为一个被控对象,是快速、多变量、开环不稳定、非线性的高阶系统,必须施加十分有力的控制手段才能使之稳定。对倒立摆的研究在现实中也有一定的指导意义,航天器的发射就是很好的例子, 未来仿人类机器人的发展也离不开倒立摆模型。一直以来,很多种控制方法已经应用到倒立摆的控制当中本文采用了一种模糊控制方法实现了对一级旋转倒立摆的控制。目标是使倒立摆在保持平衡的同时,旋臂还能够快速跟踪一个位置给定信号。

    该次设计所研究的旋转倒立摆系统模型如图1所示,倒立摆模块由倒立摆的摆杆和一个支撑摆杆的旋转臂组成,摆杆固定在旋转臂一端,可以在垂直于转臂的方向上做360度的转动。旋臂的另一端安装在一个旋转伺服装置上,伺服装置通过电机驱动齿轮转动来实现旋臂在水平面内做360度的旋转。在摆杆的底端以及旋臂的里端均装有光电编码器,用来检测角度的变化并将信号传送给计算机。

    涉及到的参数有:

                    θ1 ——旋转臂的旋转角

                    l1 ——旋转臂从电机轴到摆支撑点的长度——0 . 25m

                    J1 ——为旋转臂的转动惯量——0 . 01kg ·m2

                    θ2 ——倒立摆的旋转角

                    l2 ——倒立摆的旋转轴到重心的长度——0 . 1m

                    m2 ——倒立摆的质量——0 . 1kg

                    J2 ——倒立摆的转动惯量——0 . 001kg·m2

                    M ——电机产生的转矩

 

二、设计方案既涉及设计过程

 

()、建模:

 

     系统采用拉格朗日动力学分析法[1] 建立运动方程为

因摆杆摆动幅度小, 可认为sinθ1θ1 , sinθ2θ2 , cos (θ2 +θ1) 1 , 由此将(1) 式和(2) 式作线性化处理,:

    (3) 式和(4) 式可求出:

令系统的状态矢量为x = [ x1  x2  x3  x4 ]=[θ1  θ2  θ1 θ2]得状态空间方程

                          

    即输入

         

而输出部分的

              

故输出为

 

 

    由于旋转倒立摆系统自身的特点,在没有控制或控制效果不佳的情况下很难稳定。对于倒立摆的控制有和两个变量,只是对于这两个变量的控制并不能使倒立摆达到平衡,因为除了位置信号以外还缺少了反映运动情况的信号,控制器必须在兼顾这些因素的情况下进行对倒立摆的控制。所以在倒立摆的控制中要对θ1和θ’’1,θ2和θ’’2一同考虑。

 

 

()、分析:

 

1、该次设计涉及到两个方面的控制,一个是向上摆动控制(起摆控制),即使的摆杆由静止位置(垂直向下)旋转到向上并且以零角速度靠近垂直位置;一个是摆杆的平衡控制。

2、由于旋转倒立摆系统自身的特点,在没有控制或控制效果不佳的情况下很难稳定。对于倒立摆的控制有和两个变量,只是对于这两个变量的控制并不能使倒立摆达到平衡,因为除了位置信号以外还缺少了反映运动情况的信号,控制器必须在兼顾这些因素的情况下进行对倒立摆的控制。所以在倒立摆的控制中要对θ1和θ’’1, θ2和θ’’2一同考虑。虽然选定了控制的参量,但是这里有一个问题:如果设计的模糊控制器有4个输入,而每个输入又选定7个词集的话,那么规则将有7^4 = 2401,规则的编辑将变得十分复杂。而且由于这些变量之间又存在着较强的耦合关系,控制的效果也将不是十分理想。于是我们这样来设计,把θ1和θ’’1分为一组单独设计一个模糊控制器, θ2和θ’’2分为一组单独设计一个PD控制器。这样分开后,不仅减少了模糊控制规则的数量,也使每个控制器有了明确的控制对象,控制规则的编写也变得相对简单了。本次设计我们主要进行的是模糊设计,PD设计不作多少说明和分析。

 

()、模糊控制器的设计:

 

设计一个二维模糊控制器,其结构如图2所示

 

     

2 模糊控制器的结构

 

将θ2和θ’’2的控制都分别:“负大”(NB) 、“负中”(NM) 、“负小”(NS) 、“零”(ZE) 、“正小”(PS) 、“正中”(PM) 和“正大”(PB) 7 个语言变量值来描述,即{NB,NM,NS,ZE,PS,PM,PB}模糊集, 其中 

NB=负方向大的偏差(Negative Big)

  NM=负方向中的偏差(Negative Medium)

  NS=负方向小的偏差(Negative Small)

  ZO=近于零的偏差(Zero)

  PS=正方向小的偏差(Positive Small)

  PM=正方向中的偏差(Positive Medium)

PB=正方向大的偏差(Positive Big)

 

控制规则是模糊控制器的核心,规则的正确与否直接影响控制器的性能,而规则数目的多也是一个重要因素,通常用if….then的型式来表示。在这次课程设计中,我们把7*7=49条模糊规则全部写出,有:

1If theta is PB and dtheta is ZO then u is PB

   2If theta is ZO and dtheta ix NB then u is NB

3If theta is NB and dtheta is ZO then u is NB

……

……

49If theta is ZO and dtheta is PB then u is PB

要是列表则有如下模糊控制规则表:

                  

在模糊集合论域的选择上,这里取θ2的论域为对称的[ - 12 + 12 ],θ’’2的论域也为对称的[ - 12 + 12 ], 输出mu 的论域为对的[ - 2.1 + 2.1 ]。在输入端或者输出端, 论域与实际控制量的匹配都以通过添加增益环节来进行调节。只要正确地调节增益的大小, 便可以达到良好的匹配。在隶属曲线的选择上, 3个模糊控制量都使用M atlab模糊工具箱中的默认三角型曲线, 7个三角形在论域上平均分配,解决模糊的方法使用重心法。

                  (a) 控制器输入theta 的隶属度函数图像

(b) 控制器输入dtheta 的隶属度函数图像

 

(c) 控制器输出变量mu的隶属度函数图像

 

    

如此,一个二维的模糊控制器就建立好了,截面图如下图所示:

 

             

 

 3 两输入一输出系统的图形界面

           

4 隶属函数编辑器界面

 

            

 

                                5 模糊规则编辑器界面

 View菜单下执行ViewRules,激活模糊规则浏览器,观察规则推理是否正确。模糊规则浏览器如图12所示。设有两个输入变量、一个输出变量,输入的论域均为[-12  12],输出变量的论域为[-2.1  2.1],每个变量都有七个语言值,即在模糊集合论域上有七个三角形隶属函数,那么最多有49条规则。调整输入值的方法有两种,一种是用鼠标直接拖拽红线到指定的位置,另一种是在input的输入框中输入数字。如图12所示,输入[-1 0] ,可以发现推理出来的结果为0.193

 

         

 

                       6 模糊规则浏览器图形界面

 

 

选择ViewSurface,就会出现输出结果的三维立体图,如图13所示。用鼠标可以直接改变视角。观察模糊推理系统的输入、输出曲面。

            

                       模糊推理后的三维空间图

 

()、仿真图的建立:

 

Simulink里建立完整的旋转倒立摆的模糊控制系统图如图8所示:

8 模糊控制系统模型图

根据专家经验,悬臂摆角的偏差e1的论域维[-90o 90o],[-1.57 1.57] 偏差e2的论域为[-80o 80o],[-1.43 1.43];输出偏差e3的论域为[-2.4 2.4]。则三个K的取值为:

1.57 x K1 = 12           K1 = 7.3

1.43 x K2 = 12           K2 = 8.4

2.1 x K = 2.4           K = 1.15

 

8中的一些设定如下图所示:

 

                  9  Step的设置界面

                

                              10 Saturation的设置界面

11  state space的设置界面图

 

     经多次实验调整,最后确定取比例增益为24.6、微分增益为3.1、模糊控制器角的比例增益为7.3、微分增益为8.4, 输出电压增益设为1.15

 

 

三、仿真结果及分析

 

 

       12 模糊输出mu波形             13 vote的输出波形

    

                14 旋臂转动角度θ1的输出波形

                15 摆杆的转动角度θ2的输出波形

由上面的仿真图可以看出倒立摆可以很好的跟踪位置信号的给定而运动,且运动过程分为三个阶段:

 

1加速摆起过程:在最初的大概0.4秒内电机作加速运动,且速度很快,旋臂在电机的带动下转动角度由开始的零逐渐增加,且随着电机转动的速度增加而便增加,同时摆杆在旋臂带动下迅速摆起,具备相当的动能这是摆起的第一步

 

    2摆起制动过程在摆起过程中,由图可看出摆杆一直落后于旋臂的运动因此必须在加速结束之后给旋臂一个制动的信号迅速减小旋臂的动能,同时给摆杆形成一个惯性加速度,使摆杆再次加速迅速达到倒立状态附近.如果控制得比较好的话,就有可能使得旋臂与摆杆都达到了控制要求;

 

    3 自由运动阶段:由图可看出,大约在2-5s的过程中,所有的运动都处于一个缓慢的阶段,这起到一个缓冲的作用,保证比较平稳的过渡

 

     4)平衡阶段:在5s后,旋臂的转动达到一个稳定值,而相对应的时间下,摆臂的角度误差趋于0,这就意味着倒立摆已经趋于平衡稳定了,这正是我们这一个多星期的期望效果。

 

 

四、设计过程中遇到的问题

比例增益为24.6、微分增益为3.1,但考虑到是负反馈,所以在电路图中设置应用-24.6-3.1,缺少了这个负号仿真结果就大错特错,只能是发散的,不可能收敛,其仿真图如下:

                        16  错误的vote的输出波形

17  错误的旋臂的转动角度波形

                            18  错误的摆杆的转动角度波形

五、课程设计结论

 

    旋转式倒立摆是一种新型的倒立摆系统, 由于它的非线性严重,在设计过程中将它线性化,并主要采用了模糊控制法取得了很好的控制效果,即能使摆杆在平衡位置附近稳定地倒立,并且有较好的鲁棒性、快速性和准确性。

 

 

参考资料

 

1、《模糊控制技术》席爱民 编著  西安电子科技大学出版社

2、《模糊控制及其MATLAB应用》张国良 曾静 柯熙政 邓方林 西安交通大学出版社

3、《模糊控制系统的设计及稳定性分析》. 佟绍成 王涛    科学出版社.

4、《自动控制原理第4[M ]. 胡寿松   科学出版社

5、《计算机模糊控制原理及应用[M ]. 北京:北京航空航天大学出版社

 

 


在线客服
联系方式

热线电话

13329706647

上班时间

周一到周五

公司电话

027-87052087

二维码
线