单级倒立摆建模与pd矫正

n 2
z

sz s 2 2n s n 2
由反馈系统闭环传递函数的计算方法得系统的闭环传递函数 对照公式 得 K=-30 T=0.1
2.3 校正后系统动态性能指标
校正后系统框图及单位阶跃相应仿真如下
图 10 校正后系统结构图
图 11 校正后系统单位阶跃响应
11
武汉理工大学《自动控制原理》课程设计说明书
图 12 初次校正后系统单位阶跃响应
图 13 调整参数后校正系统的单位阶跃响应
12
武汉理工大学《自动控制原理》课程设计说明书
可以看出，单位脉冲响应曲线性能好了很多，ts 符合指标，但是超调量为 20.5，比规定 的 16.3 要大，不符合指标。但是注意到超出的并不多，所以微调 k 值，将 k 从 30 调整到 25 之后再次绘图，发现这次不仅超调量只有 13.3，而且 ts 下降到接近 1s。说明将 k 选取为 25 是合适的。所设计的串联 PD 校正系统满足要求。 编写 MATLAB 代码，并画出已校正系统的根轨迹和波特图，可得到已校正系统的根轨 迹如图所示。 num = [-3 -25]; den = [-0.5 0 12]; rlocus(num,den); grid; %定义分子多项式 %定义分母多项式 %绘制系统的根轨迹 %画出网络标度线
1
武汉理工大学《自动控制原理》课程设计说明书
目录
摘要........................................................................................................................................ 1 1 单级移动倒立摆的建模及其线性化 ........................................................................ 2
3 校正前后系统比较 ...................................................................................................... 15 4 心得与体会 .................................................................................................................... 15 5 参考文献 ......................................................................................................................... 16
Mp% e

