二级倒立摆的模糊控制研究二级倒立摆的模糊控制研究
在控制理论发展的过程中,某一理论的正确性及实际应用中的可行性都需要一个按其理论设计的控制器控制一
个典型对象进行验证。倒立摆就是这样一个被控制对象。倒立摆系统是一个多变量、快速、非线性和自然不稳
定系统,在控制过程中该系统能有效反映控制中的许多关键问题,如非线性问题、系统的鲁棒性问题、随动问
题、镇定问题及跟踪问题等。
1 引言引言
在控制理论发展的过程中,某一理论的正确性及实际应用中的可行性都需要一个按其理论设计的控制器控制一个典型对象
进行验证。倒立摆就是这样一个被控制对象。倒立摆系统是一个多变量、快速、非线性和自然不稳定系统,在控制过程中该系
统能有效反映控制中的许多关键问题,如非线性问题、系统的鲁棒性问题、随动问题、镇定问题及跟踪问题等。倒立摆在控制
理论研究中是一种较为理想的实验装置。小车倒立摆系统的控制目标是倒立摆通过小车能够稳定在有限长度的导轨上而不倒
下,从而达到动态平衡。本文针对二级倒立摆非线性模型,基于Maminadi模型,通过设计融合函数来设计
2 二级倒立摆的数学模型的建立二级倒立摆的数学模型的建立
二级倒立摆由小车、摆杆、水平导轨等组成,小车由伺服电机、皮带轮、传动带带动在水平导轨上左右运动,上下摆可绕
各自的转轴在水平导轨所在的铅垂面内自由转动。小车和上下摆杆间通过轴承连接,每个轴承连接处固定有电位器,分别用以
检测两根摆杆与铅垂线的角度偏移。小车相对轨道中心点的偏移位置也由固定在皮带轮轴上的电位器检测。
其基本原理为:角度、位置信号经检测电路获取后,再由微分电路得到相应的微分信号,这些信号经A/D转换器转换为数
字信号传输至计算机。通过已设计的控制程序计算控制力所需电压值,经D/A转换器转换为模拟信号,功率放大后驱动电机
运转,电机再用皮带拖动小车在导轨上往复运动实现对倒立摆的有效控制。忽略空气阻力和各种摩擦,并认为摆杆为刚体。图
1为二级倒立摆示意图。
倒立摆参数定义如下:M为小车质量,0.584 kg;m1为摆杆1质量,0.05 kg;m2为摆杆2质量,0.13 kg;m3为摆杆3
质量,0.236 kg;l1为摆杆1中心到转动中心的距离,0.077 5 m;l2为摆杆2中心到转动中心的距离,0.25 m;θ1为摆杆1
与竖直方向的夹角;θ2为摆杆2与竖直方向的夹角;F为作用在系统上的外力;g为重力加速度,9.8 m/s2。
利用拉格朗日方程推导运动学方程,拉格朗日方程为:
式中,L为拉格朗日算子,q为系统的
式中,i=1,2,3…,n,fi为系统在第i个广义坐标上的外力。
在二级倒立摆系统中,系统的广义坐标有3个,分别为x,θ1,θ2。经计算并线性化并带人参数值得到系统的状态空间方
程:
评论0
最新资源