一阶倒立摆实验报告(实验)
一阶倒立摆模糊控制实验报告
一阶倒立摆模糊控制实验报告一、实验目的本实验旨在通过模糊控制方法来控制一阶倒立摆系统，实现摆杆保持竖直的稳定控制。
二、实验原理1. 一阶倒立摆系统一阶倒立摆系统由一个垂直的支撑杆和一个在杆顶端垂直摆动的杆组成。
系统的输入为杆的控制力矩，输出为杆的角度。
系统的动力学方程可以表示为：Iθ''(t) + bθ'(t) + mgl sin(θ(t)) = u(t)其中，I为倒立摆的转动惯量，b为摩擦阻尼系数，θ为倒立摆的角度，m为倒立摆的质量，l为杆的长度，g为重力加速度，u为输入的控制力矩。
2. 模糊控制方法模糊控制方法是一种基于模糊逻辑的控制方法，通过将模糊集合与模糊规则相结合，构建模糊控制器来实现对系统的控制。
在本实验中，可以使用模糊控制器来实现倒立摆系统的稳定控制。
三、实验步骤1. 搭建实验平台，包括倒立摆系统、传感器和执行器。
2. 训练模糊控制器a. 定义模糊集合：根据角度误差和角速度误差定义模糊集合，并确定模糊集合的划分方式。
b. 构建模糊规则：根据经验或系统建模，确定模糊规则。
c. 设计模糊控制器：根据模糊集合和模糊规则，设计模糊控制器，包括模糊推理和模糊解模块。
d. 调整模糊控制器参数：根据系统响应实验，根据控制效果调整模糊控制器参数。
3. 实施模糊控制a. 读取传感器数据：获取倒立摆的角度和角速度数据。
b. 计算控制器输出：根据模糊控制器和传感器数据计算控制力矩的输出。
c. 执行控制器输出：将控制力矩作用在倒立摆上。
4. 监测系统响应：实时监测倒立摆的角度和角速度，判断控制效果。
5. 调整模糊控制器参数：根据实验监测结果，调整模糊控制器参数，以提高控制效果。
四、实验结果分析通过实验，我们可以观察到倒立摆系统在模糊控制下的稳定控制效果。
通过实时监测倒立摆的角度和角速度，可以验证控制器的性能。
实验结果可以通过绘制控制力矩输入和倒立摆角度响应曲线，以及观察系统的稳态误差来分析。
一阶倒立摆模糊控制实验报告
一阶倒立摆模糊控制实验报告本次实验旨在研究一阶倒立摆系统的模糊控制方法，通过对系统进行建模、设计控制器并进行仿真，最终评估控制效果。
实验过程主要包括系统建模、控制器设计、模糊控制器参数调节和性能评价四个步骤。
首先，我们对一阶倒立摆系统进行建模。
一阶倒立摆系统是一种具有非线性特性的控制系统，主要由电机、倒立摆、支撑杆等组成。
我们需要建立数学模型描述系统的动力学特性，包括倒立角度、倒立角速度、杆角度等状态变量，并考虑控制输入电压对系统的影响。
接着，我们设计模糊控制器。
模糊控制是一种基于模糊逻辑的控制方法，适用于非线性系统和模糊系统。
我们根据系统模型，设计模糊控制器的模糊规则、隶属函数等参数，以实现系统的稳定控制。
在设计过程中，我们需要考虑系统的性能指标，如超调量、稳态误差等。
第三步是模糊控制器参数调节。
通过仿真实验，我们可以对模糊控制器的参数进行调节，以使系统的性能达到最佳状态。
调节参数的过程需要考虑系统的稳定性、鲁棒性和响应速度，以达到控制效果的要求。
最后，我们对模糊控制系统进行性能评价。
通过对系统的响应曲线、稳定性、控制精度等指标进行分析，评价模糊控制器的控制效果。
我们可以比较模糊控制系统和传统控制系统的性能，探讨模糊控制在一阶倒立摆系统中的优势和局限性。
总的来说，本次实验通过研究一阶倒立摆系统的模糊控制方法，探讨了模糊控制在非线性系统中的应用。
通过实验，我们对模糊控制的基本原理和设计方法有了更深入的理解，同时也对一阶倒立摆系统的控制特性有了更清晰的认识。
希望通过实验的研究，能够为控制系统的设计和应用提供一定的参考和借鉴。
电气系统综合设计实验报告--直线一级倒立摆控制系统设计
电气控制系统设计——直线一级倒立摆控制系统设计学院轮机工程学院班级电气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 。
直线一级倒立摆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、直线一级倒立摆建模1.1 受力分析针对直线一级倒立摆，在实际的模型建立过程中，可忽略空气流动阻力和其它次要的摩擦阻力，则倒立摆系统抽象成小车和匀质刚性杆组成的系统，如图所示。
图1 小车系统各参数定义：M ：小车质量m ：摆杆质量β：小车摩擦系数l: 摆杆转动轴心到杆质心的长度I ：摆杆惯量F ：加在小车上的力X ：小车位置Ф：摆杆与垂直向上方向的夹角θ：摆杆与垂直向下方向的夹角摆杆受力和力矩分析图2 摆杆系统摆杆水平方向受力为：H摆杆竖直方向受力为：V由摆杆力矩平衡得方程：cos sin Hl Vl I φφθθπφθφ⎧-=⎪=-⎨⎪=-⎩&&&&&& （1） 代入V 、H ，得到摆杆运动方程。
当0φ→时，cos 1θ=，sin φθ=-，线性化运动方程：1.2 传递函数模型以小车加速度为输入、摆杆角度为输出，令，进行拉普拉斯变换得到传递函数：22()()mlG sml I s mgl=+-（2）倒立摆系统参数值：M=1.096 % 小车质量，kgm=0.109 % 摆杆质量，kg0.1β=% 小车摩擦系数g=9.8 % 重力加速度，l=0.25 % 摆杆转动轴心到杆质心的长度，mI= 0.0034 % 摆杆转动惯量，以小车加速度为输入、摆杆角度为输出时，倒立摆系统的传递函数模型为：20.02725()0.01021250.26705G ss=-（3）1.3 倒立摆系统状态空间模型以小车加速度为输入，摆杆角度、小车位移为输出，选取状态变量：(,,,)x x xθθ=&&（4）由2()I ml mgl mlxθθ+-=&&&&得出状态空间模型01001000000013300044xxxxxgglμθθθθ⎡⎤⎡⎤⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥'==+⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎢⎥⎢⎥⎣⎦⎣⎦&&&&&&&&（5）μθθθ'⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=11&&xxxy（6）由倒立摆的参数计算出其状态空间模型表达式：（7）111()()n n n n f s sI A BK s a s a s a --=--=++++L （11）设期望特征根为***12,,,n λλλL ，则期望特征多项式为：***1111()()()n n n n n f x s s s b s b s b λλ--=--=++++L L （12）由*()()f s f s =求得矩阵K 。
直线一级倒立摆系统实验报告
直线一级倒立摆系统实验报告1. 实验目的：通过对直线一级倒立摆系统进行分析，掌握系统的基本原理、参数设置和控制策略；提高学生实际动手能力和科学实验能力。
2. 实验内容：（1）搭建直线一级倒立摆系统实验平台；（2）设置系统的动力学模型，采集系统的状态变量；（3）根据系统的特性设计控制策略，实现系统的稳定控制；（4）记录实验数据，并进行数据处理和分析。
3. 实验原理：直线一级倒立摆系统是一种经典的非线性控制系统，其原理和稳定性分析可以使用动力学建模方法来描述。
系统由直线弹簧、质量块、直线导轨和质量块的摆杆组成。
当摆杆处于垂直状态时，系统处于平衡状态；当摆杆被扰动后，系统进入不稳定状态，需要通过控制策略来实现其稳定控制。
在实验中，我们选取了单摆系统作为直线一级倒立摆系统的原形。
单摆系统由一个质点和一个线性弹簧组成，其状态变量为质点的位置和速度。
当质点处于平衡位置时，系统拥有稳定状态；当质点被扰动后，系统进入不稳定状态，需要通过控制策略来实现其稳定控制。
因此，我们可以使用单摆系统来研究直线一级倒立摆系统的控制策略。
4. 实验步骤：（1）搭建实验平台：搭建直线一级倒立摆系统实验平台，包括直线导轨、摆杆、质点、力传感器、位移传感器和控制电路等。
将质点放置在导轨上，并用摆杆将其固定在弹簧上。
使用力传感器和位移传感器来测量系统的状态变量。
（2）设置系统模型：对实验平台的动力学模型进行建模，将系统的状态变量与控制策略联系起来。
（3）设计控制策略：根据系统的特性设计相应的控制策略，使系统保持稳定状态。
常用的控制策略包括模型预测控制、PID控制、滑模控制等。
（4）记录实验数据：实验过程中需要记录系统的状态变量和控制参数，并进行数据处理和分析，得到实验结论。
5. 实验结果分析：通过对直线一级倒立摆系统的实验研究，我们发现系统的稳定控制需要根据其特性和实际情况来确定相应的控制策略。
在实验中，我们采用了模型预测控制策略，通过对系统的状态变量进行预测和调节，成功实现了系统的稳定控制。
直线一级倒立摆实验报告
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，所以由全部输出是可观测的。
自控期末设计一阶倒立摆小车实验报告
B J 1 vl sin Hl cos 2 m d (l cos ) v mg ml cos 2 ml sin dt 2 d2 2 ml cos ml sin m 2 ( z l sin ) H mz dt d2z dz uH M 2 B2 dt dt
倒立摆实验素 孙圳
自控原理期末设计倒立摆实验报告
课程名称：自控原理倒立摆实验报告 指导老师：杨智 学生学院：信息科学与技术学院 专业班级：12 级自动化 学 号：12350068 12350015 12350054 郭素素 孙圳
学生姓名：许天野
完成时间： 2014 年 12 月
其中： H 和 v 分别是摆杆和小车结合部的水平反力和垂直反力，B1 为摆杆和小车 的摩擦系数， B2 为小车摩擦系数， J 为转动惯量， u 是作用在小车上的力。 化简得：
ml cos m lg sin ( J ml 2 ) z B1 B z 2 u ml sin ( M m) z (ml cos )
1
倒立摆实验报告
12 自动化
许天野 郭素素 孙圳
目录
一、理论设计思路........................................................................................................................... 3 1.1 数学模型..........................................................................................................
一阶倒立摆模型建立与正确性分析实验报告
一阶倒立摆模型建立与正确性分析【实验目的】学会建立一阶倒立摆模型建立，并结合物理现象与数值结果分析模型的正确性。
【实验设备与软件】MATLAB/Simulink【实验原理】对于倒立摆系统，由于其本身是自不稳定的系统，实验建模存在一定的困难但是经过假设忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内应用经典力学理论建立系统的动力学方程下面我们采用其中的牛顿欧拉方法建立直线型一阶倒立摆系统的数学模型.微分方程的推导：在忽略了空气阻力和各种摩擦之后，可将直线一阶倒立摆系统抽象成小车和匀质杆组成的系统.图一直线一阶倒立摆系统图取小车质量M=1.096kg，摆杆质量m=0.109kg，摆杆与小车间的摩擦系数b1=0.001N.m.s.，小车水平运动的摩擦系数b2=0.1N.m.s.，摆杆转动轴心到摆杆质心的长度l=0.25m，加在小车上的力F，小车位置X，摆的角度θ摆杆惯量J。
一．忽略摩擦摆杆绕其重心的转动方程为：J=—l （1）摆杆重心的水平运动可描述为：=m(x+) （2）摆杆重心在垂直方向上的运动可描述为：—mg= m(x+l) （3）小车水平方向运动可描述为：F—=M （4）由式(2)和式（4）得到：（M+m ）x+ml （—）=F （5）由式（1）式（2）和式（3）得：J+mml=mgl （6）整理式（5）和式（6）得：（7）若只考虑θ=0 在其工作点附近（0*<θ<10）的细微变化，这时可近似认为 ， sin θ=θ，cos θ=1,J=由此得到的简化近似模型为：代入数值得本实验中倒立摆的简化模型：二．有摩擦定义逆时针转动为正方向。
设摆杆的重心为（）,则（1）根据牛顿定律建立系统垂直和水平运动力学方程：（1） 摆杆绕其重心转动的力学方程为：J=l+l b1 （2）式中，J 为摆杆绕其重心的转动惯量：2312123J mL L ml ==。
这里，杆重力的转动力矩为0，小车运动引起的杆牵连运动的惯性力的转矩也为0。
小车倒立摆
小车单级倒立摆模糊控制实验报告小车倒立摆系统的控制问题一直是控制研究中的一个典型问题，下面先简单介绍一下这个系统。
小车倒立摆系统由一个杆、一个导轨和一辆滑车组成，滑车可以沿导轨水平运动。
在一定的初始条件下，通过在滑车质心处施加一个力μ(控制力)，使杆尽可能的平衡,如下图。
本次实验采用多种控制方法，并进行一下比较。
1.单级倒立摆的经典PID 控制 建立系统的动力学方程:假设小车质量为M,摆的质量是m ，小车位置为x ，摆的角度为θ,如上图。
现假设摆杆偏离垂直线的角度为θ，同时规定摆杆重心的坐标为G(Xc,Yc ），则有： Xc=x+lsin θ Yc=lcos θ根据牛顿定律，可以建立摆杆水平和垂直运动状态方程。
摆杆围绕其重心的转动运动可用力矩方程来描述： ..sin cos I Vl Hl θθθ=- 式中，I 为摆杆围绕其重心的转动惯量。
摆杆重心的水平运动由下式描述：22(sin )d m x l Hdt θ+=摆杆重心的垂直运动由下式描述：22cos d m l V mgdt θ=-小车的水平运动由下式描述：22d xm u Hdt =-假设θ很小，sin θ≈θ，cos θ≈1。
则以上各式变为： ..I Vl Hl θθ=- 1.1 ....()m x l H θ+= 1.2 0V mg =- 1.3 ..M x u H =- 1.4 由式1.2和1.4得：....()M m x ml u θ++= 1.5 由式1.2和1.3得：....2()I ml ml x mgl θθ++= 1.6 由1.5和1.6可得单级倒立摆方程：..22()()()m m M gl mlu m M I Mml m M I Mml θθ+=-++++222..22()()m gl I ml x u m M I Mml m M I Mml θ+=-++++ 式中，2112I mL =， l=0.5L .控制指标共有四个，即单级倒立摆的摆角θ、摆速.θ，小车位置x 和小车速度.x 。
一阶倒立摆实验报告(实验)
一、实验介绍：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）的控制论专家根据火箭发射助推器原理设计出一级倒立摆实验设备。
近年来，新的控制方法不断出现，人们试图通过倒立摆这样一个典型的控制对象，检验新的控制方法是否有较强的处理多变量、非线性和绝对不稳定系统的能力，从而从中找出最优秀的控制方法。
实验七 直线一级倒立摆根轨迹控制实验
实验七直线一级倒立摆系统根轨迹校正和仿真一、实验目的（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 ——控制器增益实际系统的开环传递函数为：可以看出，系统有两个零点，有两个极点，并且有一个极点为正。
(完整版)倒立摆实验报告(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. 单级倒立摆系统的建模单级倒立摆系统的建模可采用受力分析或Lagrange 方程建立得到。
这里采用受力分析方法建模。
如图所示：根据牛顿第二定律：(cos )0Mx m x L u θθ++-= (2-1) cos sin 0mLxI mLg θθθ--= (2-2)以摆杆偏角θ、角速度θ 、小车的位移x 和小车速度x为状态变量，即令： ()TX x x θθ=(2-3)同时假设倒立摆摆杆的垂直倾斜角度θ与1（单位为rad ）相比很小，即1θ 。
则可以近似处理：cos θ≈1，sin 0θ≈，并忽略高阶小量，则可得：2222()()m L g Ix u I m M mML I m M mML θ=+++++ （2-4）22()()()mL m M g mLu I m M mML I m M mMLθθ+=-+++++ （2-5）摆杆系统的状态方程为： 12222122344122()()()()()x x m L g I x x u I m M mML I m M mMLx x mL m M g mL x x u I m M mML I m M mML =⎧⎪⎪=+⎪++++⎨=⎪⎪+=-+⎪++++⎩（2-6） 写成向量的形式为：XAX Bu y CX Du ⎧=+⎨=+⎩(2-7)其中0100000A 0001000a b⎛⎫ ⎪⎪= ⎪ ⎪⎝⎭, 00c B d ⎛⎫⎪ ⎪= ⎪ ⎪⎝⎭,10000010C ⎛⎫= ⎪⎝⎭,00D ⎛⎫= ⎪⎝⎭（2-8） 参数a 、b 、c 、d 分别为：222()m L gb I m M mML =++ （2-9）2()()mL m M ga I m M mML +=-++（2-10）2()Ic I m M mML =++ （2-11）2()mLd I m M mML =++（2-12）选择摆杆的倾斜角度θ和小车的水平位移x 作为系统的输出，则输出方程为：y CX = (2-13)根据金棒-2型倒立摆系统实验平台的参数，m=0.2kg ，M=0.6kg ，L=0.158m ，I=0.001654kg.m 2 ，g=10N/kg.同时，这里建模时候使用的ｕ是以力作为输入信号的，实际上采用的是以电压作为输入信号，通过电机作了一定的转化，这里我们约定：先暂时以力作为输入信号，最后再统一处理。
一阶倒立摆双闭环PID控制实验报告
一阶倒立摆双闭环PID控制实验报告一、实验目的1. 学习并掌握一阶倒立摆原理及其数学模型；2. 了解反馈控制理论，学习PID控制原理及其在一阶倒立摆控制中的应用；3. 熟悉MATLAB/Simulink软件的使用，能够建立一阶倒立摆的模型，并进行控制仿真。
二、实验原理一阶倒立摆是指在一根杆上挂一个质量小于杆的质量的小球，通过控制杆上电动机的电流来控制小球的倾斜角度，实现倒立控制。
2. 数学模型根据机械臂的动力学方程，可以得到一阶倒立摆的状态方程：其中，θ为小球倾斜的角度，M为电机的转矩，l为杆的长度，g为重力加速度，J为小球和杆组成的转动惯量。
3. PID控制PID控制是目前最常用的控制方法之一，包括比例控制、积分控制和微分控制。
PID控制器的控制对象通常是一个差值，由控制器在比例、积分和微分的作用下不断调整输出，使差值达到期望设定值。
其中，比例作用是根据误差的大小进行调整，积分作用是积累误差从而消除静差，微分作用是根据误差的变化率进行调整，消除系统震荡和过冲。
三、实验步骤1. 建立模型首先建立一阶倒立摆的模型，输入电机的转矩，输出小球的倾斜角度。
模型如下所示：2. 设计控制器在模型基础上，设计PID控制器，控制小球的倾斜角度达到预定值。
3. 进行仿真四、实验结果根据一阶倒立摆的数学模型，建立了如下图所示的Simulink模型：输入变量为电机的转矩M，输出变量为小球的倾斜角度θ。
根据反馈控制理论和PID控制原理，设计了如下的PID控制器：其中，Kp、Ki和Kd分别为比例、积分和微分增益。
利用上述模型和控制器进行仿真，得到了小球的倾斜角度随时间的变化曲线如下图所示：可以看出PID控制器在控制小球倾斜方面表现良好，小球在稳态时达到了预定角度，并在稳定范围内波动。
五、结论1. 本次实验成功建立了一阶倒立摆的数学模型；。
平面一级倒立摆实验报告
平面倒立摆实验一、实验装置简介平面倒立摆是在XY平台的基础上，设计平面倒立摆摆杆组件，组成平面倒立摆控制系统，倒立摆是研究自动控制原理和智能控制控制算法的研究平台，系统本身是一个多变量，强耦合的非线性系统。
1.系统组成一套完整的平面摆系统主要由以下三部分组成，见图片1-1：(1).控制对象，平面摆机械本体；(2).电控箱；(3).计算机。
图片 1-1 平面倒立摆系统组成用户在计算机上发送的指令通过电控箱转化为控制信号传达给机械本体的执行部件；反馈元件采集的信号通过电控箱送回计算机并转化为可视的数据、曲线、图像等在显示器上显示出来。
1.1 平面摆机械本体图片1-2所示，GPIP200X系列XY平台平面摆是由下端的GXY系列XY平台和上端的摆部件组成，部件全部采用工业级元件。
图片 1-2 XY 平台本体外观平面倒立摆摆体说明图片 1-3 平面一级倒立摆摆体外观1.2控制箱控制箱是平台控制部分的核心，与机械本体驱动电机配套，为交流伺服型，电控箱内置交流伺服驱动器、开关电源、断路器、接触器、运动控制器端子板，按钮开关等，外观见图片 1-4图片 1-4交流伺服型电控箱外形图1.3计算机为保证系统良好运行，建议计算机系统配置不低于一定标准。
二、平面一级倒立摆的建模在多种机器人动力学建模方法中，具有代表性的是牛顿－欧拉方法和拉格朗日方法。
用牛顿定律求解多体动力学问题时，需要把多体系统切开，将各个组成部分看作是独立的子结构，先建立各自的动力学方程，然后建立系统的动力学方程，求解驱动力的同时也解出切开处的铰链约束力；但是要解算大量的微分方程组，带来了一定的运算量。
由于倒立摆系统中关节处的约束力并无太大的意义，且由于拉格朗日方程组形式对称，表达方便，便于利用MATHEMATICA 强大的符号运算功能编程实现，简化了求解难度。
所以，本文采用拉格朗日方程推导平面一级倒立摆系统的动力学模型。
采用如图所示的坐标：根据几何知识：其中l是倒立摆摆杆长度，，分别是摆杆在x-z，y-z平面的映射长度，为摆杆与z轴方向的夹角，，分别为摆杆在x-z，y-z平面的映射与z轴方向的夹角。
直线一级倒立摆自动摆起控制实验
第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”为起摆控制模块。
- 1、下载文档前请自行甄别文档内容的完整性，平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益，请联系客服反馈,我们会尽快为您处理(人工客服工作时间：9:00-18:30)。
一、实验介绍：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）的控制论专家根据火箭发射助推器原理设计出一级倒立摆实验设备。
近年来，新的控制方法不断出现，人们试图通过倒立摆这样一个典型的控制对象，检验新的控制方法是否有较强的处理多变量、非线性和绝对不稳定系统的能力，从而从中找出最优秀的控制方法。
倒立摆系统作为控制理论研究中的一种比较理想的实验手段，为自动控制理论的教学、实验和科研构建一个良好的实验平台，以用来检验某种控制理论或方法的典型方案，促进了控制系统新理论、新思想的发展。
由于控制理论的广泛应用，由此系统研究产生的方法和技术将在半导体及精密仪器加工、机器人控制技术、人工智能、导弹拦截控制系统、航空对接控制技术、火箭发射中的垂直度控制、卫星飞行中的姿态控制和一般工业应用等方面具有广阔的利用开发前景。
一阶倒立摆系统的结构示意图如图1所示。
图1 一阶倒立摆结构示意图给系统施加脉冲扰动，输出量为摆杆的角度时，系统框图如下：图2 直线一级倒立摆闭环系统图（脉动干扰）倒立摆的控制目标倒立摆的控制问题就是使摆杆尽快地达到一个平衡位置，并且使之没有大的振荡和过大的角度和速度。
当摆杆到达期望的位置后，系统能克服随机扰动而保持稳定的位置。
倒立摆的控制方法倒立摆系统的输入为小车的位移（即位置）和摆杆的倾斜角度期望值，计算机在每一个采样周期中采集来自传感器的小车与摆杆的实际位置信号，与期望值进行比较后，通过控制算法得到控制量，再经数模转换驱动直流电机实现倒立摆的实时控制。
直流电机通过皮带带动小车在固定的轨道上运动，摆杆的一端安装在小车上，能以此点为轴心使摆杆能在垂直的平面上自由地摆动。
作用力u平行于铁轨的方向作用于小车，使杆绕小车上的轴在竖直平面内旋转，小车沿着水平铁轨运动。
当没有作用力时，摆杆处于垂直的稳定的平衡位置（竖直向下）。
为了使杆子摆动或者达到竖直向上的稳定，需要给小车一个控制力，使其在轨道上被往前或朝后拉动。
3、实验目的：（1）掌握MATLAB的基本使用。
（2）以一阶倒立摆为被控对象，初步掌握MATLAB对控制对象建模的方法。
（3）掌握MATLAB在系统分析、系统校正中的应用。
（4）掌握MATLAB仿真软件的使用方法及控制系统的调试方法。
（5）了解用古典控制理论设计控制器（如PID控制器）的设计方法和用现代控制理。
（6）论设计控制器（最优控制）的设计方法，加深对所学课程的理解，培养理论联系实际的能力。
4、预备知识：MATLAB语言是一种广泛应用于工程计算及数值分析领域的新型高级语言，自1984年由美国MathWorks公司推向市场以来，MATLAB从1984年公布的1.0版到现在的7.8版，功能不断增强，历经十多年的发展与竞争，现已成为国际公认的最优秀的工程应用开发环境，在数值型软件市场占主导地位。
MATLAB功能强大、简单易学、编程效率高，深受广大科技工作者的欢迎。
MATLAB对控制系统的理论分析，计算机辅助设计和仿真具有深刻意义。
在欧美各高等院校，MATLAB已经成为线性代数、自动控制理论、数字信号处理、时间序列分析、动态系统仿真、图像处理等课程的基本教学工具，成为大学生、硕士生以及博士生必须掌握的基本技能。
MATLAB是一个高度集成的语言环境，在该环境下既可以进行交互式的操作，又可以编写程序、运行程序并跟踪调试程序。
MATLAB语言是一种通用的仿真语言，该软件使用容易，提供丰富的矩阵处理功能，还有一个工具箱（仿真专门的应用程序集）。
MATLAB语言集可靠的数值运算、图象、图形显示及处理，高水平的图形界面风格为一体。
还与其它高级语言提供接口。
SIMULINK是为MATLAB语言提供的控制系统模型图形输入与仿真工具。
使用MATLAB对倒立摆系统建模、对控制算法进行模拟，在SIMULINK 中对控制算法进行仿真，已经成为研究倒立摆控制系统的通用方法。
二、实验内容：1、自学和答疑结合，掌握MATLAB软件的基本使用方法。
2、自学和答疑结合，掌握倒立摆的基本知识和基本控制算法。
3、在MATLAB编程环境下完成以下实验操作：1）MATLAB基本使用的练习。
2）MATLAB在系统分析、系统校正中的应用。
3）以一阶倒立摆为被控对象，在MATLAB中完成系统的建模。
4）倒立摆控制算法的MATLAB实现。
4、在proteus环境下，完成一阶倒立摆电机控制算法的仿真。
（选作）三、实验步骤：1．直线一阶倒立摆数学模型的推导：首先建立一阶倒立摆的物理模型。
在忽略空气阻力和各种摩擦之后，可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统，如图1所示。
图3-1 直线一阶倒立摆模型系统内部各相关参数定义如下：M 小车质量m 摆杆质量b 小车摩擦系数l 摆杆转动轴心到杆质心的长度I 摆杆惯量F 加在小车上的力x 小车位置φ摆杆与垂直向上方向的夹角θ摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）2．一阶倒立摆的微分方程模型：对一阶倒立摆系统中的小车和摆杆进行受力分析，其中，N和 P为小车与摆杆相互作用力的水平和垂直方向的分量。
图1-2 小车及摆杆受力图分析小车水平方向所受的合力，可以得到以下方程：（2-1）由摆杆水平方向的受力进行分析可以得到下面等式：（2-2）即：（2-3）把这个等式代入式(1-1)中，就得到系统的第一个运动方程：（2-4）为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析，可以得到下面方程：（2-5）即：（2-6）力矩平衡方程如下：（2-7）由于所以等式前面有负号。
合并这两个方程，约去 P和 N，得到第二个运动方程：（2-8）设，（φ是摆杆与垂直向上方向之间的夹角），假设φ<<1弧度，则可以进行近似处理：。
用u代表被控对象的输入力F，利用上述近似进行线性化得直线一阶倒立摆的微分方程为：3．一阶倒立摆的传递函数模型：对式(1-9)进行拉普拉斯变换，得：注意：推导传递函数时假设初始条件为 0。
由于输出为角度φ，求解方程组的第一个方程，可得：（2-9）（3-1）或如果令，则有：把上式代入方程组（3-1）的第二个方程，得：整理后得到传递函数：其中。
4．一阶倒立摆的状态空间模型：设系统状态空间方程为：（3-5）（3-2）（3-3）（3-4）（3-6）（4-1）方程组（2-9）对解代数方程，得到解如下：整理后得到系统状态空间方程：摆杆的惯量为，代入（2-9）的第一个方程为：得：化简得：（4-2）（4-3）（4-4）设，则有：5.实际系统的传递函数与状态方程：实际系统的模型参数如下:M 小车质量 0.5 Kg m 摆杆质量 0.2 Kg b 小车摩擦系数 0 .1N/m/sec l 摆杆转动轴心到杆质心的长度 0.3m I 摆杆惯量 0.006 kg*m*m 代入上述参数可得系统的实际模型。
摆杆角度和小车位移的传递函数：（4-5）（4-6）（4-2） （5-1）摆杆角度和小车加速度之间的传递函数为：（5-2）摆杆角度和小车所受外界作用力的传递函数：以外界作用力作为输入的系统状态方程：（5-3）（5-4）6.用MATLAB的Simulink进行仿真：（1）没校正之前的θ-F控制系统：由于未加进控制环节，故系统输出发散。
（2）加进控制环节，实现时域的稳定控制：给系统加入PID 控制，设置系统稳定值为0，给系统一个初始干扰冲击信号，采用试凑法不断调整PID 参数，使系统达到所需的控制效果。
当系统Kp=-100，Ti=Td=0时输出如下：Transfer Fcn-1s +-20.582ScopePulseGeneratorIntegrator 1s Gain 3-40Gain 11Gain -K-Derivativedu/dt Constant不断地调整参数，最后得到稳定的响应 Kp=-1000，Ti=1，Td=-40时，在打开的如下界面里修改具体参数调整。
可见调整好参数后，系统基本达到稳定，净差基本为0，超调较小，响应时间较小。
再微调后，得到最终的响应曲线响应时间较小，Tp=0.2s 。
（3）时域达到稳定后，进行离散化分析：离散模型系统控制框图如下：当Kp=-100，Ti=0，Td=0时输出 ：发散，需加大Kp 、增加Ti 、Td 控制 Kp=-100，Ti=-2，Td=-1000时输出：仍需调节PID ，由图可知超调仍大，响应时间稍长，故微增加Kp 、Ti 、TdZero -OrderHoldTransfer Fcn-1s +-20.582ScopePulseGeneratorGain 3-K-Gain 1-2Gain-K-Discrete Filter11-z -1Discrete FIR Filter1-z -11Constant反复试凑PID参数得到较好响应曲线如下（Kp=-110，Ti=-4，Td=-1500时）如果控制效果不理想，调整参数，直到获得较好控制效果；运动曲线文件要及时，在MATLAB中运行保存指令，MATLAB会将保存的曲线重新绘制出来。