《北京理工大学学报》(自然科学中文版)稿件模板

1、 基于MATLAB的单级倒立摆的LQR控制研究王思 3120150031 （1.北京理工大学宇航学院，北京 100081） 摘 要：以一级直线倒立摆为模型，研究线性二次型指标的最优控制问题，并利用MATLAB来设计LQR最优控制器系统。通过调整加权矩阵Q和R，使控制器的系统性能达到最优，并画出系统阶跃响应曲线。仿真结果表明该系统具有较好的稳定性和快速性。关键词：倒立摆，LQR，MATLAB，最优控制中图分类号：TJ765 文献标识码：AStudy of LQR Control Singe Inverted Pendulum Based on MATLABWang Si 1(School of

2、Aerospace Engineering, Beijing Institute of Technology, Beijing 100081, China)Abstract: Based on single inverted pendulum model to study the line for the linear quadratic index optimal control problem, and use MATLAB to design the optimal controller system conventional LQR. Through adjusting weighte

3、d matrix Q and R, make the controller system performance to achieve optimal and draw the system order step response curve. The simulation results show that the system has a good stability and quickness.Key word: inverted pendulum, LQR, MATLAB, optimal control1 单级倒立摆数学模型在忽略了空气阻力，各种摩擦后，可将一级倒立摆系统抽象成小车和

4、均质杆组成的系统，如图1所示。图1 一级直线倒立摆系统假设M为小车质量，m为摆杆质量，b为小车摩擦系数，l为摆杆转动轴到杆质心的长度，F为加在小车上的力，x为小车位置，为摆杆与垂直向上方向的夹角，为摆杆和垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下），因此系统状态空间方程为： (1)其中，四个状态量、分别代表小车位移、小车速度、摆杆位置和摆杆角速度，为重力加速度，输出包括小车位移和摆杆角度。2 单级倒立摆LQR控制器设计直线一级倒立摆系统的控制问题可理解为稳态时间连续系统的状态调节器问题。该系统的状态方程为（1）式，系统的性能指标是：线性二次型调节器（LQR）就是用来确定反馈控制函数使得上

5、述性能指标达到最小。其中不受约束，和称为加权矩阵，为常数对称正定阵。，为如下Riccati方程：的半正定对称解。MATLAB中的LQR函数不仅可以求解P，还能同时求出K。3 LQR最优控制器的MATLAB实现下面针对直线型一级倒立摆系统应用LQR法设计与调节控制器，控制摆杆保持倒立平衡的同时，跟踪小车的位置。表1 实际系统参数表小车质量1.096 Kg摆杆质量0.109 Kg小车摩擦系数0.1 N/m/sec摆杆转动轴心到杆质心的长度0.25 m摆杆惯量0.0034 kg*m*m重力加速度9.8 m/(s*s)采样频率0.005 s将实际系统参数代入（1）式，可得倒立摆系统状态方程： （2）控

6、制系统结构如图2所示，图中R是施加在小车上的阶跃输入。设计控制器使得当给系统施加一个阶跃输入时，摆杆会摆动，然后仍然回到垂直位置，小车可以到达新的指定位置。图2 控制系统结构假设全状态反馈可以实现，R=1，Q=C*C= diag (1，0，1，0)，用MATLAB中的LQR函数可以得到最优控制器对应的K=-1.0000 -1.7619 16.1472 3.0896。系统的阶跃响应曲线如图3所示，可见系统的响应速度很慢，不太理想。LQR函数允许选择两个参数（R和Q），这两个参数用来平衡输入量和状态量的权重。图4和图5选择了不同的Q矩阵，可以看出Q= diag(4000,0,100,0)时系统的超

7、调量很小，达到稳态的时间也很短，动态性能有较大改善，满足最优的设计要求。图3 系统阶跃响应（Q=diag（1，0，1，0）图4 系统阶跃响应（Q= diag（500，0，2，0）图5 系统阶跃响应（Q= diag（500，0，2，0）4 结论设计线性二次型最优控制系统时，关键问题是要选择合理的Q、R阵，一般来说，把Q中某个加权系数增大，则对应的状态变量会收敛得更快一些，R中某个加权系数增大则对应的控制量会小一些。Q、R的选择是一个试凑的过程，若Q、R选择得合理，就可以减少试凑次数。直线倒立摆LQR控制器的设计简单、响应速度快、超调量小以及良好的稳定性等特点。参考文献：1 马扬龙, 陈琼, 宁玉玲. 基于MATLAB的单级