2
1- ²
100%
( s )
K (Ts 1) U (s ) KTs 0.7 s 12 KTs K 13 0.5 s2 K
( s)K (Ts 1)
10
武汉理工大学《自动控制原理》课程设计说明书
=
s 1 KT T 2 KTs 0.5 s K 12 0.5 0.5
2 单级移动倒立摆的串联 PD 校正 ............................................................................... 4
2.1 未校正系统的动态性能指标.................................................................................... 4 2.2 系统的串联 PD 校正 ................................................................................................ 9 2.3 校正后系统动态性能指标 ..................................................................................... 11
margin(s1); %绘制开环系统模型对象 s1 伯德图 并在图上标注 Gm wg Pm wp
7
武汉理工大学《自动控制原理》课程设计说明书
图 6 未校正系统伯德图 1
可以看到上面的伯德图在函数相频部分略奇怪，思考后发现可能是坐标取得太小，将 标度调大一些之后得到下图
图 7 未校正系统伯德图 2
(编写程序如下： num = [1]; den = [-0.5 0 12];
8
% 定义分子多项式 %定义分母多项式
武汉理工大学《自动控制原理》课程设计说明书
nyquist (num,den,'r');
%绘制奈奎斯特曲线
图 8 未校正系统奈奎斯特曲线
未校正系统奈奎斯特曲线在（-1，0）这点附近比较杂乱，看不清楚到底环绕多少圈， 系统不稳定。
grid;
图 4 系统未校正前单位阶跃响应曲线图
（3）未校正系统根轨迹图 可以用 Matlab 作出系统的根轨迹图形，编写 matlab 程序代码如下： num = [1]; den = [-0.5 0 12]; rlocus(num,den,'r'); grid; xlabel ('实轴'),ylabel('虚轴'); title ('根轨迹'); %定义分子多项式 %定义分母多项式 %绘制系统的根轨迹 % 画出网络 %加上坐标轴名称 %加标题
1.1 单级移动倒立摆的物理建模.................................................................................... 2 1.2 单级移动倒立摆的数学建模.................................................................................... 3 1.3 单级移动倒立摆的数学模型线性化........................................................................ 4
6
武汉理工大学《自动控制原理》课程设计说明书
图 5 未校正前系统根轨迹
右半平面也有根轨迹，故系统不稳定 （4）未校正系统伯德图 用 MATLAB 绘制校正前系统的伯德图，编写程序如下： num=[1]; den=[-0.5 0 12]; s1=tf(num,den); [m,pi,w]=bode(num,den); %创建传递函数 G（s）的 TF 模型对象 %m 为幅值 pi 为相角
1 单级移动倒立摆的建模及其线性化
1.1 单级移动倒立摆的物理建模
单级倒立摆系统物理模型如图 1 所示。在小车静止的状态下，由于受到重力的作用， 倒立摆的稳定性在摆杆在轻微干扰作用下就会发生不可逆转的破坏而使倒立摆无法保持平
图 1 单级倒立摆物理模型
2
武汉理工大学《自动控制原理》课程设计说明书
衡。 若要倒立摆保持平衡， 那么在受外力干扰的作用下， 必须使小车水平方向方向通过移动 来产生相应的加速度， 以抵消外力作用下的加速度。 假设干扰的作用是二维的， 即干扰力的 方向只在平行于纸面的方向，依照惯性参考系下的牛顿力学原理，作用力与物体对位移时 间的二阶导数存在线性关系。故单级倒立摆系统是一个典型的非线性系统。
用 MATLAB 函数做校正后系统的阶跃响应图，编写代码如下 num=[-3 -30]; den=[-0.5 0 12]; sys=tf(num,den); lsys=feedback(sys,1,-1); step(lsys); grid; 得出校正后系统阶跃响应输出曲线如图所示 %作系统的阶跃响应图 %定义分子多项式
1.2 单级移动倒立摆的数学建模
研究单级移动倒立摆特性及其控制策略就要首先对单级移动倒立摆进行数学建模，便 于后续分析研究。 如图 1 所示，在惯性参考系下，设小车的质量为 M，摆杆的质量为 m；摆杆的长度为 l，在某一瞬间时刻的摆角为 θ，在水平方向施加控制力 u。这样，整个倒立摆系统就受到重 力、水平力和摩擦力的三个外力合力的作用。假设此时小车在水平方向的位移为 x，此时的 摆心瞬时位置为（x + l） 。 在水平方向上，由牛顿第二定律，可求得系统的运动方程为：
当 θ 很小时( 1 )，非线性三角函数可近似为 sin , cos 1 。故可对方程组进行 线性化，带入 sin ， cos 1 ，方程式可以化简为
将上式进行拉普拉斯变换得
联立解得
代入 M(小车的质量)=1kg，m(倒立摆的质量)=0.2g,l（倒立摆的长度)=0.5m,g(重力 加速度)=10m/s2 到式 1-6，得系统开环传递函数为：
武汉理工大学《自动控制原理》课程设计说明书
摘要
单级移动倒立摆控制系统是一个复杂的、 不稳定的、 非线性系统， 是进行控制理论教学 及开展各种控制实验的理想实验平台。对倒立摆系统的研究能有效的反映控制中的许多典 型问题：如非线性问题、鲁棒性问题、镇定问题、随动问题以及跟踪问题等。通过对倒立摆 的控制，用来检验新的控制方法是否有较强的处理非线性和不稳定性问题的能力。本此课 程设计对单级移动倒立摆的平衡问题进行了研究并采用串联 PD 校正实现了系统的的平衡 控制。建立了系统的数学模型进行合理线性化，求出线性传递函数。并且设计串联 PD 校正 装置， 使系统输出动态性能满足一定指标要求。使用 Matlab 软件中的 SIMULINK 工具对倒 立摆系统的运动进行了计算机仿真，并利用 Matlab 便捷的计算功能和绘图功能分析未校正 系统的动态性能和校正后系统的各项性能。 关键字：单级移动倒立摆 串联 PD 校正 MATLAB 仿真