倒立摆控制系统设计报告
控制系统综合设计
倒立摆控制系统
院(系、部):
组 长: 组 员
班 级:
指 导 教 师:
2014年1月2日星期四
目录
摘要----------------------------------------------------------------------------------3 引言----------------------------------------------------------------------------------3 一、整体方案设计--------------------------------------------------------------3 1、需求-----------------------------------------------------------------------------3 2、目标-----------------------------------------------------------------------------3 3、概念设计----------------------------------------------------------------------3 4、整体开发方案设计---------------------------------------------------------3 5、评估----------------------------------------------------------------------------4 二、系统设计--------------------------------------------------------------------4 (一)系统设计-----------------------------------------------------------------4 1、功能分析----------------------------------------------------------------------4 2、设计规范和约束------------------------------------------------------------6 3、详细设计----------------------------------------------------------------------7 (二)机械系统设计-----------------------------------------------------------8 三、理论分析---------------------------------------------------------------------9 1、控制系统建模----------------------------------------------------------------9 2、时域和频域分析------------------------------------------------------------13 3、设计PID 或其他控制器---------------------------------------------------21 四、元器件、设备选型--------------------------------------------------------30
五、加工制作--------------------------------------------------------------------33 1、加工图纸---------------------------------------------------------------------38 2、材料选择----------------------------------------------------------------------38 3、加工方案----------------------------------------------------------------------38 六、安装调试--------------------------------------------------------------------38 七、经济性分析-----------------------------------------------------------------39 八、结论---------------------------------------------------------------------------39 1、课程设计总结----------------------------------------------------------------39 2、感悟和体会-------------------------------------------------------------------39 3、致谢-----------------------------------------------------------------------------40 九、参考文献----------------------------------------------------------------------40
倒立摆控制系统设计
摘要:在稳定性控制问题上,倒立摆既具有普遍性又具有典型性。倒立摆系统作为一个控制装置,结构简单,便于实现多种不同类型的控制方法,作为一个被控对象,它是一个高阶次、不稳定、多变量、非线性、强耦合的快速系统,只有采用行之有效的控制策略,才能使其稳定。本文采用频率响应控制方式和PID 控制方式对倒立摆的控制过程进行分析和研究,最终使倒立摆立起并保证其稳定。
关键词:倒立摆 最优控制 PID 调节 频率响应
引言:自动控制理论在当前的工程技术界,主要解决如何面向工程的实际应用问题。一项工程的实施也存在一种可行性的试验问题,因而,用一套较好的、较完备的试验设备,将其理论及方法进行有效的检验是极其重要的。倒立摆装置被公认为自动控制理论中的典型实验设备,也是控制理论教学和科研中的被控对象,运用控制手段可使之具有良好的稳定性。因此说,倒立摆为科技研究提供了一个从控制理论通往实践的桥梁。
一 整体方案设计
1、需求
随着科学技术的不断进步,人们在生产和生活中越来越注重事物的精确性,因此,不确定因素就开始引起人们的广泛关注。提及不确定性,控制领域的人都会想起倒立摆系统,因为倒立摆系统是典型的多变量、非线性、不稳定系统,通过对它的研究,能有效的反映出许多抽象的控制理论及概念。其控制方法在军事、航空航天、机器人和一般工业过程领域中都有着广泛的用途,如机器人行走过程中的平衡控制、火箭发射中的垂直度控制和卫星飞行中的姿态控制等。目前,倒立摆已经成为控制领域的一项热门研究。
2、目标
倒立摆的控制问题就是使摆杆尽快地达到一个平衡位置,并且使之没有大的振荡、过大的角度和速度。当摆杆到达期望的位置后,系统能克服随机扰动而保持稳定的位置。
3、概念设计
倒立摆是一个非线性、不稳定系统, 经常作为研究比较不同控制方法的典型例子。设计一个倒立摆的控制系统,使倒立摆这样一个不稳定的被控对象在引入适当的控制策略的基础上而成为一个能够满足各种性能指标的稳定系统。
4、整体开发方案设计
通过对倒立摆物理模型的分析,建立倒立摆的动力学模型,然后使用状态空间理论,推导出其非线性模型,再在平衡点处进行线性化,得到倒立摆的状态方程和输出方程,再设计出PID 控制器实现对其的控制。实验参数自己选定,但要合理,符合实际情况,使用模糊控制方式,并利用 MATLAB软件,用simulink 对相应的模块进行仿真。
5、评估
对自然不稳定物体,人为地施加一定的控制手段,使之稳定,达到人们的需求。这正是倒立摆的控制思想,不仅如此,日常生活中,所有重心在上、支点在下的物体的控制思想都源于此。一般而言,对倒立摆的控制目的就是通过控制力F 的作用,使小车左右运动,从而带动摆杆的摆动,将单摆控制在倒立点附近,在这样的单摆系统中,摆杆的平衡位置有两个,一个是自然下垂位置,另一个是竖直向上的倒立位置,因此倒立点是一个不稳定的平衡位置,摆杆一旦偏离倒立点,即使很小的角度,也会使整个系统失去平衡。
二 系统设计
(一)
1、功能分析
(1) 被控对象
倒立摆的被控对象为摆杆和小车。摆杆通过铰链连接在小车上,并可以围绕连接轴自由旋转。通过给小车施加适当的力可以将摆杆直立起来并保持稳定的状态。 (2) 传感器
倒立摆系统中的传感器为光电编码盘。旋转编码器是一种角位移传感器,它分为光电式、接触式和电磁感应式三种,本系统用到的就是光电式增量编码器。
光电编码器外观、剖面图和原理示意图
图为光电式增量编码器示意图,它由发光元件、光电码盘、光敏元件和信号处理电路组成。当码盘随工作轴一起转动时,光源透过光电码盘上的光栏板形成忽明忽暗的光信号,光敏元件把光信号转换成电信号,然后通过信号处理电路的整形、放大、分频、记数、译码后输出。 光电式增量编码器的测量精度取决于它所能分辨的最小角度α ,而这与码盘圆周内所分狭缝的线数有关:α =360°/ n , 其中n 为编码器线数。对于线数为n 的编码器,设信号采集卡倍频数为m ,则有角度换算关系为φ= 360°N /n ⋅ m,式中φ 为编码器轴转角,N 为编码器读数。对于电机编码器,在倒立摆使用中需要把编码器读数转化为小车的水平位置,因此l =180°×ΦN/n⋅ m式中l 为小车位移,Φ 为同步带轮直径。 (3)电控箱:
电控箱内安装有以下主要部件:1)交流伺服驱动器;2)I/O接口板:3)开关电源:4)开关、等电器元件
(4) 执行机构
倒立摆系统的执行机构为松下伺服电机和与之连接的皮带轮。电机的转矩和速度通过皮带轮传送到小车上,从而带动小车的运动。电机的驱动由与其配套的伺服驱动器提供。松下伺服电机及其驱动器如图所示。
电机的控制是通过固高公司的GT 系列运动控制器(见图)实现的。该控制器可以同步控制四个运动轴,实现多轴协调运动。运动控制器以计算机为主机,提供标准的ISA 总线或PCI 总线接口,并且可以提供RS232 串行通讯和PC104 通讯接口。运动控制器同时具有A/D 信号采集功能,从而能够将光电编码盘的信号传递到计算机。
2、设计规范和约束
用现代控制理论中的状态反馈方法来实现倒立摆系统的控制,就是设法调整闭环系统的极点分布,以构成闭环稳定的倒立摆系统,它的局限性是显而易见的。只要偏离平衡位置较远,系统就成了非线性系统,状态反馈就难以控制。实际上,用线性化模型进行极点配置求得的状态反馈阵,不一定能使倒立摆稳定竖起来,能使倒立摆竖立起来的状态反馈阵是实际调试出来的,这个调试出来的状态反馈阵肯定满足极点配置。这就是说,满足稳定极点配置的状态反馈阵很多,而能使倒立摆稳定竖立的状态反馈阵只有很少的一个范围,这个范围要花大量的时间去寻找。 3、详细设计
原料清单:
设计原型:
产品分析:
我们所使用的是固高科技直线二级倒立摆,型号为GLIP2002,它具有工业化、模块化、开放性和创新性的特点。工业化即它的机械结构是按照工业标准设计及制造,所有产品零部件均采用工业级产品;模块化即只需增减摆杆组件就可实现同类倒立摆单级与多级之间的转换,不同类别倒立摆的转换只需要更换基座;开放性是指基于PC 和DSP 运动控制器的开放式硬件控制平台,固高Simulink 通用软件实验平台,可直接对系统进行建模、仿真和实际控制;创新性即随意配置独具个性的实验平台,开发和验证自己的控制算法。
(二)机械系统设计
倒立摆系统中的计算机、运动控制卡、伺服驱动器、倒立摆本体(包含摆杆、小车、伺服电机、光电码盘)几大部分组成了下图所示的一个闭环系统。
倒立摆系统框图
倒立摆硬件组成方框图
光电码盘1 将小车的位移、速度信号反馈给伺服驱动器和运动控制卡,而光电码盘2 将摆杆的位置、速度信号反馈回控制卡。计算机从运动控制卡中读取实时数据,确定控制决策(小车向哪个方向移动、移动速度、加速度等),并由运动控制卡来实现该控制决策,产生相应的控制量,使电机转动,带动小车运动,保持摆杆平衡。
三 理论分析
1、控制系统建模
微分方程的推导 :
在忽略了空气阻力,各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如下图4.1所示。
图4.1 直线一级倒立摆系统
我们不妨做以下假设:
M 小车质量
m 摆杆质量
b 小车摩擦系数
l 摆杆转动轴心到杆质心的长度
I 摆杆惯量
F 加在小车上的力
x 小车位置
φ 摆杆与垂直向上方向的夹角
θ 摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下)
下图是系统中小车和摆杆的受力分析图。其中,N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量。
倒立摆模型受力分析图
注意:在实际倒立摆系统中检测和执行装置的正负方向已经完全确定,因而矢量方向定义如图所示,图示方向为矢量正方向
分析小车水平方向所受的合力,可以得到以下方程:
M x =F -b x -N
对摆杆水平方向的受力进行分析可以得到下面等式: .. .
d 2
N =m 2(x +l sin θ) dt
把这个等式代入上式中,就得到系统的第一个运动方程:
. .. ..
(M +m ) x +b x +ml θcos θ-ml θsin θ=F . ∙2
为了推出系统的第二个运动方程,我们对摆杆垂直方向上的合力进行分析,可以得到下面方程:
d 2
P -mg =m 2(l cos θ) dt
力矩平衡方程如下:
-Pl sin θ-Nl cos θ=I θ
注意:此方程中力矩的方向,由于θ=π+Ø,cos Ø=-cos θ,sin Ø=-sin θ, 故等式前面有负号。 合并这两个方程,约去和,得到第二个运动方程: ..
(I =ml ) θ+mgl sin θ=-ml x cos θ
设θ=π+φ(φ是摆杆与垂直向上方向之间的夹角),假设φ与1(单位是弧度)相比很小,即φ《1,则可以进行近似处理:cos θ=-1,sin θ=-φ,(
输入力F ,线性化后两个运动方程如下:
.. .. ⎧2⎪(I +ml ) ϕ-mgl ϕ=ml x ⎨ .. . .. ⎪⎩(M +m ) x +b x -ml ϕ=u 2.. .. d θ2) =0,用u 来代表被控对象的dt
令a=x , 拉氏变换后为(I +ml ) s φ(s ) -mg φ(s ) =mlV (s ) 角度与加速度之间传递函数为:.. 22φ(s )
V (S ) =ml (I +ml 2) s 2-mgl
对方程组(1.3)进行拉普拉斯变换,得到 :
.. ⎧2⎪(I +ml ) φ(s ) s 2-mgl φ=mlX (s ) s 2 ⎨22⎪⎩(M +m ) X (s ) s +bX (s ) s -ml φ(s ) s =U (s )
把方程组化简得到一级倒立摆的传递函数为:
φ(s )
U (s ) =b (I +ml 2)
s +q 4
22ml 2s q (M +m ) mgl 2bmgl s 3-s -s q q 其中q=[(M+m)(I+ml)-(ml)]
实际系统的模型参数如下:
M 小车质量 1.096 Kg
m 摆杆质量 0.109 Kg
b 小车摩擦系数 0 .1N/m/sec
l 摆杆转动轴心到杆质心的长度 0.2 5m
I 摆杆惯量 0.0034 kg*m*m
T 采样频率 0.005秒
校正前系统动态性能分析:G 0(s ) =ml 22(I +ml ) s -mgl
将参数值带入得到系统开环传递函数为G 0(s ) =
起摆时系统建模
0. 027250. 0102125s 2-0. 26705
起摆演示操作模块
采用能量控制策略和时间最优控制法来实现倒立摆的起摆控制。摆杆的初始位置是自然下垂状态,要使摆杆从初始位置起摆直到竖直向上位置,且速度减少到0,所需的能量为
E 0=2m g l
而倒立摆系统在任意角度时的能量为
1. 2 E =I θ+mgl (cosθ-1) 2
对其求微分可得:
. .. . . dE =I θθ-mgl θsin θ=-mul θcos θ dt
由于倒立摆本身系统特点,刚开始运动的摆杆具有摆动能量小于2mgl ,只有经过能量反馈,调整小车的加速度,从而增加摆杆的摆动能量,最终达到2mgl 。能量反馈表达式为: u =k (E 0-E )
其中,K 为系数。
摆杆相对于初始位置有四种不同运动状态,如下:
(1)θ>0,θ>0 (2)θ>0,θ
当系数u =0即, θ=0或π时,不能控制u 控制摆杆的能量。为使
当θcos θ为负时,u 应该为正。
. . . . . dE >0 dt
应用李雅普夫方法我们可以得到控制策略。可设李雅普诺夫函数为:
V =
令控制策略为:
u =k (E -E 0) θcos θ
可以得到:
. . dV dE =(E -E 0) =-(E -E 0) mul θcos θ=-mlk ((E -E 0) θcos θ) 2 dt dt
. dV π 0。虽然在θ=±是摆杆不能控,但是由于摆杆在 只要θ≠0并且cos θ≠0,则就有dt 21(E -E 0) 2 2.
该位置并不是稳定点,因此将能量E 带到E 0。
为使能量尽快增加,则控制量的幅值需要尽可能大,因此可采用控制策略
u =sat ng (k (E -E 0) sign (θcos θ))
其中sat ng 代表以ng 为限幅的线性函数,sign ()为符号函数,且有 .
由上可以看出,摆杆自然下垂时,θ=π或θ=-π系统具有的能量为--2mgl ,处于稳定竖直向上的状态时θ=0,所以当摆杆从自然下垂状态开始起摆时,u 的起始值始终为正才能保证能量不断增加。
2、时域和频域分析
时域分析:
用MATLAB 对此系统的动态性能进行分析。对系统施加单位阶跃输入信号,然后观察响应曲线并分析系统的动态性能。用step( )函数命令编写求单位阶跃响应的MATLAB 程序段如下:
M=1.096;
m=0.109;
l=0.25;
I=0.0034;
T=0.005;
g=9.8;
num=[m*l];
den=[(I+m*l*l) 0 -m*g*l];
step(num,den);
title('G(S)=ml/[(I+ml*l)s*s-mgl]的单位阶跃响应');
xlabel('时间/sec');
ylabel('幅度')
2.5x 10
25G(S)=ml/[(I+ml*l)s*s-mgl]的单位阶跃响应
2
1.5
幅度
1
0.5
0024681012
时间/sec (seconds)
图2 单位阶跃响应图
由系统的单位阶跃响应曲线可知,此系统很不稳定,是发散的,不存在动态性能指标,因此需要对其进行校正。
频域分析:
num=[0.02725];
den=[0.0102125 0 -0.26705];
bode(num,den),grid; %绘制波特图并加栅格
title('波特图')
xlabel('频域/(rad/sec)')
ylabel('幅度/dB')
ylabel('相位/deg')
波特图
-20
-30
M a g n i t u d e (d B
) -40-50
-60
-70
-80
-180
-180
相位/d e g (d e g ) -180-180-180
-180
100101102
频域/(rad/sec) (rad/s)
上面我们已经得到了系统的Bode 图,但是无法找到截止频率,因此增加一定比例,设G 1(s ) =KG (s ) =0. 02725K 0. 0102125s 2-0. 26705
根据稳态误差要求计算增益 K ,
0. 02725k =10 s →00. 0102125s 2-0. 26705
可以得到:k =98 K P =lim
于是有: G (s ) =0. 02725⨯982. 6705=0. 0102125s 2-0. 267050. 0102125s 2-0. 26705
用MATLAB 求校正前系统的幅值裕量和相位裕量
用命令margin(G)可以绘制出G 的伯德图,并标出幅值裕量、相位裕量和对应的频率。用函数
[kg,r,wg,wc]=margin(G)可以求出G 的幅值裕量、相位裕量和幅值穿越频率。
程序:
num=[2.6705];
den=[0.0102125 0 -0.26705];
margin(tf(num,den))
[kg,r,wg,wc]=margin(tf(num,den))
xlabel(' 频域/(rad/sec)')
ylabel(' 幅度/dB')
ylabel(' 相位/deg')
得到的幅值裕量和相位裕量如图所示:
Bode Diagram
Gm = -20 dB (at 0 rad/s) , Pm = 0 deg (at 15.3 rad/s)
20
10
M a g n i t u d e (d B ) 0-10
-20
-30
-40
-180
-180
相位/d e g (d e g ) -180-180-180
-180
100101102
频域/(rad/sec) (rad/s)
运行结果: kg=0.1000 r=0
wg=0 wc=15.3409
即相角域度γ=0。
对校正前系统进行仿真分析
Simulink 是可以用于连续、离散以及混合的线性、非线性控制系统建模、仿真和分析的软件包,并为用户提供了用方框图进行建模的图形接口,很适合于控制系统的仿真。
仿真后得到的结果如图所示:
︒
超前校正设计参数计算
︒︒上面已求出相角域度γ=0,假设要求系统的相角裕量γ≥40,因此需要增加的相角裕量为
40︒,增加超前校正装置会改变Bode 图的幅值曲线,这时增益交界频率会向右移动,必须对增益交界频率增加所造成的相位滞后增量进行补偿,因此,假设需要的最大相位超前量φm ≈45。 ︒
1+sin 45︒
≈5. 826 计算可以得到:α=︒1-sin 45
-10lg α=20lg G (jw m )
即 -10lg 5. 826=20lg 2. 725 -0. 0102125w m -0. 26705
计算结果为:w m =25. 89rad /s
最大超前相角ϕm 发生的转折频率
w m =11与的几何中点w m 处,所以 αT T 1
T T =0. 016
引入超前校正网络的传递函数: 1αTs +115. 826⨯0. 016s +1 . =. αTs +15. 8260. 016s +1
引入α倍的放大器。为了补偿超前网络造成的衰减,引入α=5. 826倍的放大器。得到超前校正装G c (s ) =置的传递函数 αG c (s ) =5. 826⨯15. 826⨯0. 016s +10. 093216s +1 ⨯=5. 8260. 016s +10. 016s +1
所以,校正后系统的开环传递函数 2. 6705⨯(0. 093216s +1)
(0. 0102125s 2-0. 26705)(0. 016s +1) 0. 2540136s +2. 725=0. 0001634s 3+0. 0102125s 2-0. 0042728s -0. 26705G (s ) =G 0(s ). αG c (s ) =
MATLAB 程序:
num0=2.6705;
num1=[0.093216 1];
num=conv(num0,num1);
den0=[0.0102125 0 -0.26705];
den1=[0.016 1];
den=conv(den0,den1);
ga=tf(num,den);
gb=feedback(ga,1,-1);
figure(1);
step(gb);grid;
figure(2);
margin(ga);grid;
Step Response
A m p l i t u d e
Time (seconds)
由阶跃响应图像可以得到上升时间为0.0487s ,峰值时间为0.126s ,超调量为26.3%,调节时间为0.265s 。此超前环节可调整系统至稳定,但超调量较大。
Bode Diagram
Gm = -20 dB (at 0 rad/s) , Pm = 44.9 deg (at 23.9 rad/s)
20
M a g n i t u d e (d B ) P h a s e (d e g )
-20
-40
-60-120
-150
-180
10
-1
10
10
1
10
2
10
3
Frequency (rad/s)
超前校正后系统的Bode 图 将开环传递函数G (s ) =MATLAB 语句如下: num=[9.135168 98];
9. 135168s +98
转化为零极点形式。
0. 016s +1
den=[0.016 1];
[z,p,k]=tf2zp(num,den) 运行结果: z = -10.7278 p = -62.5000 k = 570.9480 进行simulink 仿真:
Simulink 仿真模块
Simulink 仿真图
演示操作模块
实际演示操作过程小车位置与摆角波形图
3、设计PID 或其他控制器
倒立摆的PID 模型
系统输出量为摆杆的位置,它的初始位置为垂直向上,我们给系统施加一个扰动,观察摆杆的响应。系统框图如下:
图中KD (s ) 是控制器传递函数,G (s ) 是被控对象传递函数当摆杆的平衡位置为垂直向上时,闭环控制系统中给定参考输入 r(s)为零,所以系统控制框图可以变换为
该系统的输出为
num
G (s ) den y (s ) =F (s ) =F (s )
(numPID )(num ) 1+KD (s ) G (s )
1+
(denPID )(den )
num (denPID )
=F (s ) (denPID )(den ) +(numPID )(num )
其中, num ——被控对象传递函数的分子项
den ——被控对象传递函数的分母项
numPID ——PID 控制器传递函数的分子项 denPID ——PID 控制器传递函数的分母项
被控对象的传递函数是
G 0(s ) =
PID 控制器的传递函数为
ml
22
(I +ml ) s -mgl
K I K D s 2+K P s +K I numPID
KD (s ) =K D s +K P +==
s s denPID
调节PID 控制器的各个参数,以得到满意的控制效果。
程序扫描法求kp 、ki 、kd t=0:0.01:10; for kp=70:1:180 for ki=95:1:120 for kd=5:1:30
numpid=[kd kp ki]; denpid=[1 0]; num=0.02725;
den=[0.0102125 0 -0.26705]; numc=conv(num,numpid); d1=conv(denpid,den); sys=tf(numc,d1);
sys1=feedback(sys,1,-1); y=step(sys1,t);
s=101;while y(s)>0.98 & y(s)
if settling_time
if settling_time
figure(1); step(sys1,t); grid
title('PID 单位阶跃响应' ) xlabel(' 时间' )
ylabel(' 幅值' )
sol=[kp;ki;kd;settling_time] kp ki kd
settling_time; 运行结果:
Kp=70;ki=110;kd=8;settling_time=0.9900
PID 单位阶跃响应
幅值
[1**********]0
时间 (seconds)
PID 参数扫描阶跃响应图
(1)比例(P )控制
Bode 图
Simulink 仿真图
P 控制器实质上是一个具有可调增益的放大器。在信号变换过程中,P 控制器只改变信号的增益不影响其相位。在串联校正中,加大控制器的增益kp ,可以提高系统的开环增益,减小系统稳态误差,从而提高系统的控制精度,但会降低系统的相对稳定性,甚至可能造成闭环系统的不稳定。因此,在系统校正设计中,很少单独使用比例控制规律。 (2)比例-微分(PD )控制
对数频率特性曲线
Simulink 仿真图
PD 控制器中的微分控制规律,能反映输入信号的变化趋势,产生有效的早期修正信号,以增加系统的阻尼程度,从而改善系统的稳定性。 (3)比例-积分(PI )控制
对数频率特性曲线
Simulink 仿真图
在串联校正时,PI 控制器相当于在系统中增加了一个位于原点的开环极点,同时也增加了一个位于s 左半平面的开环零点。位于原点的极点可以提高系统的型别,以消除或减小系统的稳态误差,改善系统的稳态性能;而增加的负实零点则用来减小系统的阻尼程度,缓和PI 控制器极点对系统稳定性及动态过程产生的不利影响。在控制工程实践中,PI 控制器主要用来改善控制系统的稳态性能。
(4)比例-积分-微分(PID )控制规律
对数频率特性曲线 MATLAB 命令:
num=[0.02725];
den=[0.0102125 0 -0.26705]; k=70 ki=110 kd=8
numPID=[kd k ki]; denPID=[1 0];
numc=conv (num,denPID)
denc=polyadd(conv(denPID,den),conv(numPID,num)) t=0:0.005:5; figure(1);
impulse(numc,denc,t)
PID仿真控制模块
双击PID Controller,输入kp=70,ki=110,kd=8,进行仿真得到如下波形图:
Simulink 仿真波形图
MATLAB 演示操作模块
PID实际操作过程中小车位移与摆角波形图
利用PID 控制器进行串联校正时,除可使系统的型别提高一级外,还将提供两个负实零点,与PI 控制器相比,PID 控制器除了同样具有提高系统的稳态性能的优点外,还多提供一个负实零点,从而在提高系统动态性能方面,具有更大的优越性。
四 元器件、设备选型
倒立摆基本构造、价格及性能分析:
1)基座:1000*213*55mm 材质:铁 100元
2)松下直流伺服电机:型号:MSMA022A1C 200W 200HZ 3000r/min 3400元(含税)深圳市兴和弘
五金机电有限公司
优点:精确的速度控制, 转矩速度特性很硬, 原理简单、使用方便, 价格优势。
替代性:因为A 系列已停产,所以在市场上的价格偏高,经过对比,决定选择MSMD022G1U ,同样是小惯量,但是价格性能更优。伺服电机,驱动器一套2700(含税)元,而且编码器是20位的。采购厂家是深圳市云翔机电设备有限公司。相对于国产登奇,华中电机的比较好,虽然价格比进口的便宜一些,但是相比之下,国产的稳定性比较低,性能弱一些,而日系的性能优良,设计精密。
3)滑杆: 18*730mm 材质:不锈钢 25元
要求:表面有足够的光滑度,合理支撑小车运动,经过多次试验决定选择18*730mm的不锈钢杆。
4)滑杆基座:材质:铝合金 50元
要求:采用铝合金和铁镶嵌结构,既能良好固定滑杆,又能承受隔挡小车所带来的撞击。
5)同步带:型号:788XL037 宽:9.4mm 周长:2米 材质:橡胶 28元 (慈溪贝龙传动带有限公司)
如果选用更宽的同步带,电机需要更大功率,而788XL037型号的同步带则能很好的牵动小车控制摆杆运动。
6) 限位开关:型号:EE-SX671A 2元
作用:遮光时动作,是NPN 型。
7) 角度编码器:型号:OVW2-06-2MD 脉冲数:600P/R 带线1米 520元(含税)
角度编码器有三种安装方式:低速端安装,高速段安装,辅助机械安装(常用的有齿轮齿条、链条皮带、摩擦转轮、收绳机械等) 在此采用辅助机械安装。
优点:通用型、低成本、高性能。
8) 带轮:直径50mm 宽:12mm 材质:铝合金 50元 (慈溪贝龙传动带有限公司)。 带轮基座:材质:铝合金 65元
9) 摆杆:长500mm 重0.109kg 摆动 直径:10mm 材质:铝合金 15元 北京大兴机械加工厂
选用10mm 的铝合金杆为摆杆,主要考虑到控制的精度和稳定性。
10) 电线拖链: 材质:塑料 长1米 30元
11) 小车:重1.096kg 摩擦系数 0 .1N/m/sec 材质:铝合金 160元
选择厂家按图纸加工
12) 运动控制器:GT-400-SV 型运动控制器 6300元
ALIP-EB-2002:直线二级摆电控模块
ALIP-LM-100-C:直线运动组件
ALIP-R-2002:二级摆组件
控制平台:
1) 与IBM PC/AT机兼容的PC 机,带PCI/ISA总线接槽;
2) GT400-SV-PCI 运动控制卡;
3) GT400-SV-PCI 运动控制卡用户接口软件;
4) 演示实验软件
控制系统典型链接
,
把倒立摆相关实验实时控制系统程序输入到PC 机中,设置相关实验模块参数后,再经过编译、连接过程,下装至倒立摆控制卡,由控制卡控制小车及摆杆运动,接着控制卡再把检测到的信号传回PC 机。
五 加工制作
1、加工图纸
2、材料选择:铝合金,不锈钢
3、加工厂家: 大兴兴华西大街.亿园电子商城
大兴兴丰大街和林校路交叉口 聚源电子
北京中关村中发电子市场
北京大兴机械加工厂
六 安装调试
固高公司倒立摆实验步骤如下:
1) 进入MATLAB Simulink的目录,即:
“\\matlab6p5\toolbox\GoogolTech\InvertedPendulum\Linear Inverted Pendulum”, 打开直线一级倒立摆相关实验实时控制程序。
2)打开相关实验Controller 模块设置控制器参数,把仿真结果较好的参数输入到模块中,点击“OK ”完成设定。
3)点击编译按钮编译程序,编译成功后点击连接按钮,使计算机和倒立摆建立连接。
4)点击运行按钮运行程序,确定电机上伺服后,缓慢的提起摆杆到竖直向上的位置,程序进入自动控制后松开摆杆。
5)双击“Scope ”观察实验运行结果,改变仿真得到的控制参数,输入实时控制参数,运行实时控制程序,观察控制效果的变化。
七 经济性分析
在自动控制领域中,当一种新的控制理论和方法提出后,在无法用理论对其进行严格证明的情况下,可以考虑通过倒立摆装置来验证其正确性和可行性,如今,倒立摆仿真和实物控制实验,已成为检验一个新的控制理论是否有效的试金石,同时也是产生一个新的控制方法必须依据的基础实验平台。为全方位满足控制教学和研究的需要,固高科技采用开放的控制解决方案和工业化、模块化的机械结构研发出了一系列结构简单、价格低廉的倒立摆实验设备。从经济方面而言,固高倒立摆系统具有通用性、成本低、性价比高的特点,便于从模拟和数字角度实现多种不同的控制方法。随着科技的发展,越来越多的人努力摆脱古老的生活和思维模式,转而追求高效和便携,因而倒立摆在市场上的需求越来越宽广,这在某种程度上大大降低了劳动力,进而提高了经济效益。
八 结论
课程设计总结:
(1) 由于直线一级倒立摆本身是不稳定的系统,但通过数学建摸分析可以建立起小车加速度与摆杆角度间的传递函数,然后应用控制理论的方法,借助Matlab 及Simulink 软件,可以分析出系统的特性以及调节方向。所以通过给系统添加一个串联超前校正装置,最终使系统稳定,但系统的超调量较大,稳态误差也较大。此时,可以给系统添加一个串联超前-滞后校正系统,使稳态误差减小。
(2) 我们小组主要采用频率响应法和PID 调节法对倒立摆系统进行分析和控制。尽管确定了方法,可实践过程中并不是一帆风顺的,但我们发现,只有充分掌握并理解了基本概念,才有可能有条理的将控制器设计出来。
感悟和体会:
利用两周的课程设计时间设计一个直线一级倒立摆的控制器,对我们来说有点难度,时间紧迫,尤其是数学建模过程,需要下很大功夫,数学建模是分析、设计、预测以及控制一个系统的理论基础,比较有难度,而且在完成课程设计的过程中,需要我们了解并掌握一些软件的使用,比如MATLAB 软件和SIMULINK 仿真等。硬件部分需要不断尝试,但不是盲目的调试,而是需要有理论作为指导,指明调整的方向,这样设计系统就会事半功倍,所以,基础知识对我们实践起来是很重要的。另外,在写报告时我们要搜集足够的资料,这就要求我们进一步掌握文献检索能力。不过,通过两周的课程设计,我们能够比较好地运用所学的自动控制原理的相关知识解决一些实际控制问题,也能够熟练的运用MATLAB 对控制系统进行仿真和校正,总体来说,我们不仅提高了自己查阅资料的能力,也锻炼了实际动手能力,提升了撰写课程设计报告的水平。
自动控制原理这门课程对于我们自动化的学生来说是极其重要的,理论知识是入门的基础,然而,实践是检验真理的唯一标准,时代在发展,我们所处的社会正一步一步向自动化趋近,作为一名理工科大学生,我们不仅要牢固掌握课本上的理论知识,更要将理论与实践结合,熟练掌握相关的软件操作,在实践中发现真理,在动手中提升自己。两周的课程设计对于我们来说远远不够,以后,我们要不断摸索,敢于尝试,为揭开科学的神秘面纱而继续奋斗。当然,在这两周里,我们还懂得了团队合作的重要性,在激发了对自动化课程的学习兴趣的同时,也亲身体验了自己动手解决疑问的喜悦之情。
致谢:
两周的课程设计即将结束,在这两周的时间内,我们付出了很多,也收获了很多,感谢一直鼓励我们的指导老师,是他们给我们指明了方向,并给予我们精心的引导,同时还要感谢身边帮助我们的小伙伴们,我们会好好珍惜这份经历,从中吸取教训,总结经验,以便将来能够更好的运用学习到的理论知识,在以后的工作和生活充分发挥自己的动手能力。
参考文献
[1] 裴月琳,李斌. 倒立摆系统稳摆控制算法研究. 重庆:重庆大学出版社,2012
[2] 胡寿松. 自动控制原理. 北京:科学出版社,2001
[3] 彭恒,刘白雁. 基于MATLAB 的倒立摆控制及参数优化. 武汉科技大学,2008
[4] 固高科技有限公司. 直线倒立摆安装与使用手册R1.0,2005
[5] 固高科技有限公司. 倒立摆与自动控制原理实验,2005
[6] 刘金琨. 先进PID 控制及其MATLAB 仿真. 北京:电子工业出版社,2002
[7] 王俊,潘健. 基于倒立摆的三种控制策略的研究. 湖北工业大学,2008
[8] 赵景波.MATLAB 控制系统仿真与设计. 北京:机械工业出版社,2010
[9] 固高科技有限公司.GT 系列运动控制器用户手册
[10] 固高科技有限公司.GT 系列运动控制器编程手册
[11]王骏,赵世敏. 倒立摆建模与控制. 清华大学,2010