一级倒立摆控制系统设计
- 格式：docx
- 大小：415.09 KB
- 文档页数：14
基于双闭环PID控制的一阶倒立摆控制系统设计 一、 设计目的 倒立摆是一个非线性、不稳定系统，经常作为研究比较不同控制方法的典 型例子。设计一个倒立摆的控制系统，使倒立摆这样一个不稳定的被控对象通过 引入适当的控制策略使之成为一个能够满足各种性能指标的稳定系统。
二、 设计要求 倒立摆的设计要求是使摆杆尽快地达到一个平衡位置， 并且使之没有 大的振荡和过大的角度和速度。当摆杆到达期望的位置后，系统能克服随 机扰动而保持稳定的位置。实验参数自己选定，但要合理符合实际情况，控制 方式为双PID控制，并利用MATLAB进行仿真，并用simulink对相应的模块进 行仿真。
三、 设计原理 倒立摆控制系统的工作原理是：由轴角编码器测得小车的位置和摆杆相对 垂直方向的角度，作为系统的两个输出量被反馈至控制计算机。 计算机根据一定 的控制算法，计算出空置量，并转化为相应的电压信号提供给驱动电路， 以驱动 直流力矩电机的运动，从而通过牵引机构带动小车的移动来控制摆杆和保持平 衡。
四、 设计步骤 首先画出一阶倒立摆控制系统的原理方框图 一阶倒立摆控制系统示意图如图所示： 工业控制计算机 电动机驱动器 一阶倒立摆 一阶倒立摆控制系统动态结构图 F面的工作是根据结构框图，分析和解决各个环节的传递函数!
1■一阶倒立摆建模 在忽略了空气流动阻力，以及各种摩擦之后，可将倒立摆系统抽象成小车和 匀质杆组成的系统，如下图所示, 其中： M :小车质量 m：为摆杆质量 J :为摆杆惯量 F:加在小车上的力 x :小车位置 9 :摆杆与垂直向上方向的夹角
l :摆杆转动轴心到杆质心的长度
根据牛顿运动定律以及刚体运动规律，可知: (1) 摆杆绕其重心的转动方程为 J鎳 Fylsin 二- Fxl cos： .... (1)
(2) 摆杆重心的运动方程为 Fx
d2 (x l sin r)
彳『=mg -m d
2
d2t (3) 小车水平方向上的运动为 阶倒立摆环节问题解决! 2.电动机驱动器 选用日本松下电工MSMA02型小惯量交流伺服电动机，其有关参数如下:
F — Fx 二 M d2x 联列上述4个方程，可以得出 一阶倒立精确气模型: J ml2 F ml J ml2 sin u2-m2l2gsin r COST
2 2 2 2 J ml j[ M m ：-m l cos)
mlcos v.F m2l 2sin vcos m2-＜； M m mlg sin v
m2l2 cos20 -(M + m^J +ml2 )
式中J为摆杆的转动惯量： J』 3
若只考虑B在其工作点附近0 0=0附近(-10 —”：10 )的细微变化，则可 以近似认为:
* sin^比日 COS)： 1
若取小车质量 M=2kg,摆杆质量 m=1kg,摆杆长度2 l =1m,重力加速度取 g=10m/s2,则可以得 一阶倒立摆简化模型: x =0.44F -3.33^ v - -0.4 F 12^ 拉氏变换
=^>
日(s)
』
F(s) x(s) ?(s)
-0.4 2 s-12
2 -1.1s 10
2 一1*+10
即 G 1(s)= ' ; G
2
(s)=' -
x (J ml2)F -m2l2g J J(M m) Mml (M m)mlg mlF J(M m) Mml MSDA021A1AS 制电压：UDA=0± 10V。 若忽略电动机的空载转矩和系统摩擦，就可以认为驱动器和机械传动装置 均为纯比例环节，并假设这两个环节的增益分别为 Kd和Km
Kv TmTs2 Tms 1
G(s) =KdKvK^Ks
―芒粧.6
即 D3(s)=1.6
电动机驱动器部分问题解决!
3.双闭环PID控制器设计 U(S) D,和D2 (S) D2‘(S)的结构和参数。 (一)内环控制器的设计
其中，Ks=1.6为伺服电动机与减速机构的等效模型
驱动电压: U=0~100V 额定功率: PN=200W 额定转速: n=3000r/min 转动惯量: J=3X 10-6kg.m2 额定转矩: TN=0.64Nm 最大转矩: TM=1.91Nm 电磁时间常数：Tl=0.001s 电机时间常数：TM=0.003s
经传动机构变速后输出的拖动力为: F=0~16N与其配套的驱动器为:
剩下的问题就是如何确定控制器 反惯校正控制的系统内环框图 (b) PD 1.控制器的选择 内环系统未校正时的传递函数为出 F(s) s -12 对于内环反馈控制器D2(s)可有PD, PI, PID三种可能的结构形式，怎么选 取呢？这里，不妨采用绘制各种控制器结构下 “系统根轨迹”的办法加以分析比 较，从之选出一种比较适合的控制器结构。 各种控制器的开环传函的传递函数分别为： 在MATLAB下输入以下程序用 凑试”的方法画根轨迹图: num=［分子］; den=［分母］; xlabel('Real Axis'); ylabel('lmag Axis'); axis(［横、纵坐标范围］); title('Root Locus'); grid; rlocus( nu m,de n) 下图为各种控制器下的系统根轨迹。 P: -6-4Kp s2 -12 PD: -6.4KDs -6.4Kp s2 -12 PI : -6.4Kps -6.4K| s(s2 -12) PID : -6.4Kps2 -6.4KpS-6.4K| s(s2 -12) (a) PD ReiJ Aua 从根轨迹不难发现，采用PD结构的反馈控制器，结构简单且可保证闭环系 统的稳定。所以，选定反馈控制器的结构为 PD形式的控制器 2.控制器参数的选定 首先暂定K=-20。这样可以求出内环的传递函数为:
12.8 2 s 12.Kd2S12.KP2-12
注释：工程上常用阻尼比 =0.707作为二阶系统最优解!
d) PID K©s) 1 KKG(s)D'(s)
20 1.6
1-20 1.6
-0.4
s2-12 -0.4 s2-12 (@S Kd2)
Wn^12.8Kp2
2 W =12& T2 = 12.8
d2 =2 0.707 ・12.8 解得：Kp2
Kd2
二 1.94 = 0.39 D^ 0.39s 1.94
系统内环传递函数为：W2(s)
12.8
s2 5s 12.8
RGELSCUS (C) PI Q一
总 JUnLi
□帀叵一
............. .............. ........ . ............
Yi . , ---
-----------------
I --------- ----- ------ 3.系统内环的simulink仿真及结果 Hie Edt Wew Emulation Foriftat Tods He|p D|dHS诒电鸟► Worn
al
\rCorrTTand Vfirtfow
In1 >o 0bt1
Ready ：00:i
T=0.C<
仿真结果为: Step Resccnse
1.2-
Dpn・-
V Property Ecftar Chfiracten
Chanacbe ristcs Slw setting time wthn
Show rise the from （二）外环控制器的设计 -1.1s2 10 12.8(-1.1s2 10) s2 _ s2(s2 5s 12.8) 可见，系统开环传递函数可视为一个高阶（4阶）且带有不稳定零点的“非 最小相位系统”，为了便于设计，需要首先对系统进行一些简化处理（否则，不 便利用经典控制理论与方法对它进行设计）。 1 .系统外环模型的降阶
（1）对内环等效闭环传递函数的近似处理
将高次项s2忽略，有 12 8 1 W2（s） —8 - ..... （2） 5s+12.8 0.39S + 1
近似条件可由频率特性导出，即
（2）对象模型G1（s）的近似处理 -1.1s2 +10 G(s) 2 .... (3) s
-1.1(j )2 10 2
G(s) 10 s
W2(s)G(s) = 12.8 s2 5s 12.8
W2(s)二 12.8 s2 5s 12.8 ...... (1)
W2(j )二 12.8 (j )2 5(j ) 12.8 12.8 12.8 - 2 5j -
由（2）得: W2(j )
12.8
5「 12.8
12.8
由（3）得: G(j •)
10 1.1 2
