自动化实验-倒立摆实验-附仿真结果图复习课程

一、直线一级倒立摆的仿真(一)直线一级倒立摆的数学建模对于倒立摆系统，由于其本身是自不稳定的系统,实验建模存在一定的困难。

但是忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。

下面我们采用其中的牛顿－欧拉方法和拉格朗日方法分别建立直线型一级倒立摆系统的数学模型.图2 直线一级倒立摆模型φ摆杆与垂直向上方向的夹角；θ摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）。

图3 小车及摆杆受力分析分析小车水平方向所受的合力，可以得到以下方程:由摆杆水平方向的受力进行分析可以得到下面等式:把这个等式代入式1中,就得到系统的第一个运动方程：为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析,可以得到下面方程:力矩平衡方程如下：注意：此方程中力矩的方向,由于θ=π+φ,cosφ= −cosθ,sinφ= −sin θ，故等式前面有负号。

合并这两个方程，约去P 和N，得到第二个运动方程:设θ=π+φ(φ是摆杆与垂直向上方向之间的夹角），假设φ与1（单位是弧度）相比很小，即φ<〈1，则可以进行近似处理:。

用u 来代表被控对象的输入力F，线性化后两个运动方程如下:对式9进行拉普拉斯变换，得到注意：推导传递函数时假设初始条件为0。

由于输出为角度φ，求解方程组的第一个方程，可以得到：或如果令v = x，则有：把上式代入方程组的第二个方程，得到：整理后得到传递函数：其中设系统状态空间方程为:方程组对解代数方程,得到解如下：整理后得到系统状态空间方程：设则有：实际系统的模型参数如下:M 小车质量1。

096 Kgm 摆杆质量0.109 Kgb 小车摩擦系数0 。

1N/m/secl 摆杆转动轴心到杆质心的长度0。

2 5mI 摆杆惯量0。

0034 kg＊m*m把上述参数代入，可以得到系统的实际模型。

摆杆角度和小车位移的传递函数:摆杆角度和小车加速度之间的传递函数为：摆杆角度和小车所受外界作用力的传递函数：以外界作用力作为输入的系统状态方程:(二)倒立摆的PID调节：经典控制理论的研究对象主要是单输入单输出的系统，控制器设计时一般需要有关被控对象的较精确模型。

专业实验报告摆杆受力和力矩分析θ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 =。

球杆系统实验实验一小球位置的数据采集处理一、实验目的：学会用Simulink仿真与硬件连接并获得小球位置。

二、实验任务：1、在MatLab Simulink中通过添加功能模块完成球杆系统模型的建立；2、正确获得小球位置数据；三、实验原理：小球的位置通过电位计的输出电压来检测，它和IPM100的AD转换通道AD5相连，AD5(16位)的范围为0－65535，对应的电压为0－5V，相应的小球位置为0－400mm。

MatLab Simulink环境下的数据采集处理工具箱提供了强大的功能。

可以编写扩展名为mdl的图形文件，采集小球的位置信号，并进行数字滤波。

四、实验设备及仪器：1、球杆系统；2、计算机MATLAB平台；五、实验步骤：将MatLab主窗口的Current Directory文本框设置为球杆控制程序的系统文件夹；在MatLab主窗口点击进入Simulink Library Brower窗口，打开工具箱Googol Education Products\4. Ball & Beam\A. Data Collection and Filter Design，运行Data Collection and Filter Design程序，确认串行口COM Port为1后，双击Start Real Control模块，打开数据采集处理程序界面；已有的模块不需再编辑设置，其中Noise Filter1模块是专门设计的滤波器，用来抑制扰动。

请参考以下步骤完成剩余部分：1、添加、设置模块：添加User-Defined Functions组中的S-Function模块，双击图标，设置name为AD5；parameters为20.添加Math Operations组中的Gain模块，双击图标，设置Gain为0.4/65535.0.添加Sinks组中的Scope模块，双击图标，打开窗口，点击(Parameters)，设置General 页中的Number of axes为2，Time Range为20000，点击OK退出，示波器屏成双；分别右击双屏，选Axes properties，设置Y-min为0，Y-max为0.4.2、连接模块：顺序连接AD5、Gain、Noise Filter1、Scope模块，完成后的程序界面如图所示：图1.1.1 完成后的数据采集处理程序界面点击运行程序，双击Scope模块，显示滤波前后的小球位置-时间图，拨动小球在横杆上往返滚动，可得如下实验结果：图1.1.2 小球位置的数据采集处理六、实验总结通过这个实验、我学会了球杆系统模型的建立以及小球位置的获取。

最优控制实验报告二零一五年一月目录第1章一级倒立摆实验 (3)1.1 一级倒立摆动力学建模 (3)1.1.1 一级倒立摆非线性模型建立 (3)1.1.2 一级倒立摆线性模型建立 (3)1.2 一级倒立摆t∞状态调节器仿真 (3)1.3 一级倒立摆t∞状态调节器实验 (3)1.4 一级倒立摆t∞输出调节器仿真 (3)1.5 一级倒立摆t∞输出调节器实验 (3)1.6 一级倒立摆非零给定调节器仿真 (3)1.7 一级倒立摆非零给定调节器实验 (3)第2章二级倒立摆实验 (3)2.1 二级倒立摆动力学模型 (3)2.1.1 二级倒立摆非线性模型建立 (3)2.1.2 二级倒立摆线性模型建立 (3)2.2 二级倒立摆t∞状态调节器仿真 (3)2.3 二级倒立摆t∞状态调节器实验 (3)2.4 二级倒立摆t∞输出调节器仿真 (3)2.5 二级倒立摆t∞输出调节器实验 (3)2.6 二级倒立摆非零给定调节器仿真 (3)2.7 二级倒立摆非零给定调节器实验 (3)第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 。

南京航空航天大学课程名称：自动化控制原理课程设计专业：探测制导与控制技术时间：2016.6.20-2016.6.25一、实验目的1、 学会用SIMULINK 软件分析复杂的控制系统。

2、 会用状态反馈进行控制系统设计。

3、 了解状态观测器的实现。

二、实验设备1、 计算机和打印机。

2、 实际倒立摆系统。

三、实验原理假设原系统的状态空间模型为BU AX X+= ，若系统是完全能控的，则引入状态反馈调节器KX R U -=这时，闭环系统的状态空间模型为⎩⎨⎧=+-=CXY BR X BK A X)(设计任务是要计算反馈K ，使A-BK 的特征值和期望的极点P 相同。

通过将倒立摆线性数学模型输入到MATLAB 中，使用K=place(A,B,P)函数算出反馈矩阵反馈增，K 和期望极点向量P 应与状态变量X 具有相同的维数。

本系统可令输入R=0,即只讨论初始值对系统的作用。

倒立摆系统模型如下：1、倒立摆线性模型：⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡----=3444.16254.42122.822122.822760.07062.38751.168751.6510000100A ⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡-=5125.62184.500B ⎥⎦⎤⎢⎣⎡=00100001C ⎥⎦⎤⎢⎣⎡=00D 2、倒立摆非线性模型:)(cos 00144.00061.0212001θθθ--+=⋅⋅B A2121121222)sin(2.1)cos(2.1sin 2.61⋅⋅⋅⋅⋅⋅⋅-----=θθθθθθθθθθ其中：⋅⋅---++=11212110]0168.0)cos()sin(00144.0[sin 2979.00236.0θθθθθθθu A 2221212210])sin()[cos(0012.0sin )cos(0734.0⋅⋅---+--=θθθθθθθθθB四、实验内容1、根据给出的倒立摆的线性数学模型,讨论系统的稳定性,可控性和可观性。

深圳大学实验报告课程名称：现代控制理论实验项目名称：倒立摆模型建立与仿真学院：机电与控制工程学院专业：自动化指导教师：***报告学号：班级：实验时间：实验报告提交时间：教务部制一、 实验目的（1）实验一：增强状态空间表达式的理解和应用，通过直线型一级倒立摆系统的具体对象，展现非线性系统线性化的应用和特点，提高仿真计算和应用Matlab 进行系统分析的能力，并为后续章节的有关系统稳定性提供感性认识。

（2）实验二：了解采用状态反馈改善系统性能的方法，应用状态反馈方法配置直线型一级倒立摆系统的极点，设计控制器，并在倒立摆系统实验平台上实现一级倒立摆系统稳定运行。

二、 实验任务与要求（1）实验一建立倒立摆的非线性状态空间表达式； 建立倒立摆的线性状态空间表达式；在两种模型下，在matlab simulink 平台上通过仿真计算给出摆角和直线位移的运动曲线，位移的初始为零，摆角的初始值分别选取如下：20πθ≤， 20πθ≥， πθ=0（2）实验二针对一级倒立摆系统，对于给定的动态性能指标（调节时间小于3秒，阻尼比0.5）确定闭环极点（参考值，32,32,10,10j j --+---），设计系统状态反馈阵的参数； 在倒立摆系统平台上完成极点配置控制实验。

实验要保持倒立状态，当系统受到扰动后仍保持稳定。

记录控制结果曲线，并进行讨论。

重新选择一组(或多组)期望的闭环极点，设计系统状态反馈阵的参数，在倒立摆系统平台上完成极点配置控制实验，记录控制结果曲线，并和第二条的实验结果进行比较分析。

三、 实验原理（1）实验参见固高《倒立摆与自动控制原理实验》（2）若受控系统(A,B)完全能控，则通过状态反馈可以任意配置闭环极点。

实验设计原理参见固高《倒立摆与自动控制原理实验》第82-89页 。

四、 实验步骤及过程（1） 非线性状态方程系统方程：1/（M+m ）=0.82988；1/（I+ml^2）=97.91922；m*g*l=0.26705；m*l=0.02725 将系统模型参数代入，可得以下仿真下载后图片可放大X 和φ输出的响应曲线（红为x ，黄为φ） 当20πθ≤，取40πθ=当20πθ≥，取430πθ=当πθ=0（2）线性状态方程可以看出，在单位阶跃响应作用下，小车位置和摆杆角度都是发散的。

球杆系统实验实验一小球位置的数据采集处理一、实验目的：学会用Simulink仿真与硬件连接并获得小球位置。

二、实验任务：1、在MatLab Simulink中通过添加功能模块完成球杆系统模型的建立；2、正确获得小球位置数据；三、实验原理：小球的位置通过电位计的输出电压来检测，它和IPM100的AD转换通道AD5相连，AD5(16位)的范围为0－65535，对应的电压为0－5V，相应的小球位置为0－400mm。

MatLab Simulink环境下的数据采集处理工具箱提供了强大的功能。

可以编写扩展名为mdl的图形文件，采集小球的位置信号，并进行数字滤波。

四、实验设备及仪器：1、球杆系统；2、计算机MATLAB平台；五、实验步骤：将MatLab主窗口的Current Directory文本框设置为球杆控制程序的系统文件夹；在MatLab主窗口点击进入Simulink Library Brower窗口，打开工具箱Googol Education Products\4. Ball & Beam\A. Data Collection and Filter Design，运行Data Collection and Filter Design程序，确认串行口COM Port为1后，双击Start Real Control模块，打开数据采集处理程序界面；已有的模块不需再编辑设置，其中Noise Filter1模块是专门设计的滤波器，用来抑制扰动。

请参考以下步骤完成剩余部分：1、添加、设置模块：添加User-Defined Functions组中的S-Function模块，双击图标，设置name为AD5；parameters为20.添加Math Operations组中的Gain模块，双击图标，设置Gain为0.4/65535.0.添加Sinks组中的Scope模块，双击图标，打开窗口，点击(Parameters)，设置General 页中的Number of axes为2，Time Range为20000，点击OK退出，示波器屏成双；分别右击双屏，选Axes properties，设置Y-min为0，Y-max为0.4.2、连接模块：顺序连接AD5、Gain、Noise Filter1、Scope模块，完成后的程序界面如图所示：图1.1.1 完成后的数据采集处理程序界面点击运行程序，双击Scope模块，显示滤波前后的小球位置-时间图，拨动小球在横杆上往返滚动，可得如下实验结果：图1.1.2 小球位置的数据采集处理六、实验总结通过这个实验、我学会了球杆系统模型的建立以及小球位置的获取。

球杆系统实验实验一小球位置的数据采集处理一、实验目的：学会用Simulink仿真与硬件连接并获得小球位置。

二、实验任务：1、在MatLab Simulink中通过添加功能模块完成球杆系统模型的建立；2、正确获得小球位置数据；三、实验原理：小球的位置通过电位计的输出电压来检测，它和IPM100的AD转换通道AD5相连，AD5(16位)的范围为0－65535，对应的电压为0－5V，相应的小球位置为0－400mm。

MatLab Simulink环境下的数据采集处理工具箱提供了强大的功能。

可以编写扩展名为mdl的图形文件，采集小球的位置信号，并进行数字滤波。

四、实验设备及仪器：1、球杆系统；2、计算机MATLAB平台；五、实验步骤：将MatLab主窗口的Current Directory文本框设置为球杆控制程序的系统文件夹；在MatLab主窗口点击进入Simulink Library Brower窗口，打开工具箱Googol Education Products\4. Ball & Beam\A. Data Collection and Filter Design，运行Data Collection and Filter Design程序，确认串行口COM Port为1后，双击Start Real Control模块，打开数据采集处理程序界面；已有的模块不需再编辑设置，其中Noise Filter1模块是专门设计的滤波器，用来抑制扰动。

请参考以下步骤完成剩余部分：1、添加、设置模块：添加User-Defined Functions组中的S-Function模块，双击图标，设置name为AD5；parameters为20.添加Math Operations组中的Gain模块，双击图标，设置Gain为0.4/65535.0.添加Sinks组中的Scope模块，双击图标，打开窗口，点击(Parameters)，设置General 页中的Number of axes为2，Time Range为20000，点击OK退出，示波器屏成双；分别右击双屏，选Axes properties，设置Y-min为0，Y-max为0.4.2、连接模块：顺序连接AD5、Gain、Noise Filter1、Scope模块，完成后的程序界面如图所示：图1.1.1 完成后的数据采集处理程序界面点击运行程序，双击Scope模块，显示滤波前后的小球位置-时间图，拨动小球在横杆上往返滚动，可得如下实验结果：图1.1.2 小球位置的数据采集处理六、实验总结通过这个实验、我学会了球杆系统模型的建立以及小球位置的获取。

Googol Technology倒立摆与 自动控制原理实验V2.0固高科技（深圳）有限公司二○○五年©Googol 20051固高科技（深圳）有限公司 GOOGOL TECHNOLOGY (SHENZHEN) LTD版权声明固高科技（深圳）有限公司 保留所有版权固高科技有限公司（以下简称固高科技）具有本产品及其软件的专利权、版 权和其它知识产权。

未经授权，不得直接或间接的复制、制造、加工、使用本产 品及相关部分。

直线倒立摆系统 GLIP 系列包含 《直线倒立摆系统 GLIP 系列安装与使用手册》 和《倒立摆与自动控制原理实验》。

声明固高科技保留在不预先通知的情况下修改设备和文档的权力。

固高科技不承担由于使用本说明书或本产品不当， 所造成的直接的、 间接的、 特殊的、附带的、或相应的损失和赔偿。

商标声明Windows 和 Microsoft 为 Microsoft 公司注册商标。

Mathematica 为沃尔夫勒姆研究公司（Wolfram Research Inc.)公司注册商标。

Matlab 为 Mathworks 公司注册商标©Googol 2005I安全注意 事项直线倒立摆系统主要用于教学和科研。

在安装，使用和维护之前，请仔细阅 读本安装手册。

请将本手册妥善保存，以备需要时随时查阅。

使用注意 事项使用（安装、运转、保养、检修）前，请务必熟悉并全部掌握本手册和其它 相关资料，在熟知全部机器知识、安全知识、以及注意事项后再使用设备。

本手册将安全注意事项分为“危险”“注意”“强制”“禁止”分别记载。

表 1-1 警告标志不正确的操作将会导致重大人身事故。

不正确的操作会导致设备损坏。

必须要做的操作。

被禁止的操作。

另外，即使“注意”所记载的内容，也可能因为不同的情况产生严重后果，因此 任何一条注意事项都很重要，在设备使用过程中请严格遵守。

虽然不符合“危险”“注意”的内容，但是用户在使用过程中必须严 格遵守的事项，在相关地方以记载。

倒立摆仿真实验报告倒立摆是一个非线性、不稳定的系统，是经常作为研究比较不同控制方法的典型例子。

有许多抽象的控制概念，如控制系统的稳定性、可控性、系统抗干扰能力等，都可以通过倒立摆系统直观地表现出来，倒立摆系统的高阶次，不稳定，多变量，非线性和强耦合等特性，使得许多现代控制理论的研究人员一直将它视为研究对象。

倒立摆系统具有3个特性，即：不确定性，耦合性，开环不稳定性。

直线型倒立摆系统，是由沿直线导轨运动的小车以及一端固定于小车上的匀质长杆组成的系统，小车可以通过传动装置由交流伺服电机驱动，小车导轨一般有固定的行程，因而小车的运动范围是受到限制的。

一阶倒立摆建模在忽略了空气流动阻力，以及各种摩擦之后，可将倒立摆系统抽象成小车和匀质杆组成的系统，如下图所示M ：小车质量；x ：小车位置；m ：摆杆质量J ：摆杆惯量；F ：加在小车上的力；l ：摆杆转动轴心到杆质心的长度；θ：摆杆与垂直向上方向的夹角。

图1 倒立摆示意图倒立摆的数学模型为πθθπθθθθ180cos )3/4(]sin )180/([cos sin 22⨯-+-=l m ml l m f mg p p 我们可以实时量测角度θ（◦），并计算出角速度θ （◦/s ），控制的任务是产生合适的作用力f,以使倒立摆保持直立状态。

一 连续模糊控制器1、论域的正规化首先设定 15=m θ，s m/60 =θ，N F m 10=，将θ，θ ，f 的实际值分别除以m θ，mθ ，m F ，并加以1±限幅后，得到正规化的输入输出变量：其中]1,1[,,-∈z y x 2、定义模糊几何及其隶属函数对正规化的输入输出变量x,y,z 各定义五个模糊集合：NL ，NS ，Z ，PS ，PL ，分别用51~A A ，21~B B ，21~C C 来代表，x,y,z 三个变量的模糊集合的隶属函数均是对称，均匀分布，全交迭的三角形，如图2所示。

图2 变量的隶属函数 3、设计模糊控制规则集x 和y 各有五个模糊集合，所以最多有2552=条规则，根据经验只用11条规则即可，如表1所示。

第一章直线一级倒立摆的数学模型1.1直线一级倒立摆数学模型的推导倒立摆系统可以等效为典型的运动刚体系统，在惯性坐标系内应用经典力学理论建立系统的动力学方程。

下面将运用牛顿－欧拉方法建立直线型一级倒立摆系统的数学模型。

在忽略了空气阻力和各种摩擦之后，可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统，如图所示。

图1-1直线一级倒立摆模型本系统内部各相关参数定义如下：M 小车质量；m 摆杆质量；b 小车摩擦系数；l 摆杆转动轴心到杆质心的长I 摆杆惯量；F加在小车上的力；x 小车位置；摆杆与垂直向上方向的夹角摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）图1-2是系统中小车和摆杆的受力分析图。

其中，N和P为小车与摆杆相互作用力的水平和垂直方向的分量。

图1-2 小车及摆杆受力分析应用Newton方法来建立系统的动力学方程过程如下：分析小车水平方向所受的合力，可以得到以下方程：M+m x+bx+mlθcosθ−mlθsinθ=FI+ml2θ+mgl sinθ=−mlx cosθ1．微分方程模型设θ=π+Φ，当摆杆与垂直向上方向之间的夹角与1（单位是弧度）相比很小，即Φ≪1时，则可以进行近似处理：cosθ=−1，sinθ=−Φ，(dθdt)2=0。

为了与控制理论的表达习惯相统一，即u一般表示控制量，用u来代表被控对象的输入力F，线性化后得到该系统数学模型的微分方程表达式：M+m x+bx−mlΦ=uI+ml2Φ+mglΦ=−mlx2．传递函数模型对以上的方程组进行拉普拉斯变换，得到M+m X(s)s2+bX(s)s−mlΦ(s)s2=U(s)I+ml2Φ(s)s2+mglΦ(s)=−mlX(s)s2注意：推导传递函数时假设初始条件为0。

对上述方程组进行化简，可得到以摆杆摆角为输出量的传递函数：Φ(s)=mlq s2s4+b(I+ml2)q s3−(M+m)mglq s2−bmglq s其中，q=[M+m I+ml2−(ml)2]3．状态空间数学模型由现代控制理论原理可知，控制系统的状态空间方程可写成如下形式：X=AX+BuY=CX+Du对于本系统，可得状态方程为：xx ΦΦ=0100−(I+ml2)bI M+m+Mml2m2gl2I M+m+Mml20001−mlb mgl(M+m)xxΦΦ+I+ml2I M+m+Mml2ml2u4．实际系统参数小车质量M=1.096 Kg；摆杆质量m= 0.109 Kg；小车摩擦系数b=0 .1N/m/sec；摆杆转动轴心到杆质心的长度l=0.25m；摆杆惯量I=0.0034 kg m2。

倒立摆特性测试实验
直线一级倒立摆
1、simulink仿真图
根据老师给出的传递函数，可得：
2、分析
有老师指导可知，最佳参数为P=100，I=4，D=15，此时，如图：
之后，采用控制变量法，分别改变三个变量，观察效果。

P=200，I=4，D=15时，如下
P=100，I=50，D=15时，如下图，
P=100，I=4，D=50时，如下图：
倒立摆顺摆
1、simulink仿真图
2、分析
有老师给出的数据可知，最佳参数为P=60，I=100，D=8，如下图：
同样采用控制变量法P=120，I=100，D=8时，如下图：
P=100，I=200，D=8时，如下图
P=100，I=100，D=16时，如下图：
综合分析：
比较不同P参数值下系统阶跃响应曲线可知，随着K的增大，超调量增大，衰减率减小，振荡频率增大。

当减少Ti时，超调量增加，进入动态稳定的时间变长。

增大微分环节，可以减少超调量，同时，减少调节时间，在图中并未发现有什么不好之处，通过查资料发现，增加微分环节对噪声干扰有放大作用，因此过强的加微分调节，对系统抗干扰不利。

心得体会：通过本次实验，我们了解了关于倒立摆和顺摆的一些基本知识，同时，又对之前学过的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闭环。

直线型倒立摆一、微分方程的建立倒立摆系统是直立双足机器人、火箭垂直姿态控制的研究基础，它涉及各个领域包括控制理论、机器人理论等，其被控系统本身有一个绝对不稳定、高阶次、多变量、强耦合的非线性系统。

本次实验分析一阶直线型倒立摆直线型倒立摆装置如下图所示系统受力分析示意图如下所示M 小车质量 1.096 Kg m 摆杆质量0.111 Kg b 小车摩擦系数0 .1N/m/secl 摆杆转动轴心到杆质心的长度 0.2 5m J 摆杆惯量0.0034 kg*m*x 小车位置θ 摆杆与垂直方向的夹角 应用牛顿定律剪力方程如下：水平方向：N bx F x --='''M由摆杆水平方向的受力情况得：22dt )θsin (N l x d m +=对摆杆垂直方向上的合力进行分析，可以得到如下方程22)cos (m mg -P dtl d θ= 综合可得力矩平衡方程为''cos sin θθθJ Nl Pl =--设θ=π+β，β远小于1，所以得线性化后的两个运动方程''lg ''m l J 2mlx m =-+ϕϕ）（F ml bx x m M =-++'''''ϕ）（ 二、传递函数模型由上式化简得，以小车加速度为控制量，摆件角度为被控对象，不考虑其他因素得传递函数为G （s ）=lg s 4343l2-,化简得G （s ）=29.4-s 32三、采用PID 控制对于倒立摆系统输出量为摆杆的角度和小车的位移，它的平衡位置为垂直向上的情况。

PID 系统控制结构框图如下图所示其包括比例环节·积分环节·微分环节，其中Gc(s)是控制器的传递函数，G(s)是被控对象的传递函数其中sK K s K s G IP D c ++=)(,需要调节PID 控制器的参数，得到满意的控制效果。

本次实验中系统的控制量仅为摆杆的角度，不考虑小车的位移。

第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”为起摆控制模块。