倒立摆校正装置的设计

1自动控制原理课程设计报告倒立摆系统的控制器设计指导教师：谢昭莉学生：冯莉学号：20095099专业：自动化班级：2009级3班设计日期：2011.12.12—2011.12.23重庆大学自动化学院2011年12月2重庆大学本科学生课程设计任务书课程设计题目倒立摆系统的控制器设计学院自动化学院专业自动化年级已知参数和设计要求：M：小车质量1.096kgm：摆杆质量0.109kgb：小车摩擦系数0.1N/secl：摆杆转动轴心到杆质心的长度0.25mI：摆杆惯量0.0034kgm2利用根轨迹法设计控制器,使得校正后系统的性能指标满足:调整时间误差带）%(.250sts最大超调量%10%p利用频率特性法设计控制器，使得校正后系统的性能指标满足：(1)系统的静态位置误差常数为10；(2)相位裕量为50；(3)增益裕量等于或大于10分贝。设计或调整PID控制器参数，使得校正后系统的性能指标满足：调整时间误差带）%2(2sts最大超调量%15%p3学生应完成的工作：1、利用设计指示书中推导的模型及任务书中的实际参数，建立小车倒立摆的实际数学模型。2、进行开环系统的时域分析。3、利用根轨迹法设计控制器，进行闭环系统的仿真分析。4、利用频域法设计控制器，进行闭环系统的仿真分析。5、设计PID控制器，进行闭环系统的仿真分析。6、所设计的控制器在倒立摆系统上的实时控制实验。7、完成课程设计报告。参考资料：1、固高科技有限公司.直线倒立摆安装与使用手册R1.0，20052、固高科技有限公司.倒立摆与自动控制原理实验，20053、固高科技有限公司.固高MATLAB实时控制软件用户手册，20054、Matlab/Simulink相关资料5、涂植英，陈今润.自动控制原理.重庆：重庆大学出版社，20056、胡寿松.自动控制原理.北京：科学出版社，20017、KatsuhikoOgata.现代控制工程.北京：电子工业出版社，20034课程设计的工作计划：1、布置课程设计任务；参考相关资料，消化课程设计内容，进行初步设计（3天）；2、按课程设计的要求进行详细设计（4天）；3、进行实时控制实验，并按课程设计的规范要求撰写设计报告（2天）；4、课程设计答辩，实时控制验证（1天）。任务下达日期2011年12月12日完成日期2011年12月23日指导教师（签名）学生（签名）5目录1倒立摆系统的研究背景和意义………………………………………12小车倒立摆系统模型的假设…………………………………………13符号说明………………………………………………………………24模型的建立……………………………………………………………24.1牛顿力学法系统分析………………………………………………………24.2拉氏变换后实际系统的模型………………………………………………65开环响应分析…………………………………………………………76根轨迹法设计超前校正装置函数……………………………………96.1校正前倒立摆系统的闭环传递函数的析…………………………………96.2系统稳定性分析……………………………………………………………96.3期望闭环极点的确定……………………………………………………106.4超前校正装置传递函数的设计…………………………………………116.4.1校正参数计算…………………………………………………………………116.4.2控制器的确定…………………………………………………………………136.4.3校正装置的改进………………………………………………………………136.4.4Simulink仿真…………………………………………………………………1567直线一级倒立摆频域法设计…………………………………………177.1系统频域响应分析…………………………………………………………177.2频域法控制器设计…………………………………………………………197.2.1控制器的选择………………………………………………………………197.2.2系统开环增益的计算………………………………………………………197.2.3校正装置的频率分析………………………………………………………207.2.4控制器转折频域和截止频域的求解………………………………………227.2.5校正装置的确定……………………………………………………………227.2.6Simulink仿真………………………………………………………………248直线一级倒立摆的PID控制设计…………………………………258.1PID简介…………………………………………………………………258.2PID控制设计分析………………………………………………………258.3PID控制器的参数测定…………………………………………………269总结与体会……………………………………………………………299.1总结………………………………………………………………………299.2体会………………………………………………………………………2910参考文献……………………………………………………………307摘要倒立摆是一种典型的非线性，多变量，强耦合，不稳定系统，许多抽象的控制概念如系统的稳定性、可控性、系统的抗干扰能力等都可以通过倒立摆直观的反应出来；倒立摆的控制思想在实际中如实验、教学、科研中也得到广泛的应用；在火箭飞行姿态的控制、人工智能、机器人站立与行走等领域有广阔的开发和利用前景。因此，对倒立摆系统的研究具有十分重要的理论和实践意义。本文首先将直线倒立摆抽象为简单的模型以便于受力分析进行机理建模，然后通过牛顿力学原理进行分析，得出相应的模型，进行拉氏变化带入相应参数得出摆杆角度和小车位移、摆杆角度和小车加速度、摆杆角度和小车所受外界作用力、小车位移与小车所受外界作用力的传递函数，其中摆杆角度和小车加速度之间的传递函数为：02()0.02725()()0.01021250.26705sGsVss………………………(1)即我们在本次设计中主要分析的系统的传递函数。8然后从时域角度着手，分析直线一级倒立摆的开环单位阶跃响应和单位脉冲响应，利用Matlab中的Simulink仿真工具进行仿真，得出结论该系统的开环响应是发散的。最后分别利用根轨迹分析法，频域分析法和PID控制法对倒立摆系统进行校正。针对目标一：调整时间0.5(2%)sts误差带，最大超调量%10%p，选取参数利用根轨迹法进行校正，得出利用超前校正环节的传递函数为：135.1547(5.0887)()135.1547csGss…………………………………………(2)针对目标二：系统的静态位置误差常数为10；相位裕量为50；增益裕量等于或大于10分贝。通过频域法得出利用超前校正环节的传递函数为：1189.6(8.15)()99.01csGss…………………………………………………(3)针对目标三：调整时间误差带）%2(2sts，最大超调量，%15%p，设计或调整PID控制器参数，得出调整后的传递函数为：150()21020cGsss………………………………………..(4)关键词：直线一级倒立摆根轨迹分析频域分析PID控制911倒立摆系统的研究背景和意义倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合，其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统，可以作为一个典型的控制对象对其进行研究。通过倒立摆这样一个典型的控制对象，检验新的控制方法是否有较强的处理多变量、非线性和绝对不稳定系统的能力，从而从中找出最优秀的控制方法。倒立摆系统作为控制理论研究中的一种比较理想的实验手段，为自动控制理论的教学、实验和科研构建一个良好的实验平台，以用来检验某种控制理论或方法的典型方案。由此系统研究产生的方法和技术将在半导体及精密仪器加工、机器人控制技术、人工智能、导弹拦截控制系统、航空对接控制技术、火箭发射中的垂直度控制、卫星飞行中的姿态控制和一般工业应用等方面具有广阔的利用开发前景。[1]平面倒立摆可以比较真实的模拟火箭的飞行控制和步行机器人的稳定控制等方面的研究。倒立摆系统中最基本、经典的是平面直线一级倒立摆，它是在直线运动模块上装有摆体组件，直线运动模块有一个自由度，小车可以沿导轨水平运动，在小车上装载一级摆体组件。2小车倒立摆系统模型的假设1、假设空气阻力为0；2、假设系统各部分连接处的摩擦力分布均匀；3、假设摆杆的质量分布均匀；4、皮带传动时没有弹性；23符号说明1、M——小车质量1.096kg2、m——摆杆质量0.109kg3、b——小车摩擦系数4、l——摆杆转动轴心到杆质心的长度0.25m5、I——摆杆惯量6、F——加在小车上的力7、x——小车位置8、——摆杆与垂直向上方向的夹角9、——摆杆与垂直向下方向的夹角4模型的建立4.1牛顿力学法系统分析通过以上假设，将倒立摆抽象为如图所示的系统3FMmxdxbdtl图4-1-1、直线一级倒立摆物理模型对系统进行受力分析，如图4-1-2小车和摆杆的受力图。其中，N和P分别为小车与摆杆相互作用力的水平和垂直方向的分量。在实际倒立摆系统中检测和执行装置的正负方向是确定的，矢量方向定义如图2所示，规定水平向右为矢量正方向。[2]4FNPxxdxbdtmg22dIdt图4-1-2直线一级倒立摆受力分析首先对小车水平方向所受的合力和对摆杆水平方向的受力进行分析，得到系统的第一个运动方程。对小车水平方向所受的合力进行分析，得到如下方程：22dxdxMFbNdtdt（4-1-1）对摆杆水平方向的受力进行分析，得到如下面方程：22(sin)dNmxldt（4-1-2）即：22222N=m+mlcosml()sindxdddtdtdt（4-1-3）把这个表达式代入式(4-1)中，得到系统的第一个运动方程：22222()cos()sinddxddMmbmlmlFdtdtdtdt（4-1-4）5然后通过对摆杆垂直方向上的合力进行分析，得到系统的第二个运动方程。对摆杆垂直方向上的合力进行分析，得到方程如下：22(cos)dPmgmldt（4-1-5）222sin()cosddPmgmlmldtdt（4-1-6）力矩平衡方程如下：22sincosdPlNlIdt（4-1-7）此方程中力矩的方向，如图所示,则cossin,sinsin，故等式前面有负号。合并这两个方程，约去P和N，得到第二个运动方程：22222()sincosddxImlmglmldtdt（4-1-8）设（是摆杆与垂直向上方向之间的夹角），假设与1（单位是弧度）相比很小，即1，则可以进行近似认为2cos1,sin,()0ddt。用u来代表被控对象的输入力F，线性化后两个运动方程如下[3]：2222222222()()()ddxImlmglmldtdtdxdxdMmbmludtdtdt（4-1-9）假设初始条件为0，对式(3-9)进行拉普拉斯变换，得到：22222()()()()()()()()()ImlssmglsmlXssMmXssbXssmlssUs（4-1-10）由于输出为角度φ，求解方程组的第一个方程，可以得到：22()()()ImlgXssmls（4-1-11）6222()()()smlsXsImlsmgl（4-1-12）令v=x，则有：22()()()smlVsImlsmgl（4-1-13）把上式代入方程组的第二个运动方程，得到：22222()()()()()()()ImlgImlgMmssbssmlssUsmlsmls（4-1-14）整理后得到传递函数：22432()()()()mlssqbImlM