直线一级倒立摆控制详细报告
一级倒立摆的建模及控制分析
直线一级倒立摆的建模及控制分析摘要:本文利用牛顿—欧拉方法,建立了直线型一级倒立摆系统的数学模型。
在分析的基础上, 采用状态反馈控制中极点配置法设计了用于直线型一级倒立摆系统的控制器。
此外,用MATLAB 仿真绘制了相应的曲线并做了分析。
一、问题描述倒立摆控制系统是机器人技术、控制理论、计算机控制等多个领域和多种技术的有机结合,其被控系统本身是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,是控制理论研究中较为理想的实验对象。
它为控制理论的教学、实验和科研构建了一个良好的实验平台,促进了控制系统新理论、新思想的发展。
倒立摆系统可以采用多种理论和方法来实现其稳定控制,如PID,自适应、状态反馈、智能控制等方法都己经在倒立摆控制系统上得到实现。
由于直线一级倒立摆的力学模型较简单,又是研究其他倒立摆的基础,所以本文利用所学的矩阵论知识对此倒立摆进行建模和控制分析。
二、方法简述本文利用牛顿—欧拉方法,建立了直线型一级倒立摆系统的数学模型。
在分析的基础上, 采用状态反馈控制中极点配置法设计了用于直线型一级倒立摆系统的控制器。
此外,用MATLAB 仿真绘制了相应的曲线并做了分析。
三、模型的建立及分析3.1 微分方程的推导在忽略了空气阻力,各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如下图1所示。
图1 直线一级倒立摆系统假设 M 为小车质量;m 为摆杆质量;b 为小车摩擦系数;l 为摆杆转动轴心到杆质心的长度;I 为摆杆惯量;F 为加在小车上的力;x 为小车位置;φ为摆杆与垂直向上方向的夹角;θ为摆杆与垂直向下方向的夹角。
图2是系统中小车和摆杆的受力分析图。
其中,N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量。
值得注意的是: 在实际倒立摆系统中检测和执行装置的正负方向已确定, 因而矢量方向定义如图2所示, 图示方向为矢量正向。
(a) (b)图2 小车和摆杆的受力分析图分析小车水平方向所受的合力,可以得到以下方程:N x b F x M --= (1)由摆杆水平方向的受力进行分析可以得到下面等式:θθθθs i n c o s 2ml ml x m N -+= (2) 把这个等式代入上式中,就得到系统的第一个运动方程:()F ml ml x b x m M =-+++θθθθsin cos 2 (3)为了推出系统的第二个运动方程,我们对摆杆垂直方向上的合力进行分析,可以得到下面方程:θθθθc o s s i n 2 ml ml mg P --=- (4) 力矩平衡方程如下:θθθI Nl Pl =--cos sin (5)合并这(4)、(5)两个方程,约去P 和N ,得到第二个运动方程:()θθθc o s s i n 2x ml mgl ml I -=++ (6) 假设φ与1(单位是弧度)相比很小,即φ《1,则可以进行近似处理:0d d s i n 1c o s 2=⎪⎭⎫ ⎝⎛-=-=t θφθθ,, (7) 用u 来代表被控对象的输入力F ,线性化后两个运动方程如下:()()⎩⎨⎧=-++=-+u ml x b x m M xml mgl ml I φφφ 2 (8) 3.2 状态空间方程方程组(8)对φ,x 解代数方程,整理后的系统状态空间方程为: ()()()()()()()()u Mm l m M I m l Mm l m M I m lI x x Mm l m M I m M m gl Mm l m M I m lbMm l m M I gl m Mm l m M I b m l I x x ⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎣⎡++++++⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎣⎡+++++-+++++-=⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡222222222200001000000010φφφφ u x x x y ⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=0001000001φφφ 对于质量均匀分布的摆杆有:3/2ml I =,于是可得:()x ml mgl ml ml =-+φφ223/ 化简得:xll g 4343+=φφ设}{x u x x X ==1,,,,φφ ,则有:14301004300100000000010u l x x l g x x⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡=⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡φφφφ10001000001u x x x y ⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=φφφ 3.3 实际系统模型实际系统模型参数: M =1.096 Kg ;m =0.109 Kg ;b =0.1 N/m/s ; l =0.25 m ;I =0.0034 kg ·m ·m ;采样频率 T =0.005 s 。
电气系统综合设计实验报告--直线一级倒立摆控制系统设计
电气控制系统设计——直线一级倒立摆控制系统设计学院轮机工程学院班级电气1111 姓名李杰学号 2011125036 姓名韩学建学号 2011125035 成绩指导老师肖龙海2014 年 12 月 25 日小组成员与分工:韩学建主要任务:二阶系统建模与性能分析,二阶控制器的设计,二阶系统的数字仿真与调试,二阶系统的实物仿真与调试。
二阶状态观测器的数字仿真与调试,二阶状态观测器的实物仿真与调试。
李杰主要任务:四阶系统建模与性能分析,四阶控制器的设计,四阶系统的数字仿真与调试,四阶系统的实物仿真与调试。
四阶状态观测器的数字仿真与调试,四阶状态观测器的实物仿真与调试。
前言倒立摆系统是非线性、强耦合、多变量和自然不稳定的系统,倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合,其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,可以作为一个典型的控制对象对其进行研究。
倒立摆系统作为控制理论研究中的一种比较理想的实验手段,为自动控制理论的教学、实验和科研构建一个良好的实验平台,以用来检验某种控制理论或方法的典型方案,促进了控制系统新理论、新思想的发展。
本报告通过设计二阶、四阶两种倒立摆控制器来加深对实际系统进行建模方法的了解和掌握随动控制系统设计的一般步骤及方法。
熟悉倒立摆系统的组成及基本结构并利用MATLAB对系统模型进行仿真,利用学习的控制理论对系统进行控制器的设计,并对系统进行实际控制实验,对实验结果进行观察和分析,研究调节器参数对系统动态性能的影响,非常直观的了解控制器的控制作用。
目录第一章设计的目的、任务及要求1.1 倒立摆系统的基本结构 (4)1.2 设计的目的 (4)1.3 设计的基本任务 (4)1.4 设计的要求 (4)1.5 设计的步骤 (5)第二章一级倒立摆建模及性能分析2.1 微分方程的推导 (5)2.2 系统的稳定性和能控能观性分析 (11)2.3 二阶的能观性、能控性分析 (13)2.4 四阶的能观性、能控性分析 (18)第三章倒立摆系统二阶控制器、状态观测器的设计与调试3.1 设计的要求 (22)3.2 极点配置 (22)3.3 控制器仿真设计与调试 (23)3.4 状态观测器仿真设计与调试 (28)第四章倒立摆系统四阶控制器、状态观测器的设计与调试4.1 设计的要求 (26)4.2 极点配置 (26)4.3 控制器仿真设计与调试 (27)4.4 状态观测器仿真设计与调试 (28)心得体会 (31)参考文献 (31)第一章设计的目的、任务及要求1.1 倒立摆系统的基本结构与工作原理图1.1 倒立摆系统硬件框图图1.2 倒立摆系统工作原理框图倒立摆系统通过计算机、I/O卡、伺服系统、倒立摆本体和光电码盘反馈测量元件组成一个闭环系统。
直线一级倒立摆PID控制实验报告
直线一级倒立摆PID 控制实验一.实验目的本实验的目的是让实验者理解并掌握PID 控制的原理和方法,并应用于直线一级倒立摆的控制,PID 控制并不需要对系统进行精确的分析,因此我们采用实验的方法对系统进行控制器参数的设置。
二.实验设备1:直线一级倒立摆:直线倒立摆是在直线运动模块上装有摆体组件,直线运动模块有一个自由度,小车可以沿导轨水平运动,在小车上装载一级倒立摆。
2.PC机和运动控制卡主机箱三.实验原理经典控制理论的研究对象主要是单输入单输出的系统,控制器设计时一般需要有关被控对象的较精确模型。
PID 控制器因其结构简单,容易调节,且不需要对系统建立精确的模型,在控制上应用较广。
首先,对于倒立摆系统输出量为摆杆的角度,它的平衡位置为垂直向上的情况。
系统控制结构框图如下:图 1 直线一级倒立摆闭环系统图图中KD(s) 是控制器传递函数,G(s) 是被控对象传递函数。
考虑到输入r(s) = 0,结构图可以很容易的变换成:图 2 直线一级倒立摆闭环系统简化图该系统的输出为:其中num ——被控对象传递函数的分子项den ——被控对象传递函数的分母项numPID ——PID 控制器传递函数的分子项denPID ——PID 控制器传递函数的分母项通过分析上式就可以得到系统的各项性能。
由(3-13)可以得到摆杆角度和小车加速度的传递函数:PID 控制器的传递函数为:需仔细调节PID 控制器的参数,以得到满意的控制效果。
在控制的过程中,小车位置输出为:通过对控制量v 双重积分即可以得到小车位置。
四.仿真步骤及结果图 3 直线一级倒立摆PID 控制MATLAB 仿真模型其中PID Controller 为封装(Mask )后的PID 控制器,双击模块打开参数设置窗口 先设置PID 控制器为P 控制器,令0,0,===kd ki kp ,得到以下仿真结果图4从图4中可以看出,闭环控制系统持续振荡,周期约为0.7s 。
(完整)倒立摆实验报告
专业实验报告摆杆受力和力矩分析θmg VH θX V X H图2 摆杆系统摆杆水平方向受力为:H 摆杆竖直方向受力为:V 由摆杆力矩平衡得方程:cos sin Hl Vl I φφθθπφθφ⎧-=⎪=-⎨⎪=-⎩(1) 代入V 、H ,得到摆杆运动方程。
当0φ→时,cos 1θ=,sin φθ=-,线性化运动方程:2()I ml mgl mlx θθ+-=1.2 传递函数模型以小车加速度为输入、摆杆角度为输出,令,进行拉普拉斯变换得到传递函数:22()()mlG s ml I s mgl=+- (2) 倒立摆系统参数值:M=1.096 % 小车质量 ,kg m=0.109 % 摆杆质量 ,kg0.1β= % 小车摩擦系数g=9.8 % 重力加速度,l=0.25 % 摆杆转动轴心到杆质心的长度,m I= 0.0034 % 摆杆转动惯量,以小车加速度为输入、摆杆角度为输出时,倒立摆系统的传递函数模型为:20.02725()0.01021250.26705G s s =- (3) 1.3 倒立摆系统状态空间模型以小车加速度为输入,摆杆角度、小车位移为输出,选取状态变量:(,,,)x x x θθ= (4)由2()I ml mgl mlx θθ+-=得出状态空间模型001001000000001330044x x x x x g g lμθθθθ⎡⎤⎡⎤⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥'==+⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎢⎥⎢⎥⎣⎦⎣⎦(5) μθθθ'⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=0001000001 xx x y (6) 由倒立摆的参数计算出其状态空间模型表达式:(7)010000001000100029.403x x x x x μθθθθ⎡⎤⎡⎤⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥'==+⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎣⎦⎣⎦(8)00x μθθ⎤⎥⎡⎤⎥'+⎢⎥⎥⎣⎦⎥⎥⎦作用)增大,系统响应快,对提高稳态精度有益,但过大易作用)对改善动态性能和抑制超调有利,但过强,即校正装Ax B Cx μ+= 1n x ⎥⎥⎥⎦,1n x x x ⎡⎤⎢⎥=⎢⎥⎢⎥⎣⎦,1111n n nn a A a a ⎡⎤⎢⎥=⎢⎥⎢⎥⎣⎦ , 1n B b ⎥⎥⎥⎦,]n C c =。
直线一级倒立摆PID控制实验报告
直线一级倒立摆PID 控制实验报告一、实验目的本实验的目的是让实验者理解并掌握 PID 控制的原理和方法,并应用于直线一级倒立摆的控制,PID 控制并不需要对系统进行精确的分析,因此我们采用实验的方法对系统进行控制器参数的设置。
二、实验设备直线一级倒立摆;安装有MATLAB 软件的PC 机;运动控制卡主机箱。
三、实验步骤及结果1、PID 控制参数设定及仿真对于 PID 控制参数,我们采用以下的方法进行设定:由实际系统的物理模型:(s)V (s)=0.027250.0102125s 2−0.26705 在 Simulink 中建立如图1所示的直线一级倒立摆控制模型:图1直线一级倒立摆 PID 控制 MATLAB 仿真模型先设置 PID 控制器为P 控制器,令K p =9,K i =0,K D =0,得到以下仿真结果:图2 参数设置窗口图3直线一级倒立摆P控制仿真结果图(K p=9)从图3中可以看出,控制曲线不收敛,因此增大控制量,令Kp =50,Ki=0,KD=0,得到以下仿真结果:图4直线一级倒立摆P控制仿真结果图(K p=50)从图4中可以看出,闭环控制系统持续振荡,周期约为 0.6s。
为消除系统的振荡,增加微分控制参数KD ,令 Kp=50, Ki=0, KD=16 ,得到仿真结果如下:图5直线一级倒立摆PD控制仿真结果图(K p=50,K D=16)从图5中可以看出,系统稳定时间过长,大约为7秒,因此再增加微分控制参数KD ,令:Kp=50, Ki=4, KD=16,仿真得到如下结果:图6直线一级倒立摆 PID 控制仿真结果图(K p=50,K i=4,K D=16)由于 PID 控制器为单输入单输出系统,所以只能控制摆杆的角度,并不能控制小车的位置,所以小车会往一个方向运动。
2、PID 控制实验1) 打开直线一级倒立摆 PID 控制界面入下图6所示:图6直线一级倒立摆 MATLAB 实时控制界面2) 双击"PID"模块进入 PID 参数设置,如下图7所示:图7 参数设置窗口把仿真得到的参数输入 PID 控制器,保存参数。
实验七 直线一级倒立摆根轨迹控制实验
实验七直线一级倒立摆系统根轨迹校正和仿真一、实验目的(1)了解直线倒立摆系统的组成以及系统建模的过程;(2)学习根轨迹法设计控制器的原理和方法;(3)学习用MA TLAB&SIMULINK对倒立摆系统建立模型的方法,并仿真实现;(4)学习用MA TLAB实现倒立摆控制器的设计,并仿真实现;(5)了解根轨迹校正实时控制方法和过程。
二、实验设备(1)直线倒立摆实验装置(2)电控箱(3)GT-400-SV-PCI运动控制卡(4)计算机(5)软件要求:Matlab6.5以上版本软件,VC++6.0软件,板卡自带Device Manager,倒立摆实时控制软件。
三、实验原理3.1 倒立摆系统组成(见附录4)3.2 倒立摆系统模型(见附录4)3.3 根轨迹分析闭环系统瞬态响应的基本特性与闭环极点的位置紧密相关,如果系统具有可变的环路增益,则闭环极点的位置取决于所选择的环路增益,从设计的观点来看,对于有些系统,通过简单的增益调节就可以将闭环极点移到需要的位置,如果只调节增益不能满足所需要的性能时,就需要设计校正器,常见的校正器有超前校正、滞后校正以及超前滞后校正等。
根据附录中公式(15)得到倒立舞者开环传递函数,输入为小车的加速度,输出为倒立摆系统摆杆的角度,被控对象的传递函数为:给系统施加脉冲扰动,输出量为摆杆的角度时,系统框图如下:图7-1 直线一级倒立摆闭环系统图(脉动干扰)考虑到输入r(s) = 0,结构图变换成:图7-2 直线一级倒立摆闭环系统简化图(脉动干扰)该系统的输出为:其中num ——被控对象传递函数的分子项;den ——被控对象传递函数的分母项;numlead 、denlead ——控制器超前环节传递函数的分子项;numlag 、denlag ——控制器滞后环节传递函数的分子项和分母项;k ——控制器增益实际系统的开环传递函数为:可以看出,系统有两个零点,有两个极点,并且有一个极点为正。
直线一级倒立摆系统实验报告
直线一级倒立摆系统实验报告1. 实验目的:通过对直线一级倒立摆系统进行分析,掌握系统的基本原理、参数设置和控制策略;提高学生实际动手能力和科学实验能力。
2. 实验内容:(1)搭建直线一级倒立摆系统实验平台;(2)设置系统的动力学模型,采集系统的状态变量;(3)根据系统的特性设计控制策略,实现系统的稳定控制;(4)记录实验数据,并进行数据处理和分析。
3. 实验原理:直线一级倒立摆系统是一种经典的非线性控制系统,其原理和稳定性分析可以使用动力学建模方法来描述。
系统由直线弹簧、质量块、直线导轨和质量块的摆杆组成。
当摆杆处于垂直状态时,系统处于平衡状态;当摆杆被扰动后,系统进入不稳定状态,需要通过控制策略来实现其稳定控制。
在实验中,我们选取了单摆系统作为直线一级倒立摆系统的原形。
单摆系统由一个质点和一个线性弹簧组成,其状态变量为质点的位置和速度。
当质点处于平衡位置时,系统拥有稳定状态;当质点被扰动后,系统进入不稳定状态,需要通过控制策略来实现其稳定控制。
因此,我们可以使用单摆系统来研究直线一级倒立摆系统的控制策略。
4. 实验步骤:(1)搭建实验平台:搭建直线一级倒立摆系统实验平台,包括直线导轨、摆杆、质点、力传感器、位移传感器和控制电路等。
将质点放置在导轨上,并用摆杆将其固定在弹簧上。
使用力传感器和位移传感器来测量系统的状态变量。
(2)设置系统模型:对实验平台的动力学模型进行建模,将系统的状态变量与控制策略联系起来。
(3)设计控制策略:根据系统的特性设计相应的控制策略,使系统保持稳定状态。
常用的控制策略包括模型预测控制、PID控制、滑模控制等。
(4)记录实验数据:实验过程中需要记录系统的状态变量和控制参数,并进行数据处理和分析,得到实验结论。
5. 实验结果分析:通过对直线一级倒立摆系统的实验研究,我们发现系统的稳定控制需要根据其特性和实际情况来确定相应的控制策略。
在实验中,我们采用了模型预测控制策略,通过对系统的状态变量进行预测和调节,成功实现了系统的稳定控制。
一级倒立摆实验报告
一级直线倒立摆极点配置控制实验一、实验目的1.运用经典控制理论控制直线一级倒立摆,包括实际系统模型的建立、根轨迹分析和控制器设计、PID 控制分析等内容。
2.熟悉利用极点配置方法来进行倒立摆实验的原理方法。
3.学习MATLAB工具软件在控制工程中的应用。
3.掌握对实际系统进行建模的方法,熟悉利用MATLAB 对系统模型进行仿真,利用学习的控制理论对系统进行控制器的设计,并对系统进行实际控制实验,对实验结果进行观察和分析,非常直观的感受控制器的控制作用。
二、实验设备计算机及MATLAB相关软件元创兴倒立摆系统的软件元创兴一级直线倒立摆系统,包括运动卡和倒立摆实物倒立摆相关安装工具三、倒立摆系统介绍倒立摆是进行控制理论研究的典型实验平台。
由于倒立摆系统的控制策略和杂技运动员顶杆平衡表演的技巧有异曲同工之处,极富趣味性,而且许多抽象的控制理论概念如系统稳定性、可控性和系统抗干扰能力等等,都可以通过倒立摆系统实验直观的表现出来。
学习自动控制理论的学生通过倒立摆系统实验来验证所学的控制理论和算法,非常的直观、简便,在轻松的实验中对所学课程加深了理解。
倒立摆不仅仅是一种优秀的教学实验仪器,同时也是进行控制理论研究的理想实验平台。
由于倒立摆系统本身所具有的高阶次、不稳定、多变量、非线性和强耦合特性,许多现代控制理论的研究人员一直将它视为典型的研究对象,不断从中发掘出新的控制策略和控制方法,相关的科研成果在航天科技和机器人学方面获得了广阔的应用。
四、倒立摆工作原理和物理模型以及数学模型(简述)1、工作原理:数据采集卡(也称运动控制卡,安装于计算机机箱的PCI插槽上)采集到旋转编码器数据和电机尾部编码器数据,旋转编码器与摆杆同轴,电机与小车通过皮带连接,所以通过计算就可以得到摆杆的角位移以及小车位移,角位移差分得角速度,位移差分可得速度,然后根据自动控制中的各种理论转化的算法计算出控制量。
控制量由计算机通过运动控制卡下发给伺服驱动器,由驱动器实现对电机控制,电机尾部编码器连接到驱动器形成闭环,从而可以实现闭环控制。
直线一级倒立摆实验报告
Gs KDs2 KPs KI
s
相当于给系统增加了一个位于原点的开环极点和两个位置可变的开环零点,因此 对于低阶已知数学模型的系统,根据期望的性能指标可以采用根轨迹法确定PID 参数。
2、频域法确定PID参数 对于已知频率特性曲线的系统,PID控制器相当于 给频率特性曲线增加了积分环节和一个二阶微分环节,通过调整PID参数,可以 改变PID控制器的频率特性,进而改变闭环系统的频率特性。
当摆杆被控时,小车的运动的位移也受到导轨实际长度的限制。因此,输出量除 了摆杆角度外,还有一个小车运动的位移。位移与输入量小车加速度之间的关系 为:
X (s) 1
Rs s2
控制系统结构图:
1
s2
Transfer Fcn1
Pos
3
In1 Out1
Step
s2+-29.4
Addห้องสมุดไป่ตู้
Transfer Fcn
Step 0.08
0.06
0.04
0.02
0
0
1
2
3
4
5
6
7
8
9
10
Pos.
0
-2
-4
0
1
2
3
4
5
6
7
8
9
10
Ang.
4
3
2
1
0
0
1
2
3
4
5
6
7
8
9
10
由曲线可以看出,系统角度超调量为33.6%,调整时间接近0.55秒,位移变化平 稳,角度输出稳定。故这组参数可以作为PID控制参数;
2、基于计算机MATLAB 平台进行现场倒立摆控制,绘制实验曲线; 直线一级倒立摆系统是小车在光滑的导轨上运动,小车上铰链了一根摆杆,
直线一级倒立摆系统实验报告
直线一级倒立摆系统实验报告西北工业大学姓名:张云虎探测制导与控制技术学号:2013300925 1.实验参数介绍2.根据实验指导书给的受力分析结合newton定律得出动力学方程:分析水平方向的合力有:M=F-f-N (1)分析摆杆水平方向的受力得;N-Fs=m(x+lsinθ) ps:Fs=0即N=m+mlθcosθ-mlθsinθ(2)把(2)带入(1)得到:(M+m)+f+ mlθcosθ-mlθsinθ=F(3)对垂直方向的合力进行分析得到:-P+mg+Fh=m(l-lcosθ) ps:Fh=0即P-mg= mlθsinθ+mlθcosθ(4)力矩平衡方程:Plsinθ+Nlcosθ+Iθ=0 (5)把公式(2)(4)带进(5)得到:(I+m)θ+mglsinθ=-ml(6)近似化处理得到:(I+m)ф-mglф=ml(M+m)+f-mlф=u写出状态空间模型:=Ax+Buy=Cx+Du==+ф+ uф=фф= +ф+ u写成矩阵形式,带入参数化简如下:фф =ф= uy= ф = фф+ u3.MATLAB分析:>> A=[0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0]A =0 1.0000 0 0 0 0 0 0 0 0 0 1.0000 0 0 29.4000 0>> B=[0;1;0;3]B =13>> C1=[1 0 0 0]C1 =1 0 0 0>> C2=[0 0 1 0]C2 =0 0 1 0>> C=[C1;C2]C =1 0 0 00 0 1 0>> D=[0;0]D =D1 =>> D2=[0]D2 =状态空间模型如下:>> sys1=ss(A,B,C,D)sys1 =a =x1 x2 x3 x4x1 0 1 0 0x2 0 0 0 0x3 0 0 0 1x4 0 0 29.4 0b =u1x1 0x2 1x3 0x4 3c =x1 x2 x3 x4y1 1 0 0 0y2 0 0 1 0d =u1y1 0y2 0Continuous-time state-space model.4.利用MATLAB判断系统的能控性与观性:>> Qc=ctrb(A,B);>> Qo1=obsv(A,C1);>> Qo2=obsv(A,C2);>> rank(Qc)ans =4>> rank(Qo1)ans =2>> rank(Qo2)ans =2>> rank(obsv(A,C))ans =4因为rank(ctrb(A.B))=4,所以系统可控;因为rank(obsv(A,C1))=2,所以输出1不可观测;因为rank(obsv(A,C2))=2,所以输出2不可观测;因为rank(obsv(A,C)=4,所以由全部输出是可观测的。
直线一级倒立摆控制器设计课程设计报告4
工业大学控制科学与工程系控制系统设计课程设计报告一.直线一阶倒立摆简介倒立摆是进行控制理论研究的典型实验平台。
倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合,其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,可以作为一个典型的控制对象对其进行研究。
最初研究开始于二十世纪50 年代,麻省理工学院(MIT)的控制论专家根据火箭发射助推器原理设计出一级倒立摆实验设备。
近年来,新的控制方法不断出现,人们试图通过倒立摆这样一个典型的控制对象,检验新的控制方法是否有较强的处理多变量、非线性和绝对不稳定系统的能力,从而从中找出最优秀的控制方法。
倒立摆系统作为控制理论研究中的一种比较理想的实验手段,为自动控制理论的教学、实验和科研构建一个良好的实验平台,以用来检验某种控制理论或方法的典型方案,促进了控制系统新理论、新思想的发展。
由于控制理论的广泛应用,由此系统研究产生的方法和技术将在半导体及精密仪器加工、机器人控制技术、人工智能、导弹拦截控制系统、航空对接控制技术、火箭发射中的垂直度控制、卫星飞行中的姿态控制和一般工业应用等方面具有广阔的利用开发前景。
平面倒立摆可以比较真实的模拟火箭的飞行控制和步行机器人的稳定控制等方面的研究。
一阶倒立摆系统的结构示意图如下所示:摆杆滑轨电机图1-1 一阶倒立摆结构示意图系统组成框图如下所示:图1-2 一级倒立摆系统组成框图系统是由计算机、运动控制卡、伺服机构、倒立摆本体和光电码盘几大部分组成的闭环系统。
光电码盘1将小车的位移、速度信号反馈给伺服驱动器和运动控制卡,白干的角度、角速度信号由光电码盘2反馈给运动控制卡。
计算机从运动控制卡中读取实时数据,确定控制决策(小车运动方向、移动速度、加速度等),并由运动控制卡来实现控制决策,产生相应的控制量,使电机转动,通过皮带带动小车运动吗,保持摆杆平衡。
二.直线一阶倒立摆数学模型的推导首先建立一阶倒立摆的物理模型。
倒立摆仿真及实验报告
最优控制实验报告二零一五年一月目录第1章一级倒立摆实验 (3)1.1 一级倒立摆动力学建模 (3)1.1.1 一级倒立摆非线性模型建立 (3)1.1.2 一级倒立摆线性模型建立 (5)1.2 一级倒立摆t∞状态调节器仿真 (5)1.3 一级倒立摆t∞状态调节器实验 (9)1.4 一级倒立摆t∞输出调节器仿真 (11)1.5 一级倒立摆t∞输出调节器实验 (13)1.6 一级倒立摆非零给定调节器仿真 (14)1.7 一级倒立摆非零给定调节器实验 (16)第2章二级倒立摆实验 (16)2.1 二级倒立摆动力学模型 (16)2.1.1 二级倒立摆非线性模型建立 (17)2.1.2 二级倒立摆线性模型建立 (18)2.2 二级倒立摆t∞状态调节器仿真 (19)2.3 二级倒立摆t∞状态调节器实验 (21)2.4 二级倒立摆t∞输出调节器仿真 (22)2.5 二级倒立摆t∞输出调节器实验 (22)2.6 二级倒立摆非零给定调节器仿真 (23)2.7 二级倒立摆非零给定调节器实验 (24)第1章一级倒立摆实验1.1一级倒立摆动力学建模在忽略了空气阻力和各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如图所示图1-1 直线一级倒立摆模型M小车质量1.096 kg;m 摆杆质量0.109 kg;b 小车摩擦系数0 .1N/m/sec;l 摆杆转动轴心到杆质心的长度0.25m;I 摆杆惯量0.0034 kg·m2;φ摆杆与垂直向上方向的夹角,规定角度逆时针方向为正;x 小车运动位移,规定向右为正。
1.1.1一级倒立摆非线性模型建立采用拉格朗日方法,系统的拉格朗日方程为:()()()=-(1.1)L q q T q q V q q,,,其中,L为拉格朗日算子,q为系统的广义坐标,T为系统的动能,V为系q和L表示为:统的势能。
拉格朗日方程由广义坐标ii i id L Lf dt q q ∂∂-=∂∂ (1.2)i f 为系统沿该广义坐标方向上的外力,在本系统中,系统的两个广义坐标分别为φ和x 。
直线一级倒立摆控制详细报告
直线一级倒立摆控制一、课程设计目的学习直线一级倒立摆的数学建模方法,运用所学知识设计PID控制器,并应用MATLAB进行仿真。
通过本次课程设计,建立理论知识与实体对象之间的联系,加深和巩固所学的控制理论知识,增加工程实践能力。
二、课程设计要求1. 应用动力学知识建立直线一级倒立摆的数学模型(微分方程形式),并建立系统的开环传递函数模型。
2. 运用经典控制理论知识,按设计要求设计控制器。
3. 应用MATLAB的Simulink建立控制系统的仿真模型,得出仿真结果。
4. 控制要求:※小车的位置x和摆杆角度的稳定时间小于10秒;※阶跃响应摆杆角度的摆幅小于2°;※θ有≤8°扰动时,摆杆的稳定时间小于三秒。
对比仿真结果与控制要求,修正设计值,使之满足设计要求。
三、控制系统建模过程1、控制对象示意图图1.控制对象示意图图中对象参数:M 小车质量 1.32kg l 摆杆转动中心到杆质心的距离0.27mm 摆杆质量0.132kg F 作用在系统上的外力X 小车位移θ 摆杆与竖直方向的夹角,以垂直向上为起始位置,取逆时针方向为正方向。
b 小车摩擦阻尼系数 m/sec 2. 控制系统模拟结构图:图2.系统的模拟结构图其中G1(s )表示关于摆角θ的开环传递函数,D(S)表示PID 控制器的传递函数,G2(s )表示小车位移x 的传递函数。
由于摆角与垂直向上方向夹角为0时为平衡状态,故摆角的理想输出值应为R (S )=0。
3. 建模过程:T图3.小车及摆杆的受力分析图如图3所示,对小车及摆杆进行受力分析,得到以下平衡方程:对小车有: 22..................................(1)dx d xF F b N M dt dt=--=∑小车对摆杆有:2222(cos ) (2)(cos ).............................(3)d F N m x l dt d Fmg P m l l dtθθ==-=-=-∑∑水平竖直转矩:2222sin cos ...................................(4)1 (5)23ll d T I Pl Nl dt mr I dr ml l θθθ-==+==∑⎰为使摆杆直立,需使θ≪1,则有sin ,cos 1θθθ≈≈, 线性化(2)(3)(4)方程得:2222() (6)0.......................................................................(7)..............................d N m x l dtmg P d I Pl Nl dtθθθ=--==+................................(8) 由(1)(5)(6)(7)(8)式联立解得:222222222() (9)4 (10)3d x d dxF M m ml b dt dt dtd d xmgl ml ml dt dtθθθ=+-+=- 对(9)(10)两式进行拉式变换,得:22222()()()()()4()()()3F S M m s X s Mls s bsX s mgl s ml s s mls X s θθθ=+-+=- 传递函数:13222432()3()()(4)43()3()43()()(4)43()3s sG s F s Ml ml s bls M m gs gbX s ls gG s F s Ml ml s bls M m gs gbsθ==++-+--==++-+-将数值带入后得到系统的传递函数:132224323() 1.461240.10842.6888 2.941.0829.4() 1.461240.10842.6888 2.94sG s s s s s G s s s s s =+---=+--四、应用Simulink建立仿真模型进行实验1.控制系统的simulink仿真结构图及仿真结果其中PID控制器的传递函数参数的初步范围可以由劳斯判据确定,具体过程如下:设PID控制器的传递函数为1()P I DD s K K K ss=++,则以θ为输出量的系统特征方程为111()()0P ID K K K s G s s+++= 整理得321.46124(30.108)(342.6888)(3 2.94)0D P I s K s K s K +++-+-=通过劳斯判据可以确定,若使系统稳定,则有0.48708(3 2.94)0.98,0,14.22960.1083I I D P DK K K K K ->>>++通过模拟系统反复实验,根据PID 各个参数的作用进行数值调整,得到使系统满足要求的PID 控制器的传递函数为:1()90092650D s s s=++2. 系统响应曲线在单位阶跃输入下,θ(t )的响应曲线为:从该响应曲线可以看出,此时系统的稳定时间小于10s ,且摆杆的摆幅小于2度,满足控制要求。
一阶倒立摆实验报告(实验)
一、实验介绍:1、背景介绍 (3)2、倒立摆简介 (3)3、实验目的 (5)4.预备知识 (5)二、实验内容:1.自学掌握MATLAB软件的基本使用方法 (6)2.自学掌握倒立摆的基本知识 (6)3.在MATLAB编程环境下完成以下实验操作 (6)4.在proteus环境下,完成倒立摆电机控制算法的仿真 (6)三、实验步骤:1.直线一阶倒立摆数学模型的推导‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥6 2.一阶倒立摆的微分方程模型‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥7 3.一阶倒立摆的传递函数模型‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥9 4.一阶倒立摆的状态空间模型‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥10 5.实际系统的传递函数与状态方程‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥12 6.用MATLAB的Simulink进行仿真‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥13四、实验总结:1、实验结论 (18)2、实验收获 (19)五、参考文献:一、实验介绍:1、背景介绍倒立摆装置被公认为自动控制理论中的典型实验设备,也是控制理论教学和科研中不可多得的典型物理模型。
它深刻揭示了自然界一种基本规律,即一个自然不稳定的被控对象,运用控制手段可使之具有良好的稳定性。
通过对倒立摆系统的研究,不仅可以解决控制中的理论问题,还能将控制理论所涉及的三个基础学科:力学、数学和电学(含计算机)有机的结合起来,在倒立摆系统中进行综合应用。
在多种控制理论与方法的研究和应用中,特别是在工程实践中,也存在一种可行性的试验问题,将其理论和方法得到有效的经验,倒立摆为此提供一个从控制理论通往实践的桥梁。
2、直线一阶倒立摆简介:倒立摆是进行控制理论研究的典型实验平台,可以作为一个典型的控制对象对其进行研究。
最初研究开始于二十世纪50 年代,麻省理工学院(MIT)的控制论专家根据火箭发射助推器原理设计出一级倒立摆实验设备。
近年来,新的控制方法不断出现,人们试图通过倒立摆这样一个典型的控制对象,检验新的控制方法是否有较强的处理多变量、非线性和绝对不稳定系统的能力,从而从中找出最优秀的控制方法。
直线一级倒立摆自动摆起控制实验
第5章 直线一级倒立摆自动摆起控制实验 对于直线一级倒立摆,其初始状态为静止下垂状态,为使其转化到竖直向上的状态,需要给摆杆施加力的作用。
上面的实验,我们都是采用手动的方法将摆杆提起,下面我们采用自动摆起的方法对其进行控制。
5.1 摆起的能量控制策略单个不受约束的倒立摆系统的能量为:)1(cos 212−+=⋅φφmgl J E 有:φφφφφφCos mul Sin mgl J dtdE ...−=−=⋅⋅ 其中 u ——为水平向右的控制量。
应用李亚普诺夫方法,令:2)(21ref E E V −= 则:φφCos mul E E dtdV ref .)(−−= 因此,令:φφCos E E k u ref .)(−=注意当00.=或=φφCos 时,0=u 。
另外,由于实际物理系统的限制,控制量不能太大,因此采用:⎪⎩⎪⎨⎧≤⋅−=02])[(.πθφφng Cos E E sign v ref其中,()sign 为取符号函数,g v n /max =为常数。
5.2 直线一级倒立摆摆起控制实验实时控制实验在MATALB Simulink 环境下进行,用户在实验前请仔细阅读使用手册。
z在进行MATLAB实时控制实验时,请用户检查倒立摆系统机械结构和电气接线有无危险因素存在,在保障实验安全的情况下进行实验。
实验步骤:1)在MATLAB Simulink中打开直线一级倒立摆起摆控制程序:(进入MATLAB Simulink 实时控制工具箱“Googol Education Products”打开“Inverted Pendulum\Linear Inverted Pendulum\Linear 1-Stage IP Swing-Up Control”中的“Swing-Up Control Demo)图 5-1直线一级倒立摆摆起实时控制程序2)其中“Swing-up Controller”为起摆控制模块。
(完整版)倒立摆实验报告(PID控制)
专业实验报告3. 实验装置直线单级倒立摆控制系统硬件结构框图如图1所示,包括计算机、I/O设备、伺服系统、倒立摆本体和光电码盘反馈测量元件等几大部分,组成了一个闭环系统。
图1 一级倒立摆实验硬件结构图对于倒立摆本体而言,可以根据光电码盘的反馈通过换算获得小车的位移,小车的速度信号可以通过差分法得到。
摆杆的角度由光电码盘检测并直接反馈到I/O设备,速度信号可以通过差分法得到。
计算机从I/O设备中实时读取数据,确定控制策略(实际上是电机的输出力矩),并发送给I/O设备,I/O设备产生相应的控制量,交与伺服驱动器处理,然后使电机转动,带动小车运动,保持摆杆平衡。
图2是一个典型的倒立摆装置。
铝制小车由6V的直流电机通过齿轮和齿条机构来驱动。
小车可以沿不锈钢导轨做往复运动。
小车位移通过一个额外的与电机齿轮啮合的齿轮测得。
小车上面通过轴关节安装一个摆杆,摆杆可以绕轴做旋转运动。
系统的参数可以改变以使用户能够研究运动特性变化的影响,同时结合系统详尽的参数说明和建模过程,我们能够方便地设计自己的控制系统。
图2 一级倒立摆实验装置图上面的倒立摆控制系统的主体包括摆杆、小车、便携支架、导轨、直流伺服电机等。
主图7 直线一级倒立摆PD控制仿真结果图从上图可以看出,系统在1.5秒后达到平衡,但是存在一定的稳态误差。
为消除稳态误差,我们增加积分参数Ki,令Kp=40,Ki=60,Kd=2,得到以下仿真结果:图8 直线一级倒立摆PID控制仿真结果图从上面仿真结果可以看出,系统可以较好的稳定,但由于积分因素的影响,稳定时间明显增大。
双击“Scope1”,得到小车的位置输出曲线为:图9 施加PID控制器后小车位置输出曲线图由于PID 控制器为单输入单输出系统,所以只能控制摆杆的角度,并不能控制小车的位置,所以小车会往一个方向运动,PID控制分析中的最后一段,若是想控制电机的位置,使得倒立摆系统稳定在固定位置附近,那么还需要设计位置PID闭环。
倒立摆仿真及实验报告
最优控制实验报告二零一五年一月目录第1章一级倒立摆实验 (3)1.1 一级倒立摆动力学建模 (3)1.1.1 一级倒立摆非线性模型建立 (3)1.1.2 一级倒立摆线性模型建立 (5)1.2 一级倒立摆t∞状态调节器仿真 (5)1.3 一级倒立摆t∞状态调节器实验 (10)1.4 一级倒立摆t∞输出调节器仿真 (12)1.5 一级倒立摆t∞输出调节器实验 (14)1.6 一级倒立摆非零给定调节器仿真 (16)1.7 一级倒立摆非零给定调节器实验 (17)第2章二级倒立摆实验 (18)2.1 二级倒立摆动力学模型 (18)2.1.1 二级倒立摆非线性模型建立 (18)2.1.2 二级倒立摆线性模型建立 (19)2.2 二级倒立摆t∞状态调节器仿真 (20)2.3 二级倒立摆t∞状态调节器实验 (23)2.4 二级倒立摆t∞输出调节器仿真 (24)2.5 二级倒立摆t∞输出调节器实验 (24)2.6 二级倒立摆非零给定调节器仿真 (25)2.7 二级倒立摆非零给定调节器实验 (26)第1章一级倒立摆实验1.1一级倒立摆动力学建模在忽略了空气阻力和各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如图所示图1-1 直线一级倒立摆模型M小车质量1.096 kg;m 摆杆质量0.109 kg;b 小车摩擦系数0 .1N/m/sec;l 摆杆转动轴心到杆质心的长度0.25m;I 摆杆惯量0.0034 kg·m2;φ摆杆与垂直向上方向的夹角,规定角度逆时针方向为正;x 小车运动位移,规定向右为正。
1.1.1一级倒立摆非线性模型建立采用拉格朗日方法,系统的拉格朗日方程为:()()()&&&(1.1)=-L q q T q q V q q,,,其中,L 为拉格朗日算子,q 为系统的广义坐标,T 为系统的动能,V 为系统的势能。
拉格朗日方程由广义坐标i q 和L 表示为:i i id L Lf dt q q ∂∂-=∂∂& (1.2)i f 为系统沿该广义坐标方向上的外力,在本系统中,系统的两个广义坐标分别为φ和x 。
一阶倒立摆课程设计报告4
哈尔滨工业大学控制科学与工程系控制系统设计课程设计报告姓名:院(系):英才学院专业:自动化班号:任务起至日期:课程设计题目:直线一级倒立摆控制器设计已知技术参数和设计要求:本课程设计的被控对象采用固高公司的直线一级倒立摆系统GIP-100-L。
系统内部各相关参数为:M小车质量0.5kg; m摆杆质量0.2kg; b小车摩擦系数0.1N/m/sec; l摆杆转动轴心到杆质心的长度0.3m; I摆杆惯量0.006kg*m*m; T采样时间0.005秒。
设计要求:1.推导出系统的传递函数和状态空间方程。
用Matlab进行阶跃输入仿真,验证系统的稳定性。
2.设计PID控制器,使得当在小车上施加0.1N的脉冲信号时,闭环系统的响应指标为:(1)稳定时间小于5秒;(2)稳态时摆杆与垂直方向的夹角变化小于0.1弧度。
3.设计状态空间极点配置控制器,使得当在小车上施加0.2m的阶跃信号时,闭环系统的响应指标为:(1)摆杆角度错误!未找到引用源。
和小车位移x的稳定时间小于3秒(2)x的上升时间小于1秒(3)错误!未找到引用源。
的超调量小于20度(0.35弧度)(4)稳态误差小于2%。
工作量:1.建立直线一级倒立摆的线性化数学模型;2.倒立摆系统的PID控制器设计、Matlab仿真及实物调试;3.倒立摆系统的极点配置控制器设计、Matlab仿真及实物调试。
工作计划安排:第3周:(1)建立直线一级倒立摆的线性化数学模型;(2)倒立摆系统的PID控制器设计、Matlab仿真;(3)倒立摆系统的极点配置控制器设计、Matlab仿真。
第4周:实物调试;撰写课程设计论文。
同组设计者及分工:各项工作独立完成指导教师签字年月日教研室主任意见:教研室主任签字年月日*注:此任务书由课程设计指导教师填写。
一.直线一阶倒立摆简介倒立摆是进行控制理论研究的典型实验平台。
倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合,其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,可以作为一个典型的控制对象对其进行研究。
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
直线一级倒立摆控制一、课程设计目的学习直线一级倒立摆的数学建模方法,运用所学知识设计PID控制器,并应用MATLAB进行仿真。
通过本次课程设计,建立理论知识与实体对象之间的联系,加深和巩固所学的控制理论知识,增加工程实践能力。
二、课程设计要求1. 应用动力学知识建立直线一级倒立摆的数学模型(微分方程形式),并建立系统的开环传递函数模型。
2. 运用经典控制理论知识,按设计要求设计控制器。
3. 应用MATLAB的Simulink建立控制系统的仿真模型,得出仿真结果。
4. 控制要求:※小车的位置x和摆杆角度的稳定时间小于10秒;※阶跃响应摆杆角度的摆幅小于2°;※θ有≤8°扰动时,摆杆的稳定时间小于三秒。
对比仿真结果与控制要求,修正设计值,使之满足设计要求。
三、控制系统建模过程1、控制对象示意图/ 101图1.控制对象示意图图中对象参数:M 小车质量 1.32kg l 摆杆转动中心到杆质心的距离 0.27mm 摆杆质量 0.132kg F 作用在系统上的外力/ 102X 小车位移θ 摆杆与竖直方向的夹角,以垂直向上为起始位置,取逆时针方向为正方向。
b 小车摩擦阻尼系数 0.1N/m/sec 2. 控制系统模拟结构图:图2.系统的模拟结构图其中G1(s )表示关于摆角θ的开环传递函数,D(S)表示PID 控制器的传递函数,G2(s )表示小车位移x 的传递函数。
由于摆角与垂直向上方向夹角为0时为平衡状态,故摆角的理想输出值应为R (S )=0。
3. 建模过程:T图3.小车及摆杆的受力分析图如图3所示,对小车及摆杆进行受力分析,得到以下平衡方程:对小车有: 22..................................(1)dx d xF F b N M dt dt=--=∑小车对摆杆有:/ 1032222(cos ) (2)(cos ).............................(3)d F N m x l dt d Fmg P m l l dtθθ==-=-=-∑∑水平竖直转矩:2222sin cos ...................................(4)1 (5)23ll d T I Pl Nl dt mr I dr ml l θθθ-==+==∑⎰为使摆杆直立,需使θ≪1,则有sin ,cos 1θθθ≈≈, 线性化(2)(3)(4)方程得:2222() (6)0.......................................................................(7)..............................d N m x l dtmg P d I Pl Nl dtθθθ=--==+................................(8) 由(1)(5)(6)(7)(8)式联立解得:222222222() (9)4 (10)3d x d dxF M m ml b dt dt dtd d xmgl ml ml dt dtθθθ=+-+=- 对(9)(10)两式进行拉式变换,得:22222()()()()()4()()()3F S M m s X s Mls s bsX s mgl s ml s s mls X s θθθ=+-+=- 传递函数:13222432()3()()(4)43()3()43()()(4)43()3s sG s F s Ml ml s bls M m gs gbX s ls gG s F s Ml ml s bls M m gs gbsθ==++-+--==++-+-/ 104将数值带入后得到系统的传递函数:132224323() 1.461240.10842.6888 2.941.0829.4() 1.461240.10842.6888 2.94sG s s s s s G s s s s s =+---=+--/ 105四、应用 Simulink 建立仿真模型进行实验1.控制系统的simulink 仿真结构图及仿真结果其中 PID 控制器的传递函数参数的初步围可以由劳斯判据确定,具体过程如下:/ 106设PID 控制器的传递函数为 1()P I D D s K K K s s=++, 则以θ为输出量的系统特征方程为111()()0P ID K K K s G s s+++= 整理得321.46124(30.108)(342.6888)(3 2.94)0D P I s K s K s K +++-+-=通过劳斯判据可以确定,若使系统稳定,则有0.48708(3 2.94)0.98,0,14.22960.1083I I D P DK K K K K ->>>++通过模拟系统反复实验,根据PID 各个参数的作用进行数值调整,得到使系统满足要求的PID 控制器的传递函数为:1()90092650D s s s=++2. 系统响应曲线在单位阶跃输入下,θ(t )的响应曲线为:从该响应曲线可以看出,此时系统的稳定时间小于10s,且摆杆的摆幅小于2度,满足控制要求。
7/ 10/ 108当有8o θ≤的扰动时,θ(t )的响应曲线为:此时,摆杆的稳定时间小于3s ,满足控制要求。
扰动脉宽为0.3s 时θ(t )的响应曲线/ 109在单位脉冲(脉宽0.3s ≤)输入下,θ(t )的响应曲线为:在单位阶跃输入下x (t )的响应曲线为:在单位脉冲(脉宽0.3s)输入下x(t)的响应曲线为:五、实习总结经过两个星期的实习,我们学习了直线一级倒立摆的数学建模方法,运用所学知识成功设计出了PID控制器,并应用Matlab进行了仿真。
最终使系统响应的超调量小于t t调整到了最好的状态,精确的满足了所要求的各个系统性能指标。
通过本20%,将,p s次实习,我们建立了理论知识与实体对象之间的联系,加深和巩固了所学的控制理论知识。
在实验开始阶段,由于对PID控制器各个参数的控制原理及作用不甚明了,没有将系统的时域性能指标与响应的仿真波形相结合,导致盲目调整,给实验的进行带来了极大的困难。
但是在后期通过查阅相关资料书籍,并结合所学知识,逐步对PID控制器各参数的控制围进行了进一步的确定,从而得到了使系统响应波形满足控制要求的参数。
以下即我们通过实习,对PID 控制器及其参数调整所做出的总结:1. PID 控制的原理和特点在工程实际中,应用最为广泛的调节器控制规律为比例、积分、微分控制,简称PID 控制,又称PID 调节。
当被控对象的结构和参数不能完全掌握,或得不到精确的数学模型时,控制理论的其它技术难以采用时,系统控制器的结构和参数必须依靠经验和现场调试来确定,这时应用PID 控制技术最为方便。
PID 控制器就是根据系统的误差,利用比例、积分、微分计算出控制量进行控制的。
比例(P )控制比例控制器的传递函数为()c p G s k =比例控制器是一种最简单的控制方式。
其控制器的输出与输入误差信号成比例关系。
它的作用是调整系统的开环增益,提高系统的稳态精度,加快响应速度。
当比例控制值增大时,系统的时间常数和阻尼系数均减小,但是过大的开环增益不仅会使系统的超调量增大,而且会使系统的稳定裕度变小,对高阶系统来说,甚至会使系统变得不稳定。
仅有比例控制时系统输出存在稳态误差(Steady-state error )。
积分(I )控制积分控制器的传递函数为:1()c i G s T s= 在积分控制中,控制器的输出与输入误差信号的积分成正比关系。
对一个自动控制系统,为了消除稳态误差,在控制器中必须引入“积分项”。
积分项对误差取决于时间的积分,随着时间的增加,积分项会增大。
这样,即便误差很小,积分项也会随着时间的增加而加大,它推动控制器的输出增大使稳态误差进一步减小,直到等于零。
采用积分器可以提高系统的型别,消除或减小系统的稳态误差,使系统的稳态性能得到改善。
但是单独引用积分器会影响系统的稳定性,并使系统的反应速度降低。
因此,比例+积分(PI)控制器,可以使系统在进入稳态后无稳态误差。
微分(D )控制微分控制器的传递函数为:()c d G s T s在微分控制中,控制器的输出与输入误差信号的微分(即误差的变化率)成正比关系。
自动控制系统在克服误差的调节过程中可能会出现振荡甚至失稳。
解决的办法是使抑制误差的作用的变化“超前”,即在误差接近零时,抑制误差的作用就应该是零。
这就是说,在控制器中仅引入 “比例”项往往是不够的,比例项的作用仅是放大误差的幅值,而目前需要增加的是“微分项”,它能预测误差变化的趋势,这样,具有比例+微分的控制器,就能够提前使抑制误差的控制作用等于零,甚至为负值,从而避免了被控量的严重超调。
所以对有较大惯性或滞后的被控对象,比例+微分(PD)控制器能改善系统在调节过程中的动态特性。
2.本实验中PID 控制器的参数整定过程及经验实验中,首先通过计算系统的特征方程式,应用劳斯稳定性判据计算出PID 控制器的参数起始围,此时所得到的计算数据并不能使系统达到所需要求,必须经过系统模拟进行调整和修改。
因此通过对控制系统进行simulink仿真试验,使输入脉冲r(t)=10(t)(为使系统的超调量更加清晰直观便于计算),根据PID控制器各参数的作用进行调整,使系统响应曲线满足要求的超调量围。
然后,将阶跃输入除去,加入扰动。
由于实际扰动是力,但本实验所要求的扰动为摆杆角度,并不能通过角度得知力的大小,故本系统所加的扰动为角度,且需将此扰动作为输入量进行试验,经反复调整,对控制器参数进行整定与完善,使系统在阶跃输入和增加扰动两种情况下均满足控制要求。
在调整过程中,按照先比例,再积分,后微分的顺序,即先提高系统的稳态精度,加快响应速度,再减小系统的超调量,从而将PID控制器参数确定在某个大致围,再经过小围反复调整可以更迅速的将系统调整到使之满足控制要求的围。
参考文献:《MATLAB运用参考与指南》,《自动控制学习指导》,电子大学《自动控制原理》,清华大学。