倒立摆控制系统设计报告
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
控制系统综合设计
倒立摆控制系统
院(系、部):
组长:
组员
班级:
指导教师:
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、详细设计
原料清单:
器件名称单价/加工费用数量
倒立摆基座100元1
角编码器520元1
松下伺服电机2700元1
滑杆25元2
摆杆15元1
小车160元1
同步带28元1
限位开关2元2
带轮50元2
运动控制器6300元1
带轮基座65元2
滑杆基座50元2
电线拖链30元1
设计原型:
产品分析:
我们所使用的是固高科技直线二级倒立摆,型号为GLIP2002,它具有工业化、模块化、开放性和创新性的特点。
工业化即它的机械结构是按照工业标准设计及制造,所有产品零部件均采用工业级产品;模块化即只需增减摆杆组件就可实现同类倒立摆单级与多级之间的转换,不同类别倒立摆的转换只需要更换基座;开放性是指基于PC和DSP 运动控制器的开放式硬件控制平台,固高Simulink通用软件实验平台,可直接对系统进行建模、仿真和实际控制;创新性即随意配置独具个
性的实验平台,开发和验证自己的控制算法。
(二)机械系统设计
倒立摆系统中的计算机、运动控制卡、伺服驱动器、倒立摆本体(包含摆杆、小车、伺服电机、光电码盘)几大部分组成了下图所示的一个闭环系统。
倒立摆系统框图
倒立摆硬件组成方框图
光电码盘1 将小车的位移、速度信号反馈给伺服驱动器和运动控制卡,而光电码盘2 将摆杆的位置、速度信号反馈回控制卡。
计算机从运动控制卡中读取实时数据,确定控制决策(小车向哪个方向移
动、移动速度、加速度等),并由运动控制卡来实现该控制决策,产生相应的控制量,使电机转动,带动小车运动,保持摆杆平衡。
三理论分析
1、控制系统建模
微分方程的推导:
在忽略了空气阻力,各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如下图4.1所示。
图4.1 直线一级倒立摆系统
我们不妨做以下假设:
M 小车质量
m 摆杆质量
b 小车摩擦系数
l 摆杆转动轴心到杆质心的长度
I 摆杆惯量
F 加在小车上的力
x 小车位置
φ摆杆与垂直向上方向的夹角
θ摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下)
下图是系统中小车和摆杆的受力分析图。
其中,N和P为小车与摆杆相互作用力的水平和垂直方向的分量。
倒立摆模型受力分析图
注意:在实际倒立摆系统中检测和执行装置的正负方向已经完全确定,因而矢量方向定义如图所示,图示方向为矢量正方向
分析小车水平方向所受的合力,可以得到以下方程:
.
..N x b F x M --=
对摆杆水平方向的受力进行分析可以得到下面等式:
)sin (22
θl x dt
d m N +=
把这个等式代入上式中,就得到系统的第一个运动方程:
F ml
ml x b x m M =-+++•θθθθsin cos )(2
.....
.
为了推出系统的第二个运动方程,我们对摆杆垂直方向上的合力进行分析,可以得到下面方程:
)cos (22
θl dt
d m mg P =-
力矩平衡方程如下:
..
cos sin θθθI Nl Pl =--
注意:此方程中力矩的方向,由于θ=π+Ø,cos Ø=-cos θ,sin Ø=-sin θ,故等式前面有负号。
合并这两个方程,约去和,得到第二个运动方程:
θθθcos sin )(..
..2
x ml mgl ml I -=+=
设φπθ+=(φ是摆杆与垂直向上方向之间的夹角),假设φ与1(单位是弧度)相比很小,
即φ《1,则可以进行近似处理:1cos -=θ,φθ-=sin ,0)(2
=dt
d θ,用u 来代表被控对象的输入力F ,线性化后两个运动方程如下:
⎪⎩⎪⎨⎧=-++=-+u ml x b x m M x
ml mgl ml I ..
.....
..2
)()(ϕϕϕ
令a=..
x ,拉氏变换后为)()()()(2
2
s mlV s mg s s ml I =-+φφ 角度与加速度之间传递函数为:
mgl
s ml I ml
S V s -+=
22)()
()
(φ
对方程组(1.3)进行拉普拉斯变换,得到 :
⎪⎩⎪⎨
⎧=-++=-+)
()()()()()()()(2
22
..
22
s U s s ml s s bX s s X m M s s mlX mgl s s ml I φφφ 把方程组化简得到一级倒立摆的传递函数为:
s
q
bmgl
s q mgl m M s q ml I b s s
q
ml s U s -+-++=23)
242
)(()()(φ 其中q=[(M+m)(I+ml 2)-(ml)2]
实际系统的模型参数如下:
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秒
校正前系统动态性能分析:mgl
s ml I ml
s G -+=
2
20)()( 将参数值带入得到系统开环传递函数为26705.00102125.002725
.0)(20-=s s G
起摆时系统建模
起摆演示操作模块
采用能量控制策略和时间最优控制法来实现倒立摆的起摆控制。
摆杆的初始位置是自然下垂状态,要使摆杆从初始位置起摆直到竖直向上位置,且速度减少到0,所需的能量为 mgl E 20= 而倒立摆系统在任意角度时的能量为
)1(cos 2
1.2
-+=θθmgl I E
对其求微分可得:
θθθθθθcos sin .....mul mgl I dt
dE
-=-=
由于倒立摆本身系统特点,刚开始运动的摆杆具有摆动能量小于2mgl ,只有经过能量反馈,调整小车的加速度,从而增加摆杆的摆动能量,最终达到mgl 2。
能量反馈表达式为: )(0E E k u -= 其中,K 为系数。
摆杆相对于初始位置有四种不同运动状态,如下:
(1)θ>0,.
θ>0 (2)θ>0,.
θ<0 (3)θ<0,.
θ<0 (4)θ<0,.
θ<0 当系数0=u 即,θ=0或π时,不能控制u 控制摆杆的能量。
为使
dt
dE >0
当θθcos .
为负时,u 应该为正。
应用雅普夫方法我们可以得到控制策略。
可设雅普诺夫函数为:
20)(2
1
E E V -= 令控制策略为:
θθcos )(.
0E E k u -= 可以得到:
2.0.00)cos )((cos )()(θθθθE E mlk mul E E dt
dE
E E dt dV --=--=-= 只要0.≠θ并且0cos ≠θ,则就有0 dt dV 。
虽然在2
π
θ±=是摆杆不能控,但是由于摆杆在该位置并不是稳定点,因此将能量E 带到0E 。
为使能量尽快增加,则控制量的幅值需要尽可能大,因此可采用控制策略 ))cos ()((.
0θθsign E E k sat u ng -=
其中ng sat 代表以ng 为限幅的线性函数,()sign 为符号函数,且有
由上可以看出,摆杆自然下垂时,πθ=或πθ-=系统具有的能量为-mgl 2-,处于稳定竖直向上的状态时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('幅度')
24681012
00.511.5
2
2.5
x 10
25
G(S)=ml/[(I+ml*l)s*s-mgl]的单位阶跃响应
时间/sec (seconds)
幅度
图2 单位阶跃响应图
由系统的单位阶跃响应曲线可知,此系统很不稳定,是发散的,不存在动态性能指标,因此需要对其进行校正。
频域分析: num=[0.02725];
den=[0.0102125 0 -0.26705];
bode(num,den),grid; %绘制波特图并加栅格 title('波特图')
xlabel('频域/(rad/sec)') ylabel('幅度/dB') ylabel('相位/deg')
-80-70-60-50-40-30
-20M a g n i t u d e (d B
)
10
10
1
10
2
-180
-180-180-180-180
-180相位/d e g (d e g )
波特图
频域/(rad/sec) (rad/s)
上面我们已经得到了系统的Bode 图,但是无法找到截止频率,因此增加一定比例,设
26705
.00102125.002725.0)()(2
1-=
=s K
s KG s G 根据稳态误差要求计算增益 K ,
1026705.00102125.002725.0lim
20=-=→s k
K s P
可以得到:98=k 于是有:
26705.00102125.06705
.226705.00102125.09802725.0)(22-=
-⨯=
s s s G
用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')
得到的幅值裕量和相位裕量如图所示:
-40-30-20-10010
20M a g n i t u d e (d B )
10
10
10
-180
-180-180-180-180
-180相位/d e g (d e g )
Bode Diagram
Gm = -20 dB (at 0 rad/s) , P m = 0 deg (at 15.3 rad/s)
频域/(rad/sec) (rad/s)
运行结果: kg=0.1000 r=0
wg=0 wc=15.3409
即相角域度︒
=0γ。
对校正前系统进行仿真分析
Simulink 是可以用于连续、离散以及混合的线性、非线性控制系统建模、仿真和分析的软件包,并为用户提供了用方框图进行建模的图形接口,很适合于控制系统的仿真。
仿真后得到的结果如图所示:
超前校正设计参数计算
上面已求出相角域度︒
=0γ,假设要求系统的相角裕量︒≥40γ,因此需要增加的相角裕量为
︒40,增加超前校正装置会改变Bode 图的幅值曲线,这时增益交界频率会向右移动,必须对增益
交界频率增加所造成的相位滞后增量进行补偿,因此,假设需要的最大相位超前量︒≈45m φ。
计算可以得到:826.545
sin 145sin 1≈-+=︒
︒
α
)(lg 20lg 10m jw G =-α
即 26705
.00102125.0725
.2lg
20826.5lg 10--=-m w
计算结果为:s rad w m /89.25=
最大超前相角m ϕ发生的转折频率T α1与T
1
的几何中点m w 处,所以 α
T w m 1=
016.0=T 引入超前校正网络的传递函数:
1016.01
016.0826.5.
826.5111.1)(++⨯=++=
s s Ts Ts s G c αα 引入α倍的放大器。
为了补偿超前网络造成的衰减,引入826.5=α倍的放大器。
得到超前校正装
置的传递函数
1
016.01
093216.01016.01016.0826.5826.51826.5)(++=
++⨯⨯⨯
=s s s s s G c α 所以,校正后系统的开环传递函数
26705
.00042728.00102125.00001634.0725
.22540136.0)
1016.0)(26705.00102125.0()
1093216.0(6705.2)().()(2320--++=
+-+⨯=
=s s s s s s s s G s G s G c α
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
Time (seconds)
A m p l i t u d e
由阶跃响应图像可以得到上升时间为0.0487s ,峰值时间为0.126s ,超调量为26.3%,调节时间为0.265s 。
此超前环节可调整系统至稳定,但超调量较大。
-60-40
-20
20
M a g n i t u d e (d B )10
10
10
10
10
-180
-150
-120
P h a s e (d e g )
Bode Diagram
Gm = -20 dB (at 0 rad/s) , P m = 44.9 deg (at 23.9 rad/s)
Frequency (rad/s)
超前校正后系统的Bode 图 将开环传递函数1
016.098
135168.9)(++=s s s G 转化为零极点形式。
MATLAB 语句如下: num=[9.135168 98]; 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模型
系统输出量为摆杆的位置,它的初始位置为垂直向上,我们给系统施加一个扰动,观察摆杆的响应。
系统框图如下:
图中)(s KD 是控制器传递函数,)(s G 是被控对象传递函数当摆杆的平衡位置为垂直向上时,闭环控制系统中给定参考输入 r(s)为零,所以系统控制框图可以变换为
该系统的输出为
)()
)(())(()
()
()
)(())((1)()
()(1)()(s F num numPID den denPID denPID num s F den denPID num numPID den num
s F s G s KD s G s y +=+=+=
其中, num ——被控对象传递函数的分子项
den ——被控对象传递函数的分母项
numPID ——PID 控制器传递函数的分子项
denPID ——PID 控制器传递函数的分母项
被控对象的传递函数是
mgl
s ml I ml
s G -+=
2
20)()( PID 控制器的传递函数为
denPID
numPID
s K s K s K s K K s K s KD I P D I P D =++=++=2)(
调节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)<1.02;s=s-1;end ; settling_time=(s-1)*0.01 if settling_time<1 break ; end end
if settling_time<1 break ; end end
if settling_time<1 break ; end end
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 单位阶跃响应
时间 (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。