单级倒立摆稳定控制

课程设计任务书课程设计任务书 学生姓名 学生姓名 王建华王建华 专业班级 专业班级 自动化自动化 10051005 班班 指导教师 指导教师 陈跃鹏陈跃鹏 工作单位 工作单位 自动化学院自动化学院 题题 目目 单级移动倒立摆建模及串连超前校正单级移动倒立摆建模及串连超前校正 初始条件 初始条件 要求完成的主要任务要求完成的主要任务 包括课程设计工作量及其技术要求 以及说明书撰写等具体要 求 1 研究该装置的非线性数学模型 并提出合理的线性化方法 建立该装置 的线性数学模型 传递函数 以 u 为输入 为输出 2 要求系统输出动态性能满足试设计串连超前校正装置 1 3 4 sts 3 用 Matlab 对校正后的系统进行仿真分析 比较校正装置加在线性化前的 模型上和线性化后的模型上的时域相应有何区别 并说明原因 时间安排 时间安排 任务时间 天 审题 查阅相关资料 2 分析 计算 2 编写程序 2 撰写报告 1 论文答辩 0 5 指导教师签名 指导教师签名 年年 月月 日日 图示为一个倒立摆装置 该装置包含一 个小车和一个安装在小车上的倒立摆杆 由 于小车在水平方向可适当移动 因此 控制 小车的移动可使摆杆维持直立不倒 2 10 1 1 0 1smgmlkgmkgM 系主任 或责任教师 签名 系主任 或责任教师 签名 年年 月月 日日 目录目录 摘要摘要 1 1 一级倒立摆数学模型建立一级倒立摆数学模型建立 2 1 1一级倒立摆的组成 2 1 2应用牛顿力学建立系统数学模型 2 1 3数学模型的线性化 4 2 校正前系统动态性能分析校正前系统动态性能分析 4 2 1待校正系统阶跃响应曲线 4 2 2待校正系统根轨迹分析 5 3 串联超前校正设计分析串联超前校正设计分析 6 3 1系统校正前性能指标要求分析 6 3 2校正环节设计分析 7 3 3校正后系统动态性能分析 8 3 4系统参数的修正 9 4 SIMULINK 仿真设计仿真设计 11 4 1MATLAB 及 SIMULINK 11 4 2绘制系统仿真结构图并进行 SIMULINK仿真 11 5 系统校正前后动态性能比较系统校正前后动态性能比较 13 5 1待校正系统的阶跃响应曲线 根轨迹图 BODE图和 NYQUIST图 13 5 2校正以后系统的阶跃响应曲线 根轨迹图 BODE图和 NYQUIST图 13 6 小结小结 14 7 心得体会心得体会 15 8 附录附录 倒立摆在倒立摆在 MATLAB 中自带的倒立摆模型中自带的倒立摆模型 16 参考文献 18 武汉理工大学 自动控制原理 课程设计说明书 1 摘要摘要 在控制理论发展的过程中 某一理论的正确性及在实际中的可行性需要一个按其理 论设计的控制器去控制一个典型对象来验证 倒立摆就是这样一个对象 倒立摆是一个 多变量 快速 非线性 强耦合 不稳定的系统 通过对它引入一个适当的控制方法使 之成为一个稳定系统 来验证控制方法对不稳定性 非线性和快速性系统的处理能力 倒立摆模型和日常见到的任何重心在上 支点在下的控制问题都有很大的相似性 因此对它的稳定控制在实际中有很多应用 例如 海上钻井平台的稳定控制 卫星发射 架的稳定控制 火箭姿态控制 飞机安全着陆等都属于此类 在控制系统的分析和设计中 首先要建立系统的数学模型 倒立摆的数学模型可以 用分析力学中的牛顿力学方法来建立 非线性模型难于研究 可将倒立摆模型线性化 分析其稳定性并设计合适的校正装置 本文使用的是基于极点配置法的串联超前校正装 置 然后需要利用 MATLAB 绘制校正后系统的单位阶跃响应曲线 根轨迹等验证系统稳 定性并分析其动态性能是否达到指标要求 最后 可以使用 MATLAB 中的 Simulink 来对 实验模型进行仿真 再次验证校正装置的可靠性 关键词关键词 MATLAB 倒立摆 控制系统 串联超前校正 武汉理工大学 自动控制原理 课程设计说明书 2 单级移动倒立摆建模及串连超前校正单级移动倒立摆建模及串连超前校正 1 一级倒立摆数学模型建立一级倒立摆数学模型建立 1 1 一级倒立摆的组成一级倒立摆的组成 一级倒立摆主要以下 4 部分组成 1 在有限长的轨道 L 上作直线运动的小车 2 与小车铰链在一起 并能在包含 L 的平面内绕 O 点转动的摆 3 驱动小车的传动机构 4 使摆稳定在垂直向上的平衡位置的控制器 一级倒立摆的结构参数 小车的质量 M 1kg 摆的质量 m 0 1kg 摆长 L 1m 重力加速度取值 g 10m 2 1 2应用牛顿力学建立系统数学模型应用牛顿力学建立系统数学模型 根据以上结构数据 假设小车系统受合外力为 u 忽略轨道及铰链的摩擦力影响 采 用先整体后隔离的方法分析系统受力情况 整体系统的受力分析 如图 1 1 所示 摆杆重心距离左边参考位置距离为 1 sin 2 xL 小车距离左边参考位置距离为x 1 水平方向上整体受力平衡方程 2 2 22 1 sin 2 t xL x MmF tt 武汉理工大学 自动控制原理 课程设计说明书 3 图 1 1 倒立摆受力分析示意图 2 摆杆的受力分析 如图 1 2 所示 图 1 2 摆杆转矩分析示意图 将摆杆作为隔离体 然后对其进行受力分析 摆的转动惯量为 2 1 3 JmL 铰链给摆杆转动方向的力矩为 2 2 1 cos 2 x HmL t 角加速度为 2 2 t 则摆在运动中的力矩平衡方程为 武汉理工大学 自动控制原理 课程设计说明书 4 22 22 11 cossin 22 x JmLmL tt 1 3数学模型的线性化数学模型的线性化 以上两个方程均是关于 的非线性微分方程 为了便于分析方便并得到解析解 需对 方程组进行必要的线性化处理 控制的目的是使摆稳定于竖直位置附近 小车稳定于轨 道附近 在施加合适外力的作用下 因此假设 x x 均近似为 0 是合理的 在 F 0 的 平衡点 X 0 0 附近线性化 令 sin cos 1 并忽略二次以上的项 2 0 得到线性化后的微分方程组 2 1 2 11 0 32 mM xmLF t mLmL xg 对方程进行拉普拉斯变换得到 22 222 1 2 11 0 32 ss sss smM s xmLsF mL smL s xg 根据任务书中所给条件可求得系统传递函数为 2 1 0 6811 s sFs 2 校正前系统动态性能分析校正前系统动态性能分析 2 1 待校正系统阶跃响应曲线待校正系统阶跃响应曲线 校正前 系统的开环传递函数为 2 0 1 0 6811 sG s 武汉理工大学 自动控制原理 课程设计说明书 5 通过使用 MATLAB 可绘制出系统的单位阶跃响应曲线如图 2 1 所示 求解过程的 MATLAB 文本如下 num 1 den 0 68 0 11 描述开环传递函数的分子 分母多项式 sys0 tf num den 系统建模 sys feedback sys0 1 加入单位负反馈 得到闭环传递函数 step sys 计算系统的单位阶跃响应 运行程序后 可得到系统的单位阶跃响应曲线 图 2 1 单位阶跃响应曲线 由上图可见该系统是不稳定的 需要进行校正 2 2待校正系统根轨迹分析待校正系统根轨迹分析 同样适用 MATLAB 也可以绘制出待校正系统的 Nyquist 图 相应 MATLAB 文本如 下 num 1 den 0 68 0 11 描述开环传递函数的分子 分母多项式 sys0 tf num den 系统建模 nyquist sys0 计算系统 Nyquist 图 武汉理工大学 自动控制原理 课程设计说明书 6 在 MATLAB 中运行文本后可得到待校正系统的 Nyquist 图如图 2 1 所示 图 2 2 待校正系统 Nyquist 图 从图中也可看出 该系统为非最小相位系统 在 S 的右半平面存在一个极点 因此 系统不稳定 3 串联超前校正设计分析串联超前校正设计分析 3 1系统校正前性能指标要求分析系统校正前性能指标要求分析 对于一级倒立摆系统 主要设计如下 2 个性能指标要求 超调量 4 3 调节时间 1sts 这里取误差范围为 2 则由公式可知 武汉理工大学 自动控制原理 课程设计说明书 7 2 1 2 4ln 1 s n e t 将上述性能指标代入公式 得到一级倒立摆系统的 2 个性能指标满足 0 707 6 15 0 707n 取 6 15 n 将得到的阻尼比与自然频率值代入下式 2 12 1ns sj 得到倒立摆系统的两个主导极点为 124 354 35 4 354 35 sjsj 系统校正前的开环特征方程为 2 0 6811sDs 可得系统开环极点为 214 02 4 02ss 系统有一个不稳定的极点 24 02s 可见系统是不稳定的 属于非最小相位系统 3 2校正环节设计分析校正环节设计分析 在经典控制理论中 已知系统的极点决定了系统的稳定性 根据稳定性分析可知 一级倒立摆只有一个特征方程 根据经典控制理论 系统的性能由主导极点近似决定 根据这一理论来对单级移动倒立摆进行校正设计 系统为非最小相位系统 且有一个不稳定的极点 可以考虑采用基于极点配置法的 串联校正来改善系统性能以达到指标要求 对于一级倒立摆可用距离虚轴最近的两个极点 即主导极点的性能来代替 并配置 另外一个非主导极点 S3 该极点应距主导极点 4 倍以上 不妨取 3521 74 ns 系统的期望特征方程为 4 354 35 4 354 35 21 74 sDsjsjs 展开可得 32 30 44226 99822 86 sDsss 加入串联超前校正 1 0 2 1 1 c s KT s G T s 武汉理工大学 自动控制原理 课程设计说明书 8 校正后系统闭环特征方程为 21 32 222 11111 0 680 68 cc s TK TK Dsss TTT 通过系统期望方程系数与校正后系统系数对比可得方程组 2 21 2 2 1 30 44 11 226 99 0 68 11 822 86 0 68 c c T T K T T K T 解得 120 185 0 033 29 38 cTTK 所以系统校正后开环传递函数为 2 29 38 1 0 185 0 6811 1 0 033 s s G ss 3 3校正后系统动态性能分析校正后系统动态性能分析 用 MATLAB 绘制校正后系统的单位阶跃响应曲线 MATLAB 文本如下 num 29 8 0 185 1 den conv 0 68 0 11 0 033 1 系统校正后传递函 数分子 分母多项式 sys0 tf num den 系统建模 sys feedback sys0 1 加入单位负反馈 step sys 计算系统的单位阶跃响应 得到系统单位阶跃响应曲线如图 3 1 所示 武汉理工大学 自动控制原理 课程设计说明书 9 图 3 1 系统校正后单位阶跃响应曲线 校正系统后 系统超调量 13 4 3 调节时间 0 8511 stss 显然系统超调量 过大 需要重新选择阻尼比 增大阻尼比可以减小超调量但是调节时间会增大 因此 需要找出满足要求的临界范围 3 4系统参数的修正系统参数的修正 对于一级倒立摆系统 在已知性能指标 采用过阻尼的控制时 系统响应缓慢 因 此不希望采用过阻尼控制 另一方面 如果加快动态过程 采用欠阻尼控制 那么系统 会出现多次震荡 对于一级倒立摆来说 可靠性会较低 这种要求相应较快 出现震荡 也较少的情况下 采用阻尼比较大的控制 即超调量应取较小值 通过以上分析可知 阻尼比比需要增大一定值 通过试探法最终确定阻尼比可取值 0 86 则自然频率可取值 2 4ln 1 5 43 n 再次重复 3 2 中校正环节设计 重新得到系统校正后开环传递函数为 0 2 25 32 1 0 2167 0 6811 1 0 0306 s s G ss 武汉理工大学 自动控制原理 课程设计说明书 10 再次用 MATLAB 绘制修正后系统的的单位阶跃响应曲线 相应 MATLAB 文本如下 num 25 32 0 2167 1 den conv 0 68 0 11 0 0306 1 系统传递函数分子 分母多项式 sys0 tf num den 系统建模 sys1 feedback sys0 1 加入单位负反馈 step sys1 计算单位阶跃响应 输入文本后 可得到修正后的单位阶跃响应曲线如图 3 2 所示 图 3 2 修正参数后系统单位阶跃响应曲线 可以从图中看出 校正后系统超调量 4 24 4 3 调节时间 0 9131 stss 均 能满足要求的性能指标 串联超前校正到此设计完成 武汉理工大学 自动控制原理 课程设计说明书 11 4 SIMULINK 仿真设计仿真设计 4 1MATLAB 及及 SIMULINK MATLAB 是美国 MathWorks 公司出品的商业数学软件 用于算法开发 数据可视化 数据分析以及数值计算的高级技术计算机语言和交互式环境 主要包括 MATLAB 和 Simulink 两大部分 而 Simulink 是 MATLAB 最重要的组件之一 它提供一个动态系统建模 仿真和综合 分析的集成环境 在该环境下 无需大量书写程序 而只需通过简单直观的鼠标操作 就可构造出复杂的系统 Simulink 具有适应面广 结构和流程清晰及仿真精细 贴近实际 等优点 并基于以上优点 Simulink 已被广泛应用于控制理论和数字信号处理的复杂仿真 和设计 同时有大量的第三方软件和硬件可应用于或被要求应用于 Simulink 4 2绘制系统仿真结构图并进行绘制系统仿真结构图并进行 Simulink 仿真仿真 1 系统校正完毕后 可以利用 simulink 对系统进行仿真 1 在 MATLAB 命令窗口下选择 File New Model 菜单项 打开 untitled 窗 口 2 在 MATLAB 命令窗口下选择 Start Simulink Library Browser 菜单项 加载 元件库 3 在 Libraries 中选择 Simulink Sources 选项 选择 Step 模块 并拖拽至 Untitled 模型窗口 在 Sinks 中选择 Scope 显示模块 在 Continuous 中选择 Transfer Fcn 模块 在 Math Operations 中选择 Gain 模块 都分别拖至 untitled 窗口中 4 双击 Transfer Fcn 模块 在弹出的对话框中修改参数 分别输入系统的分 子 分母系数 即可得到系统相应模型 双击 Gain 模块 修正参数 5 设置仿真参数 连线 2 按照以上步骤可绘得系统仿真结构图如图 4 1 所示 武汉理工大学 自动控制原理 课程设计说明书 12 图 4 1 线性化后系统仿真结构图 3 在 untitled 窗口下选择 Simulation Start 菜单开始仿真 双击 Scope 得到仿真波 形 图 4 2 系统 Simulink 仿真波形 从仿真图中可以观察到 系统从响应开始到趋向稳定 仅用了不到 1s 的时间稳态值 趋近于 1 8 武汉理工大学 自动控制原理 课程设计说明书 13 5 系统校正前后动态性能比较系统校正前后动态性能比较 使用 MATLAB 中 LTI Viewer 工具 来比较校正前后系统稳定性及动态性能 将 Workspace 中的闭环传递函数导入 LTI Viewer 中 在 LTI Viewer 窗口下选择想要显示的 曲线图 通过校正前后系统阶跃响应等曲线的对比分析可以很直观的发现校正前后系统 稳定性及动态性能的差异 5 1待校正系统的阶跃响应曲线 根轨迹图 待校正系统的阶跃响应曲线 根轨迹图 Bode 图和图和 Nyquist 图图 导入待校正系统的传递函数后可得到系统各曲线图如下图 5 1 所示 图 5 1 待校正系统阶跃响应 根轨迹 Bode 图 Nyquist 图 5 2校正以后系统的阶跃响应曲线 根轨迹图 校正以后系统的阶跃响应曲线 根轨迹图 Bode 图和图和 Nyquist 图图 导入校正后系统闭环传递函数后系统各曲线图如下图 5 2 所示 武汉理工大学 自动控制原理 课程设计说明书 14 图 5 2 校正后系统阶跃响应 根轨迹 Bode 图 Nyquist 图 从图 5 1 5 2 对比可以看到 校正前系统不稳定 校正后一级倒立摆最后实现了稳 定控制 摆杆最终稳态值接近1 8 虽然有一定的误差 但这是实验所允许的 校正后系 统超调量小于 4 3 调节时间小于 1s 说明采用基于极点配置法的串联校正装置是可行 的 6 小结小结 本次课程设计 先通过牛顿力学建立倒立摆的非线性数学模型 并提出线性化的数 学方法 建立倒立摆的线性数学模型 然后利用拉普拉斯变换求出系统的开环传递函数 验证系统的稳定性并提出合理的校正方案 基于极点配置法的串联超前校正 根据动态 性能指标要求并利用 MATLAB 进行一级倒立摆的动态性能验证 结果表明本文采用的校 正装置是可行的 然后有利用 MATLAB 中 Simulink 对系统进行仿真 发现结果相吻合 成功稳定了一级倒立摆 武汉理工大学 自动控制原理 课程设计说明书 15 在建立系统模型时 作了以下理想化考虑 假设摆是个均匀刚体 车与轨道间的摩 擦力和摆与车绞接处的摩擦力忽略不计 建立的模型只是实际系统的线性近似 倒立摆 系统的组成元件存在噪声干扰和非线性 校正前 系统发散不稳定 加入串联超前校正装置后 系统稳定 超调量和调节时 间减小 稳态误差减小 经过适当的参数整定 校正后的系统达到了题目要求的 4 3 1ts 关于题目中提出的比较校正装置加在线性化前的模型上和线性化后的模型上的时域 相应有何区别 我不知道如何分析线性化以前的非线性模型 所以不知道怎样将校正装 置加入非线性模型并分析时域上差别 一方面是由于自控知识学习不全面 另一方面是 对 MATLAB 在自控方面的应用还没完全学会 希望能得到老师的一些指导并在今后解决 这一问题 7 心得体会心得体会 大三可以说是整个大学的关键时期 而专业课的学习在大三更是显得尤为重要 作 为自动化专业的学生 自动控制原理是一门极其重要的专业课 经过半年理论课的学习 我们已经基本掌握了理论上的解题的方法 但对于实际问题的解决能力还有待提升 MATLAB 在自动控制应用方面的应用非常广泛 掌握 MATLAB 在自动控制方面的 技术对自动化学生来说极其重要 相比于以前的笔算 MATLAB 的诞生 使控制系统的 分析和设计问题变得简单许多 MTLAB 在 SIMULINK 仿真方面的功能也非常强大 可 以帮助模拟系统仿真 使得自动控制设计是否满足要求得到验证 本次课程设计时间虽然不长 但对我们基本掌握 MATLAB 在自动控制方面的应用有 很大帮助 通过线性控制理论研究了倒立摆的稳定控制 加深了对现代控制理论的理解 根据设计的完成的超前校正装置 成功实现了倒立摆的稳定控制 使我深刻体会到了理 论知识对实验的指导意义 也体会到了理论与实际的差异 整个系统校正过程是对专业 知识的理解贯通过程 也进一步掌握了数学工具 MATLAB 及仿真软件 Simulink 的运用 对于课程设计所提出的性能指标要求 我们需要选用正确的校正装置完成系统校正 并使其能够达到指标要求 然后应用 SIMULINK 仿真验证校正效果 一级倒立摆输入为 武汉理工大学 自动控制原理 课程设计说明书 16 外力 u 输出为摆与竖直方向的夹角 通过串联超前校正使其超调量稳定在 4 3 以内 调节时间稳定在 1s 以内 8 附录附录 倒立摆在倒立摆在 MATLAB 中自带的倒立摆模型中自带的倒立摆模型 在 MATLAB 命令窗口下输入命令 slcp 会弹出倒立摆的模型窗口 如下图 8 1 所 示 选择 Simulation Start 菜单 系统开始仿真运行 跟实际倒立摆十分相似如图