一级倒立摆的建模与控制分析

研究生《现代控制理论及其应用》课程小论文

一级倒立摆的建模与控制分析

学院：机械工程学院

班级：机研131

姓名：尹润丰

学号： 201321202016

2014年6月2日

目录

1. 问题描述及状态空间表达式建立............................ - 1 -

1.1问题描述................................................................. - 1 -

1.2状态空间表达式的建立..................................................... - 1 -

1.2.1直线一级倒立摆的数学模型........................................... - 1 -

1.2.2 直线一级倒立摆系统的状态方程 ...................................... - 5 -

2.应用MATLAB分析系统性能.................................. - 6 -

2.1直线一级倒立摆闭环系统稳定性分析......................................... - 6 -

2.2 系统可控性分析.......................................................... - 7 -

2.3 系统可观测性分析........................................................ - 8 -

3. 应用matlab进行综合设计................................. - 8 -

3.1状态反馈原理............................................................. - 8 -

3.2全维状态反馈观测器和simulink仿真........................................ - 9 -

4.应用Matlab进行系统最优控制设计......................... - 11 -

5.总结.................................................... - 13 -

1.问题描述及状态空间表达式建立

1.1问题描述

倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合，其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统，可以作为一个典型的控制对象对其进行研究。倒立摆系统作为控制理论研究中的一种比较理想的实验手段，为自动控制理论的教学、实验和科研构建一个良好的实验平台，以用来检验某种控制理论或方法的典型方案，促进了控制系统新理论、新思想的发展。

下对于倒立摆系统，经过小心的假设忽略掉一些次要的因素后，它就是一个典型的运动的刚体系统，可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。下面采用其中的牛顿—欧拉方法建立直线一级倒立摆系统的数学模型。

1.2状态空间表达式的建立

1.2.1直线一级倒立摆的数学模型

..

.. 图1.1 直线一级倒立摆系统

本文中倒立摆系统描述中涉及的符号、物理意义及相关数值如表1.1所示。

图1.2是系统中小车的受力分析图。其中，N和P为小车与摆杆相互作用力的水平和垂直方向的分量。

..

图1.2 系统中小车的受力分析图

图1.3是系统中摆杆的受力分析图。F s 是摆杆受到的水平方向的干扰力, F h 是摆杆受到的垂直方向的干扰力，合力是垂直方向夹角为α的干扰力F g 。

图1.3 摆杆受力分析图

分析小车水平方向所受的合力，可以得到以下方程：

()11- 设摆杆受到与垂直方向夹角为α 的干扰力Fg ，可分解为水平方向、垂直方向的干扰力，所产生的力矩可以等效为在摆杆顶端的水平干扰力FS 、垂直干扰力Fh 产生的力矩。

()21-

对摆杆水平方向的受力进行分析可以得到下面等式：

()θsin 22

l x dt

d m F N S +=- ()31-

N x f F x

M --= α

sin g S F F =α

cos g h F F =

..

即：

αθθθθsin sin cos 2f F ml ml x m N +-+= ()41- 对图1.3摆杆垂直方向上的合力进行分析，可以得到下面方程：

()θcos 22

l l dt

d m F mg P h -=++- ()51-

即 θθθθ

αcos sin cos 2 ml ml F mg P g +=++- ()61-

力矩平衡方程如下：

0cos sin sin cos cos sin =++++θθθθαθα I Nl Pl l F l F g g ()71- 代入P 和N ，得到方程：

()0cos 2sin sin 2cos sin cos 2cos sin 2222=+-++++θθθθθθθαθαx ml ml mgl ml I l F l F g g ()81- 设φπθ+=，（φ是摆杆杆与垂直向上方向之间的夹角，单位是弧度），代入上式。假设φ<<1，则可进行近似处理：

φφφφφφφ===??

?

??==2sin ,12cos ,0,sin ,1cos 2

dt d

由于：23

1

ml I =

方程化为：

()x

m mg ml F g

=-+--φφαφα34cos sin 2 ()91- 令：()αφαcos sin --=g f F F ，则()91-可化为：

x m mg ml F f

=-+φφ

3

42 ()101- ()101-即是化简后的直线一级倒立摆系统微分方程。带入实际数据后，微分方程为：

m

F x f

234.29-+= θθ ()111-

当忽略了F f 时，系统的微分方程如式（1-12）所示

x 34.29+=θθ

()121- 忽略干扰力后，直线一级倒立摆系统是单输入二输出的四阶系统，考虑干扰力后，

..

直线一级倒立摆系统是二输入二输出的四阶系统。其内部的4个状态量分别是小车的

位移x 、小车的速度x

、摆杆的角度θ、摆杆的角速度θ 。系统输出的观测量为小车的位移x 、摆杆的角度θ。其控制量为小车的加速度θ

将微分方程（1-12）化为关于加速度输入量和角度输出量的传递函数：

()

()4

.2932-=s s R s θ ()131-

1.2.2 直线一级倒立摆系统的状态方程

实验所使用的直线一级倒立摆系系统是加速度x

作为系统的控制输入，所以根据式（1-12）建立系统的状态方程为：

x

l

l g x

x x x 4343+====φφφφ

整理后得到系统状态方程：

[][]x x x x y x l g x x l g

x x

??

????+?????

?????????????=??????=????

???

???????+?????????????????????????

?=????????????00

0100000143010043001000000000

1

0φφφφ

φφφ

将实际参数代入得到一级倒立摆系统的状态空间方程为：

..

[][]x x x x y x

x x x x ??

????+?????

?????????????=??????=?

?

???

???????+????????????????????????=????????????00

01000001301004.2900

1000000000

10φφφφφφφ

?????????

???=04.2900

1000000000

1

0A ?

????

?

??????=3010B ??

????=01000001C ??????=00D

2.应用MATLAB 分析系统性能

2.1直线一级倒立摆闭环系统稳定性分析

构建如图1.4所示闭环系统，则系统的闭环极点为（-5.1381）、（5.1381）

:

图1.4 闭环系统结构图

由于有实部为正的极点，所以闭环系统不稳定，必须设计控制器使系统稳定。可以通过MATLAB Simulink 中对其进行仿真，判断其稳定性。 构建图1.4所示系统的仿真程序e1，加入1m/s 2的阶跃信号

..

由上图也能清楚的知道一级倒立摆系统是不稳定的。

2.2 系统可控性分析

系统的可控性可根据秩判据进行可控性判断。线性定常连续系统完全可控的充分必要条件是：1()n rank B AB A B n -???=，其中n 为系统矩阵A 的阶次，

1()n M B AB A B -=???为系统的可控性矩阵。 matlab 程序及运行结果如下：

>> A=[0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0]; >> B=[0;1;0;3]; >> T=ctrb(A,B); >> rank(T) ans = 4

由于rank （Ic ）=4，可见该系统是完全可控的。

..

2.3 系统可观测性分析

系统的可控性可根据秩判据进行可控性判断。线性定常连续系统完全可控的充分必要条件是：

1n C CA rank N rank n CA -?????????==?????????????

?或21(()())T T T T T T n T

rank C A C A C A C n -???=

其中n 为系数矩阵A 的阶次。 matlab 程序及运行结果如下：

>> A=[0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0]; >> C=[1 0 0 0;0 0 1 0]; >> T0=obsv(A,C); rank(T0) ans = 4

由于rank （T0）=4，故该系统是可观测的。

3.应用matlab 进行综合设计

3.1状态反馈原理

设ｎ维线性定常系统：

Cx y Bu Ax x

=+=, 其中x,u,y 分别是n 维、p 维、q 维向量；A 、B 、C 分别是n*n 维，n*p 维，n*q 维实数矩

阵。状态反馈系统的控制量u 取为状态x 的线性函数：

..

Kx v u -=

其中，v 为p 参考输入向量，K 为p*n 维实反馈增益矩阵。 加入状态反馈后系统的结构图如图3.1所示：

图3.1 系统的全状态反馈结构图

则系统状态反馈的动态方程为：

()Cx y Bv x BK A x

=+-=, 3.2全维状态反馈观测器和simulink 仿真

状态反馈的的实现是利用状态反馈使系统的闭环极点位于所希望的极点位置。而状

态反馈任意配置闭环极点的充分必要条件是被控系统可控。直线一级倒立摆系统是可控的。

设系统期望极点为[]4321λλλλ=[]i i 343432--+---，则系统期望特征多

项式为：

()()()()()4321*λλλλ----=s s s s s a

列写状态反馈系统的特征多项式：

()BK A SI +-det

令两个特征多项式各项系数对应相等，则可解出K 阵。由matlab 求出状态反馈矩阵K ，编程如下：

A=[0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0]; >> B=[0;1;0;3];

>> K=acker(A,B,[-2 -3 -4+3i -4-3i]) K =

-5.1020 -5.8844 35.1673 6.2948

系统加入0.1m/s2的阶跃输入，在构成的状态反馈调节器控制下，MATLAB中进行系统的阶跃响应仿真，编程如下：

A=[0 1 0 0

0 0 0 0

0 0 0 1

0 0 29.4 0];

B1=[0

1

3];

C=[1 0 0 0

0 1 0 0

0 0 1 0

0 0 0 1];

D1=[0 0 0 0]';

dt=0.005;

ieof=801;

for i=1:ieof;

U(:,i)=[0.1];

T(i)=i*dt;

end;

%%离散化

op=[-2 %期望极点

-3

-4+3i

-4-3i];

K=place(A,B1,op)

Ak0=[(A-B1*K)];

Bk0=[B1];

Ck0=[C];

Dk0=[D1];

lqrop=eig(Ak0);

x=[0 0 0 0]';

dt=0.005;%离散时

[dA,dB]=c2d(Ak0,Bk0,dt);%经离散化得到离散状态方程

Ak1=[(A-B1*K)];

Bk1=[B1];

Ck1=[C];

Dk1=[D1];

sys=ss(Ak1,Bk1,Ck1,Dk1);

..

..

[Y,X]=lsim(sys,U,T); plot(T,-Y), grid;

legend('Cart','VCart','single','Vs');

图3.2 极点配置为[-2 -3 -4+3i -4-3i]时的全状态反馈仿真图

横轴时间单位秒，从图中可以看出，系统稳定。

4.应用Matlab 进行系统最优控制设计

最优控制问题就是寻找一个控制系统的最优控制方案或最优控制规律，使系统能最优地达到预期的目标。对于线性连续系统，提出二次型目标函数：

()()()()()()[]

d t t u t R t u t x t Q t x t Sx t x J f

t t T T f f T ?++=

21)()(21

其中，R(t)正定，S 及Q （t)半正定，且设它们为对称矩阵，f t t ,0固定。当

f

t 趋近

无穷时，在)()(t x t y =情况下，该问题即为无限时间输出调节器问题。此时稳态误差项趋于零，在此题目中假设二次型最优控制性能指标为：

dt Ru u x Q x J T T ][0

+=?∞

..

其中：??

???

????

???=1000

0500000

300

000500Q R=1 Matlab 编程如下：

A=[0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0]; B=[0;1;0;3];

C=[1 0 0 0;0 1 0 0;0 0 1 0;0 0 0 1]; D=[0 0 0 0];

Q=[500 0 0 0;0 30 0 0;0 0 50 0;0 0 0 10]; R=1;

>> [K,P,e]=lqr(A,B,Q,R) K =

-22.3607 -17.4697 70.1041 13.2462 在simulink 下进行仿真模型的建立，如图4.1：

图4.1 LQR 仿真模型

将K 输入后，进行仿真，结果如图4.2：

图4.2 LQR仿真结果

由图可见，在二次型最优控制下系统稳定性得到明显改善。

5.总结

通过对一级倒立摆的分析可知，在开环情况下，倒立摆的平衡系统是不稳定的的；通过秩判据可知，其系统是可控可观测的；通过状态反馈对极点进行配置后，使极点都位于虚轴左侧，则经过极点配置的倒立摆稳定，又进行了LQR算法对倒立摆进行控制，也可以使系统稳定。以上都是利用MATLAB对机器人进行分析和设计，对其系统进行了稳定性、可控性、可观测性分析，以及极点配置和最优控制设计，从中我们可以看出，MATLAB作为一种交互式计算分析软件，其强大的运算分析功能，集科学计算、程序设计和可视化于一体的高度集成化软件环境，为控制系统的分析

设计，特别是高阶系统综合设计，提供了一种方便可靠的途径。

..

一级倒立摆的建模与控制分析

控制工程与仿真课程设计报告 报告题目直线一级倒立摆建模、分析及控制器的设计 组员1专业、班级14自动化1 班姓名朱永远学号1405031009 组员1专业、班级14自动化1 班姓名王宪孺学号1405031011组员1专业、班级14自动化1 班姓名孙金红学号1405031013 报告评分标准 评分项目权重评价内容评价结果项目得分 内容70设计方案较合 理、正确，内容 较完整 70-50分 设计方案基本合 理、正确，内容 基本完整 50-30分 设计方案基本不 合理、正确，内 容不完整 0-30分 语言组织15语言较流顺，标 点符号较正确 10-15分语言基本通顺， 标点符号基本正 确 5-10分 语言不通顺，有 错别字，标点符 号混乱 5分以下 格式15 报告格式较正 确，排版较规范 美观 10-15分 报告格式基本正 确，排版不规范 5-10分 报告格式不正 确，排版混乱 5分以下总分

直线一级倒立摆建模、分析及控制器的设计 一状态空间模型的建立 1.1直线一级倒立摆的数学模型 图1.1 直线一级倒立摆系统 本文中倒立摆系统描述中涉及的符号、物理意义及相关数值如表1.1所示。

图1.2是系统中小车的受力分析图。其中，N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量。 图1.2 系统中小车的受力分析图 图1.3是系统中摆杆的受力分析图。F s 是摆杆受到的水平方向的干扰力, F h 是摆杆受到的垂直方向的干扰力，合力是垂直方向夹角为α的干扰力F g 。

图1.3 摆杆受力分析图 分析小车水平方向所受的合力，可以得到以下方程： ()11- 设摆杆受到与垂直方向夹角为α 的干扰力Fg ，可分解为水平方向、垂直方向的干扰力，所产生的力矩可以等效为在摆杆顶端的水平干扰力FS 、垂直干扰力Fh 产生的力矩。 ()21- 对摆杆水平方向的受力进行分析可以得到下面等式： ()θsin 22 l x dt d m F N S +=- ()31- 即： αθθθθsin sin cos 2f F ml ml x m N +-+= ()41- 对图1.3摆杆垂直方向上的合力进行分析，可以得到下面方程： ()θcos 22 l l dt d m F mg P h -=++- ()51- 即 θθθθ αcos sin cos 2 ml ml F mg P g +=++- ()61- 力矩平衡方程如下： 0cos sin sin cos cos sin =++++θθθθαθα I Nl Pl l F l F g g ()71- 代入P 和N ，得到方程： () 0cos 2sin sin 2cos sin cos 2cos sin 2222=+-++++θθθθθθθαθαx ml ml mgl ml I l F l F g g ()81- 设φπθ+=，（φ是摆杆杆与垂直向上方向之间的夹角，单位是弧度），代入上式。假设φ<<1，则可进行近似处理： φφφφφφφ===?? ? ??==2sin ,12cos ,0,sin ,1cos 2 dt d N x f F x M --= α sin g S F F =α cos g h F F =

单级倒立摆系统的分析与设计

单级倒立摆系统的分析与设计 小组成员：武锦张东瀛杨姣 李邦志胡友辉 一．倒立摆系统简介 倒立摆系统是一个典型的高阶次、多变量、不稳定和强耦合的非线性系统。由于它的行为与火箭飞行以及两足机器人行走有很大的相似性，因而对其研究具有重大的理论和实践意义。由于倒立摆系统本身所具有的上述特点，使它成为人们深入学习、研究和证实各种控制理论有效性的实验系统。 单级倒立摆系统（Simple Inverted Pendulum System）是一种广泛应用的物理模型，其结构和飞机着陆、火箭飞行及机器人的关节运动等有很多相似之处，因而对倒立摆系统平衡的控制方法在航空及机器人等领域有着广泛的用途，倒立摆控制理论产生的方法和技术将在半导体及精密仪器加工、机器入技术、导弹拦截控制系统、航空器对接控制技术等方面具有广阔的开发利用前景。 倒立摆仿真或实物控制实验是控制领域中用来检验某种控制理论或方法的典型方案。最初研究开始于二十世纪50年代，单级倒立摆可以看作是一个火箭模型，相比之下二阶倒立摆就复杂得多。1972年，Sturgen等采用线性模拟电路实现了对二级倒立摆的控制。目前，一级倒立摆控制的仿真或实物系统已广泛用于教学。 二．系统建模 1．单级倒立摆系统的物理模型 图1：单级倒立摆系统的物理模型

单级倒立摆系统是如下的物理模型：在惯性参考系下的光滑水平平面上，放置一个可以在平行于纸面方向左右自由移动的小车（cart ），一根刚性的摆杆（pendulum leg ）通过其末端的一个不计摩擦的固定连接点（flex Joint ）与小车相连构成一个倒立摆。倒立摆和小车共同构成了单级倒立摆系统。倒立摆可以在平行于纸面180°的范围内自由摆动。倒立摆控制系统的目的是使倒立摆在外力的摄动下摆杆仍然保持竖直向上状态。在小车静止的状态下，由于受到重力的作用，倒立摆的稳定性在摆杆受到微小的摄动时就会发生不可逆转的破坏而使倒立摆无法复位，这时必须使小车在平行于纸面的方向通过位移产生相应的加速度。依照惯性参考系下的牛顿力学原理，作用力与物体位移对时间的二阶导数存在线性关系，单级倒立摆系统是一个非线性系统。 各个参数的物理意义为： M — 小车的质量 m — 倒立摆的质量 F — 作用到小车上的水平驱动力 L — 倒立摆的长度 x — 小车的位置 θ— 某一时刻摆角 整个倒立摆系统就受到重力、驱动力和摩擦阻力的三个外力的共同作用。这里，驱动力F 是由连接小车的传动装置提供，控制倒立摆的稳定实际上就是依靠控制驱动力F 使小车在水平面上做与倒立摆运动相关的特定运动。为了简化模型以利于仿真，假设小车与导轨以及摆杆与小车铰链之间的摩擦均为0。 2．单级倒立摆系统的数学模型 令小车的水平位移为x ，运动速度为v ，加速度a 。 小车的动能为212kc E Mx =，选择特定的参考平面使得小车的势能为0。 摆杆的长度为L ，某时刻摆角为θ，在摆杆上与固定连接点距离为q （0

(完整版)一级倒立摆系统分析

一级倒立摆的系统分析 一、倒立摆系统的模型建立 如图1-1所示为一级倒立摆的物理模型 图1-1 一级倒立摆物理模型 对于上图的物理模型我们做以下假设： M：小车质量 m：摆杆质量 b：小车摩擦系数 l：摆杆转动轴心到杆质心的长度 I：摆杆惯量 F：加在小车上的力 x：小车位置 ?：摆杆与垂直向上方向的夹角 θ：摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）图1-2是系统中小车和摆杆的受力分析图。其中，N和P为小车与摆

杆相互作用力的水平和垂直方向的分量。注意：实际倒立摆系统中的检测和执行装置的正负方向已经完全确定，因而矢量方向定义如图所示，图示方向为矢量正方向。 图1-2 小车及摆杆受力分析 分析小车水平方向受力，可以得到以下方程： M x?＝Ｆ-ｂx?-Ｎ (1-1) 由摆杆水平方向的受力进行分析可以得到以下方程： N =m d 2dt (x +l sin θ) (1-2) 即： N =mx?+mlθcos θ?mlθ2sin θ (1-3) 将这个等式代入式（1-1）中，可以得到系统的第一个运动方程： (M +m )x?+bx?+mlθcos θ?mlθ2sin θ=F (1-4) 为推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析，可以得出以下方程： P ?mg =m d 2dt 2 (l cos θ) (1-5) P ?mg =? mlθsin θ?mlθ2cos θ (1-6) 利用力矩平衡方程可以有：

?Pl sinθ?Nl cosθ=Iθ (1-7) 注意：此方程中的力矩方向，由于θ=π+?，cos?=?cosθ，sin?=?sinθ，所以等式前面含有负号。 合并两个方程，约去P和N可以得到第二个运动方程： (I+ml2)θ+mgl sinθ=?mlx?cosθ (1-8) 设θ=π+?，假设?与1（单位是弧度）相比很小，即?＜＜1，则 可以进行近似处理：cosθ=?1，sinθ=??，（dθ dt ） 2 =0。用u来 代表被控对象的输入力F，线性化后的两个运动方程如下： {(I+ml2)??mgl?=mlx? (M+m)x?+bx??ml?=u (1-9) 假设初始条件为0，则对式（1-9）进行拉普拉斯变换，可以得到： {(I+ml2)Φ(s)s2?mglΦ(s)=mlX(s)s2 (M+m)X(s)s2+bX(s)s?mlΦ(s)s2=U(s) (1-10) 由于输出为角度?，求解方程组的第一个方程，可以得到： X(s)=[(I+ml2) ml ?g s ]Φ(s) (1-11) 或改写为：Φ(s) X(s)=mls2 (I+ml2)s2?mgl (1-12) 如果令v=x?,则有：Φ(s) V（s）=ml (I+ml2)s2?mgl (1-13) 如果将上式代入方程组的第二个方程，可以得到： (M+m)[(I+ml2) ml ?g s ]Φ(s)s2+b[(I+ml2) ml +g s ]Φ(s)s?mlΦ(s)s2= U(s) (1-14) 整理后可得传递函数： Φ(s) U(s)= ml q s2 s4+b(I+ml 2) q s3?(M+m)mgl q s2?bmgl q s (1-15)

倒立摆姿态控制模型

倒立摆 倒立摆百度文库解释： 倒立摆系统的输入为小车的位移（即位置）和摆杆的倾斜角度期望值，计算机在每一个采样周期中采集来自传感器的小车与摆杆的实际位置信号，与期望值进行比较后，通过控制算法得到控制量，再经数模转换驱动直流电机实现倒立摆的实时控制。直流电机通过皮带带动小车在固定的轨道上运动，摆杆的一端安装在小车上，能以此点为轴心使摆杆能在垂直的平面上自由地摆动。作用力u平行于铁轨的方向作用于小车，使杆绕小车上的轴在竖直平面内旋转，小车沿着水平铁轨运动。当没有作用力时，摆杆处于垂直的稳定的平衡位置（竖直向下）。为了使杆子摆动或者达到竖直向上的稳定，需要给小车一个控制力，使其在轨道上被往前或朝后拉动。 倒立摆系统简介 倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合，其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统，可以作为一个典型的控制对象对其进行研究。最初研究开始于二十世纪50 年代，麻省理工学院（MIT）的控制论专家根据火箭发射助推器原理设计出一级倒立摆实验设备。近年来，新的控制方法不断出现，人们试图通过倒立摆这样一个典型的控制对象，检验新的控制方法是否有较强的处理多变量、非线性和绝对不稳定系统的能力，从而从中找出最优秀的控制方法。倒立摆系统作为控制理论研究中的一种比较理想的实验手段，为自动控制理论的教学、实验和科研构建一个良好的实验平台，以用来检验某种控制理论或方法的典型方案，促进了控制系统新理论、新思想的发展。由于控制理论的广泛应用，由此系统研究产生的方法和技术将在半导体及精密仪器加工、机器人控制技术、人工智能、导弹拦截控制系统、航空对接控制技术、火箭发射中的垂直度控制、卫星飞行中的姿态控制和一般工业应用等方面具有广阔的利用开发前景。平面倒立摆可以比较真实的模拟火箭的飞行控制和步行机器人的稳定控制等方面的研究。 倒立摆分类

一级倒立摆地Simulink仿真

单级倒立摆稳定控制 直线一级倒立摆系统在忽略了空气阻力及各种摩擦之后，可抽象成小车和匀质摆杆组成的系统，如图1所示。 图1 直线一级倒立摆系统 图2 控制系统结构 假设小车质量M =0.5kg ，匀质摆杆质量m=0.2kg ，摆杆长度2l =0.6m ，x (t )为小车的水平位移，θ为摆杆的角位移，2 /8.9s m g =。控制的目标是通过外力u (t)使得摆直立向上（即0)(=t θ）。该系统的非线性模型为： u ml x m M ml mgl x ml ml J +=++=++22)sin ()()cos (sin )cos ()(θθθθθθθ ，其中231ml J =。 解： 一、 非线性模型线性化及建立状态空间模型 因为在工作点附近（0,0==θ θ ）对系统进行线性化，所以 可以做如下线性化处理：32 sin ,cos 13!2!θθθθθ≈-≈-

当θ很小时，由cos θ、sin θ的幂级数展开式可知，忽略高次项后， 可得cos θ≈1，sin θ≈θ，θ’^2≈0； 因此模型线性化后如下： （J+ml^2）θ’’+mlx ’’=mgl θ (a) ml θ’’+(M+m) x ’’=u (b) 其中23 1ml J = 取系统的状态变量为,,,,4321θθ ====x x x x x x 输出T x y ][θ=包括小车位移和摆杆的角位移. 即X=????????????4321x x x x =????? ???????''θθx x Y=??????θx =??????31x x 由线性化后运动方程组得 X1’=x ’=x2 x2’=x ’’=m m M mg 3)(43-+-x3+m m M 3)(44-+u X3’ =θ’=x4 x4’=θ’’=ml l m M g m M 3)(4)(3-++x3+ml l m M 3)(43-+-u 故空间状态方程如下： X ’=????????????'4'3'2'1x x x x =????????????????? ?-++-+-03)(4)(300100003)(4300 0010ml l m M g m M m m M mg ????????????4321x x x x + ???????? ??????????-+--+ml l m M m m M 3)(4303)(440 u

三级倒立摆建模与控制器设计仿真

三级倒立摆 摘要：从刚体运动学角度分析了三级倒立摆系统的运动，运用状态空间法对三级倒立摆系统进行数学模型的建立;应用二次型最优控理论实现三级倒立摆控制；最后根据计算结果，通过Matlab程序仿真，得出上中下摆的角度和小车的位移曲线图。 关键词：倒立摆；最优控；仿真；MATLAB 三级倒立摆系统模型 一个典型的三级直线倒立摆系统主要由机电装置和控制装置两部分组成,机电装置的结构见图! 其主要由摆杆、电机、小车、导轨、传动齿轮、齿条及各种传感器等构成假设系统中的每一根摆杆都是匀质刚体， 图1所示的倒立摆系统的物理分析： 三级倒立摆受力分析图： 小车受力分析图 小车 图1 系统分析示意图

上摆受力分析 下摆牛顿定律及动力矩方程： 中摆受力分析： ) 丄摆受力分析： 注：—下，中，上摆质心到铰链处距离； –下，中摆的长度； 上，中，下摆偏离竖直方向的角度； 下，中，上摆质量; 其动力学方程如下⑴： M()=F(⑴ M()= F()=

N()= G= 将此非线性模型在系统的平衡点r====0,处线性化得到系统的状态方程: ⑵ , 其中： 将参数带入方程计算： A= B= C=D= 控制器设计 根据由图⑴所示的倒立摆系统模型的推导可知，该系统在一定的前提下，可以转变为线性系统#对于线性系统的控制，需要经过系统的稳定性、能控性和能观性判断后才能选择其最优的控制策略#图!显示了式（$）所示的线性系统外控制器的设计过程 状态方程的重构过程，实质上就是本文从式⑴式转化为式⑵式的过程，在MATLAB中，可以用如下代码表示: ％系统状态方程的重构 ％状态变量 ()=( ,zeta) ％输出变量Y=X A=zeros(8,8); A(1:4,5:8)=eye(4,4); A(5:8,1:4)=M A(5:8,5:8)=M ％不用invese而用blackslash是由于blackslash有更好的错误检查机制并且少用时间和内存。 B=zeros(8,1); B(5:8)=M C=zeros(4,8) C(1:4,1:4)=eye(4,4); D=zeros(4,1); 系统的稳定性、能控性及能惯性判断 对于如式（2）式所示的线性定常系统而言，其稳定性可通过计算系统矩阵A 的特征值来确定(李雅普诺夫线性系统稳定判据)，如果特征值均处于[S]复平面左半平面，则系统稳定。

一阶倒立摆控制系统

一阶直线倒立摆系统 姓名： 班级： 学号：

目录 摘要 (3) 第一部分单阶倒立摆系统建模 (4) （一）对象模型 (4) （二）电动机、驱动器及机械传动装置的模型 (6) 第二部分单阶倒立摆系统分析 (7) 第三部分单阶倒立摆系统控制 (11) （一）内环控制器的设计 (11) （二）外环控制器的设计 (14) 第四部分单阶倒立摆系统仿真结果 (16) 系统的simulink仿真 (16)

摘要： 该问题源自对于娱乐型”独轮自行车机器人”的控制，实验中对该系统进行系统仿真，通过对该实物模型的理论分析与实物仿真实验研究，有助于实现对独轮自行车机器人的有效控制。 控制理论中把此问题归结为“一阶直线倒立摆控制问题”。另外，诸如机器人行走过程中的平衡控制、火箭发射中的垂直度控制、卫星飞行中的姿态控制、海上钻井平台的稳定控制、飞机安全着陆控制等均涉及到倒立摆的控制问题。 实验中通过检测小车位置与摆杆的摆动角，来适当控制驱动电动机拖动力的大小，控制器由一台工业控制计算机（IPC）完成。实验将借助于“Simulink封装技术——子系统”，在模型验证的基础上，采用双闭环PID控制方案，实现倒立摆位置伺服控制的数字仿真实验。实验过程涉及对系统的建模、对系统的分析以及对系统的控制等步骤，最终得出实验结果。仿真实验结果不仅证明了PID方案对系统平衡控制的有效性，同时也展示了它们的控制品质和特性。 第一部分单阶倒立摆系统建模

（一） 对象模型 由于此问题为”单一刚性铰链、两自由度动力学问题”，因此，依据经典力学的牛顿定律即可满足要求。 如图1.1所示，设小车的质量为0m ，倒立摆均匀杆的质量为m ，摆长为2l ，摆的偏角为θ，小车的位移为x ，作用在小车上的水平方向上的力为F ，1O 为摆杆的质心。 图1.1 一阶倒立摆的物理模型 根据刚体绕定轴转动的动力学微分方程，转动惯量与角加速度乘积等于作用于刚体主动力对该轴力矩的代数和，则 1）摆杆绕其重心的转动方程为 sin cos y x l F J F l θθθ=-&& （1-1） 2）摆杆重心的水平运动可描述为 2 2(sin )x d F m x l dt θ=+ （1-2） 3）摆杆重心在垂直方向上的运动可描述为 2 2(cos )y d F mg m l dt θ-= （1-3） 4）小车水平方向运动可描述为 202x d x F F m dt -= （1-4）

倒立摆建模

系统建模 系统建模可以分为两种:机理建模和实验建模.实验建模就是通过在研究对象上加上一系列的研究者先确定的输入信号,激励研究对象并通过传感器的检测其可观测的输出,应用数学手段建立起系统输入---输出关系.这里包括输入信号的设计选取,输出信号的精确检测,数学算法的研究等等内容.机理建模就是在了解研究对象在运动规律基础上,通过物理,化学的知识和数学手段建立起的系统内部的输入输出状态关系.系统的建模原则： 1) 建模之前，要全面了解系统的自然特征和运动机理，明确研究目的和准确性要求，选择合适的分析方法。 2) 按照所选分析法，确定相应的数学模型的形式； 3) 根据允许的误差范围，进行准确性考虑，然后建立尽量简化的合理的数学模型。 小车—倒立摆系统是各种控制理论的研究对象。只要一提小车—倒立摆系统，一般均认为其数学模型也已经定型。事实上，小车—倒立摆的数学模型与驱动系统有关，常见到的模型只是对应于直流电机的情况，如果执行机构是交流伺服电机，就不是这个模型了。本文主要分析由直流电机驱动的小车—倒立摆系统。小车倒立摆系统是检验控制方式好坏的一个典型对象，其特点是高阶次、不稳定、非线性、强耦合，只有采取有效的控制方式才能稳定控制. 在忽略空气阻力,各种摩擦之后,可将直线一级倒立摆系统抽象成小车忽然均匀质杆组成的系统,如下图所示: 图中F 是施加于小车的水平方向的作用力，x 是小车的位移，φ是摆的倾斜角。若不给小车施加控制力，倒摆会向左或向右倾斜，控制的目的是当倒摆出现偏角时，在水平方向上给小车以作用力，通过小车的水平运动，使倒摆保持在垂直的位置。即控制系统的状态参数，以保持摆的倒立稳定。 M 小车的质量 0.5Kg m 摆杆的质量 0.2Kg X φ F M 图1 直线一级倒立摆系统 θ

(完整版)一级直线倒立摆matlab程序

非线性作业 一 一级直线倒立摆 如图1所示 系统里的各参数变量 M ：小车系统的等效质量（1.096kg ）； 1m ：摆杆的质量（0.109kg ）； 2m ：摆杆的半长（0.25m ）； J ：摆杆系统的转动惯量（0.0034kg*m ）； g ：重力加速度（9.8N/Kg ）； r ：小车的水平位置（m ）； θ：摆角大小（以竖直向上为0起始位置，逆时针方向为正方向）； h F ：小车对摆杆水平方向作用力（N ）（向左为正方向），h F ’是其反作用力； v F ：小车对摆杆竖直方向作用力（N ）（向上为正方向），v F ’是其反作用力； U ：电动机经传动机构给小车的力，可理解为控制作用u’（向左为正方向）； p x ：摆杆重心的水平位置（m ）；p y ：摆杆重心的竖直位置（m ）。 1．1一级倒立摆的数学建模 定义系统的状态为[r,r, θ, θ] 经推导整理后可以达到倒立摆系统的牛顿力学模型： θθθsin cos )(2mgl l r m ml I =-+ （1） u ml r m M ml -?=+-?2sin )(cos θθθθ& （2） 因为摆杆一般在工作在竖直向上的小领域内θ=0，可以在小范围近似处理： 0,0sin ,1cos 2==≈θθθ&，则数学模型可以整理成： θθmgl l r m ml I =-+&&&&)(2 （3） u r m M ml =++-&&&&)(θ （4） 系统的状态空间模型为

??????????????θθ&&&&&&r r =????????????????+++++0)() (0010000)(0000102222Mml m M I m M mgl Mml m M I gl m ??????????????θθ&&r r +???????? ??????????+++++222)(0)(0Mml m M I ml Mml m M I ml I u （5） u r r r y ??????+?????? ??????????????=??????=0000101000θθθ&& （6） 代人实际系统的参数后状态方程为： ????????????? ?θθ&&&&&&r r =????????????08285.2700100006293.0000010??????????????θθ&&r r +u ????????????3566.208832.00 （7） u r r r y ??????+????????????? ???????=??????=0000101000θθθ&& （8） 1.2滑模变结构在一级倒立摆系统的应用 主要包括切换函数的设计、控制率的设计和系统消除抖振的抑制。基于线性二次型最优化理论的切换函数设计，定义系统的优化积分指标是： Qxdt x J T ?∞ =0 Q>0， 本文采用指数趋近律：)sgn(S kS S ε--=&，其中k 和ε为正数。将其代人S=Cx=0中，可以得到： )sgn(S kS CBu CAx x C S ε--=+==&& （9） 控制率为：))sgn(()(1S kS CAx CB u ε++-=- （10） ε的选取主要是为了抑制系统的摩擦力和近似线性化所带来的误差和参数摄动等因素，从而使得系统具有良好的鲁棒性。文中k=25, ε=0.8。取变换矩阵T 。

20112515直线一级倒立摆机理建模

上海电力学院课程设计报告 课名：自动控制原理应用实践 题目：倒立摆控制装置 院系：自动化工程学院 专业：测控技术与仪器 班级：2011151班 姓名：马玉林 学号：20112515 时间：2014年1月14日

倒立摆系统按摆杆数量的不同，可分为一级，二级，三级倒立摆等，多级摆的摆杆之间属于自有连接（即无电动机或其他驱动设备）。对倒立摆系统的研究能有效的反映控制中的许多典型问题：如非线性问题、鲁棒性问题、镇定问题、随动问题以及跟踪问题等。通过对倒立摆的控制，用来检验新的控制方法是否有较强的处理非线性和不稳定性问题的能力。 倒立摆的控制问题就是使摆杆尽快地达到一个平衡位置，并且使之没有大的振荡和过大的角度和速度。当摆杆到达期望的位置后，系统能克服随机扰动而保持稳定的位置。 1.1 倒立摆的控制方法 倒立摆系统的输入来自传感器的小车与摆杆的实际位置信号，与期望值进行比较后，通过控制算法得到控制量，再经数模转换驱动直流电机实现倒立摆的实时控制。直流电机通过皮带带动小车在固定的轨道上运动，摆杆的一端安装在小车上，能以此点为轴心使摆杆能在垂直的平面上自由地摆动。作用力u平行于铁轨的方向作用于小车，使杆绕小车上的轴在竖直平面内旋转，小车沿着水平铁轨运动。当没有作用力时，摆杆处于垂直的稳定的平衡位置（竖直向下）。为了使杆子摆动或者达到竖直向上的稳定，需要给小车一个控制力，使其在轨道上被往前或朝后拉动。 本次设计中我们采用其中的牛顿－欧拉方法建立直线型一级倒立摆系统的数学模型，然后通过开环响应分析对该模型进行分析，并利用学习的古典控制理论和Matlab /Simulink仿真软件对系统进行控制器的设计，主要采用根轨迹法，频域法以及PID（比例-积分-微分）控制器进行模拟控制矫正。 2 直线倒立摆数学模型的建立 直线一级倒立摆由直线运动模块和一级摆体组件组成，是最常见的倒立摆之一，直线倒立摆是在直线运动模块上装有摆体组件，直线运动模块有一个自由度，小车可以沿导轨水平运动，在小车上装载不同的摆体组件。 系统建模可以分为两种：机理建模和实验建模。实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号，激励研究对象并通过传感器检测其可观测的输出，应用数学手段建立起系统的输入－输出关系。这里面包括输入

哈工大一阶倒立摆

哈尔滨工业大学 控制科学与工程系 控制系统设计课程设计报告

姓名：院（系）： 专业：自动化班号： 任务起至日期： 2014 年9 月9 日至 2014 年9 月20 日 课程设计题目：直线一级倒立摆控制器设计 已知技术参数和设计要求： 本课程设计的被控对象采用固高公司的直线一级倒立摆系统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仿真及实物调试。

哈尔滨工业大学 (1) 控制系统设计课程设计报告 (1) 一．实验设备简介 (3) 二．直线一阶倒立摆数学模型的推导 (6) 2.1概述 (6) 2.2数学模型的建立 (7) 2.3一阶倒立摆的状态空间模型： (9) 2.4实际参数代入： (10) 三．定量、定性分析系统的性能 (11) 3.1 对系统的稳定性进行分析 (11) 3.2 对系统的稳定性进行分析： (12) 四. 实际系统的传递函数与状态方程 (13) 五. 系统阶跃响应分析 (14) 六．一阶倒立摆PID控制器设计 (15) 6.1 PID控制分析 (15) 6.2 PID控制参数设定及MATLAB仿真 (17) 6.3 PID控制实验 (18) 七．状态空间极点配置控制器设计 (19) 7.1 状态空间分析 (20) 7.2 极点配置及MA TLAB仿真 (21) 7.3 利用爱克曼公式计算 (21) 八．课程设计心得与体会 (22) 一．实验设备简介 倒立摆控制系统：Inverted Pendulum System （IPS） 倒立摆控制系统是一个复杂的、不稳定的、非线性系统，是进行控制理论教学及开展各种控制实验的理想实验平台。对倒立摆系统的研究能有效的反映控制中的许多典型问题：如非线性问题、鲁棒性问题、镇定问题、随动问题以及跟踪问题等。通过对倒立摆的控制，用来检验新的控制方法是否有较强的处理非线性和不稳定性问题的能力。同时，其控制方法在军工、航天、机器人和一般工业过程领域中都有着广泛的用途，如机器人行走过程中的平衡控制、火箭发射中的垂直度控制和卫星飞行中的姿态控制等。 倒立摆是进行控制理论研究的典型实验平台。倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合，其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统，可以作为一个典型的控制对象对其进行研究。最初研究开始于二十世纪50 年代，麻省理工学院（MIT）的控制论专家根据火箭发射助推器原理设计出一级倒立摆实验设备。近年来，新的控制方法不断出现，人们试图通过倒立摆这样一个典型的控制对象，检验新的控制方法是否有较强的处理多变量、非线性和绝对不稳定系统的能力，从而从中找出最优秀的控制方法。

单级倒立摆经典控制系统

单级倒立摆经典控制系统 摘要：倒立摆控制系统虽然作为热门研究课题之一，但见于资料上的大多采用现代控制方法，本课题的目的就是要用经典的方法对单级倒立摆设计控制器进行探索。本文以经典控制理论为基础，建立小车倒立摆系统的数学模型，使用PID控制法设计出确定参数(摆长和摆杆质量)下的控制器使系统稳定，并利用MATLAB软件进行仿真。 关键词：单级倒立摆；经典控制；数学模型；PID控制器；MATLAB 1绪论 自动控制理论是研究自动控制共同规律的技术科学。它的发展初期，是以反馈理论为基础的自动调节原理，并主要用于工业控制。 控制理论在几十年中，迅速经历了从经典理论到现代理论再到智能控制理论的阶段，并有众多的分支和研究发展方向。 1.1经典控制理论 控制理论的发展，起于“经典控制理论”。早期最有代表性的自动控制系统是18世纪的蒸汽机调速器。20世纪前，主要集中在温度、压力、液位、转速等控制。20世纪起，应用范围扩大到电压、电流的反馈控制，频率调节，锅炉控制，电机转速控制等。二战期间，为设计和制造飞机及船用自动驾驶仪、火炮定位系统、雷达跟踪系统及其他基于反馈原理的军用装备，促进了自动控制理论的发展。

至二战结束时，经典控制理论形成以传递函数为基础的理论体系，主要研究单输入-单输出、线性定常系统的分析问题。经典控制理论的研究对象是线性单输入单输出系统，用常系数微分方程来描述。它包含利用各种曲线图的频率响应法和利用拉普拉斯变换求解微分方程的时域分析法。这些方法现在仍是人们学习控制理论的入门之道。 1.2倒立摆 1.2.1倒立摆的概念 图1 一级倒立摆装置 倒立摆是处于倒置不稳定状态，人为控制使其处于动态平衡的一种摆。如杂技演员顶杆的物理机制可简化为一级倒立摆系统，是一个复杂、多变量、存在严重非线性、非自治不稳定系统。

一级倒立摆物理建模、传递函数和状态方程的推导

一级倒立摆物理建模和传递函数的推导 设定： M 小车质量 m 摆杆质量 b 小车摩擦系数 l 摆杆转动轴心到杆质心的长度 I 摆杆惯量 F 加在小车上的力 x 车位置 φ 摆杆与垂直向上方向的夹角

图1、2是系统中小车和摆杆的受力分析图。其中，N 和P 为小车与摆杆相互作用。 分析小车水平方向所受的合力，可以得到以下方程： N x b F x M --=? ?? (1) 由摆杆水平方向的受力进行分析可以得到下面等式： )sin (22 θl x dt d m N += (2) 即： θθθθsin cos 2 ?? ???-+=ml ml x m N (3) 把这个等式代入式(3)中，就得到系统的第一个运动方程： F ml ml x b x m M =-+++?? ????θθθθsin cos )(2 (4) 对摆杆垂直方向上的合力进行分析，可以得到下面方程: )cos (2 2 θl dt d m mg P =- (5) θθθθcos sin 2 ?? ?--=-ml ml mg P (6) 力矩平衡方程： ? ?=--θθθI Nl Pl cos sin (7)

此方程中力矩的方向，由于φπθ+=,θφcos cos -=,θφsin sin -=,故等式前面有负号。 合并这两个方程，约去 P 和N ，得到第二个运动方程： θ θθcos sin )(2 ? ???-=++x ml mgl ml I (8) 设θ =π +φ, 假设φ 与1（单位是弧度）相比很小，即c <<1，则可以进行近似处理：1cos -=θ,φθ-=sin ,0)(2 =dt d θ。用u 来代表被控对象的输入力F ，线性化后两个运动方程如下： { u ml x b x m M x ml mgl ml I =-++=-+? ?? ? ?? ???φφφ)()(2 (9) 假设初始条件为0，对式(9)进行拉普拉斯变换： { ) ()()()()()()()()(22222s U s s ml s s bX s s X l M s s mlX s mgl s s ml I =Φ-++=Φ-Φ+ (10) 由于输出为角度φ ，求解方程组的第一个方程，可以得到： )(])([)(22s s g ml ml I s X Φ-+= (11) 或 mgl s ml I mls s X s -+=Φ2 22)()()( (12) 令? ?=x v ，则有： mgl s ml I ml s V s -+=Φ22)()()( (13) 把上式代入方程组的第二个方程，得到：

一级倒立摆控制系统设计

基于双闭环PID控制的一阶倒立摆控制系统设计 一、设计目的 倒立摆是一个非线性、不稳定系统,经常作为研究比较不同控制方法的典型例子。设计一个倒立摆的控制系统，使倒立摆这样一个不稳定的被控对象通过引入适当的控制策略使之成为一个能够满足各种性能指标的稳定系统。 二、设计要求 倒立摆的设计要求是使摆杆尽快地达到一个平衡位置，并且使之没有大的振荡和过大的角度和速度。当摆杆到达期望的位置后，系统能克服随机扰动而保持稳定的位置。实验参数自己选定，但要合理符合实际情况，控制方式为双PID控制，并利用MATLAB进行仿真，并用simulink对相应的模块进行仿真。 三、设计原理 倒立摆控制系统的工作原理是：由轴角编码器测得小车的位置和摆杆相对垂直方向的角度，作为系统的两个输出量被反馈至控制计算机。计算机根据一定的控制算法，计算出空置量，并转化为相应的电压信号提供给驱动电路，以驱动直流力矩电机的运动，从而通过牵引机构带动小车的移动来控制摆杆和保持平衡。 四、设计步骤 首先画出一阶倒立摆控制系统的原理方框图 一阶倒立摆控制系统示意图如图所示： 分析工作原理，可以得出一阶倒立摆系统原理方框图：

一阶倒立摆控制系统动态结构图 下面的工作是根据结构框图，分析和解决各个环节的传递函数！ 1.一阶倒立摆建模 在忽略了空气流动阻力，以及各种摩擦之后，可将倒立摆系统抽象成小车和匀质杆组成的系统，如下图所示，其中： M ：小车质量 m ：为摆杆质量 J ：为摆杆惯量 F ：加在小车上的力 x ：小车位置 θ：摆杆与垂直向上方向的夹角 l ：摆杆转动轴心到杆质心的长度 根据牛顿运动定律以及刚体运动规律，可知： （1） 摆杆绕其重心的转动方程为 （2） 摆杆重心的运动方程为 得 sin cos ..........(1)y x J F l F l θθθ=- 2 22 2(sin ) (2) (cos ) (3) x y d F m x l d t d F mg m l d t θθ=+=-

小车倒立摆系统开题报告

开题报告填表说明 1.开题报告是毕业设计（论文）过程规范管理的重要环节，是培养学生严谨务实工作作风的重要手段，是学生进行毕业设计（论文）的工作方案，是学生进行毕业设计（论文）工作的依据。 2.学生选定毕业设计（论文）题目后，与指导教师进行充分讨论协商，对题意进行较为深入的了解，基本确定工作过程思路，并根据课题要求查阅、收集文献资料，进行毕业实习（社会调查、现场考察、实验室试验等），在此基础上进行开题报告。 3.课题的目的意义，应说明对某一学科发展的意义以及某些理论研究所带来的经济、社会效益等。 4.文献综述是开题报告的重要组成部分，是在广泛查阅国内外有关文献资料后，对与本人所承担课题研究有关方面已取得的成就及尚存的问题进行简要综述，并提出自己对一些问题的看法。 5.研究的内容，要具体写出在哪些方面开展研究，要突出重点，实事求是，所规定的内容经过努力在规定的时间内可以完成。 6.在开始工作前，学生应在指导教师帮助下确定并熟悉研究方法。 7.在研究过程中如要做社会调查、实验或在计算机上进行工作，应详细说明使用的仪器设备、耗材及使用的时间及数量。 8.课题分阶段进度计划，应按研究内容分阶段落实具体时间、地点、工作内容和阶段成果等，以便于有计划地开展工作。 9.开题报告应在指导教师指导下进行填写，指导教师不能包办代替。 10.开题报告要按学生所在系规定的方式进行报告，经系主任批准后方可进行下一步的研究（或设计）工作。 一、课题的目的意义： 倒立摆系统作为一个实验装置，形象直观，结构简单，构件组成参数和形状易于改变，成本低廉；作为一个被控对象，它又相当复杂，就其本身而言，是一个高阶次、不稳定、多变量、非线性、强耦合系统，只有采取行之有效的控制方法方能使之稳定。 理论是工程的先导，倒立摆的研究具有重要的工程背景。机器人行走类似倒立摆系统，尽管第一台机器人在美国问世以来已有几十年的历史，但机器人的关键技术至今仍未很好解决。由于倒立摆系统的稳定与空间飞行器控制和各类伺服云台的稳定有很大相似性，也是日常生活中所见到的任何重心在上、支点在下的控制问题的抽象。因此，倒立摆机理的研究又具有重要的应用价值，成为控制理论中经久不衰的研究课题。 文献综述（分析国内外研究现状、提出问题，找到研究课题的切入点，附主要参考文献，约2000字）： 倒立摆系统的最初分析开始于二十世纪五十年代，是一个比较复杂的不稳定，多变量，带有强耦合特性的高阶机械系统。倒立摆系统存在严重的不确定性，一方面是系统的参数的不确定性，一方面是系统受到不确定因素的干扰。其控制方法和思路在处理一般工业过程中有很广泛的用途，此外，其相关的研究成果也在航天科技和机器人学习方面得到了大量的应用，如机器人行走过程中平衡控制，火箭发射中的垂直度控制和卫星飞行中的姿态控制等，因此，倒立摆系统是进行控制理论研究的理想平台。 倒立摆是机器人技术﹑控制理论﹑计算机控制等多个领域﹑多种技术的有机结合，其被控

一级倒立摆分析.

一级倒立摆的极点配置及仿真 摘要 倒立摆系统是一个复杂的、高度非线性的、不稳定的高阶系统，是学习和研究现代控制理论最合适的实验装置。倒立摆的控制是控制理论应用的一个典型范例，一个稳定的倒立摆系统对于证实状态空间理论的实用性是非常有用的。 本文主要研究的是一级倒立摆，首先应用动力学方程建立一级倒立摆的非线性数学模型，采用小偏差线性化的方法在平衡点附近局部线性化得到线性化的数学模型。然后通过输入单位阶跃信号分析系统的开环稳定性，由线性化得到的状态方程判断系统的能控性和能观性，结合系统的稳定性条件、调整时间以及超调量找到合适的极点，运用极点的配置方法（Matlab的acker函数）算出状态反馈增益矩阵K，运用状态空间分析方法，采用状态反馈为倒立摆系统建立稳定的控制律，并判断加入反馈矩阵K后的能观性和能控性是否改变。最后应用Matlab中的Simulink建立相应框图，得到输出变量水平位置和角度随时间的变化曲线，验证加入反馈矩阵K后一级倒立摆系统的稳定性。 关键词：一级倒立摆状态反馈极点配置Matlab Simulink

目录 1、一级倒立摆系统简介 (3) 2、一级倒立摆系统的数学模型 (4) 2.1、数学模型的建立 (4) 2.2、运动分析 (5) 2.2.1、沿水平方向运动（直线运动） (5) 2.2.2、绕轴线的转动（旋转运动） (7) 3、状态空间极点配置 (9) 3.1、系统开环稳定性分析 (9) 3.2、开环系统的能控性分析 (11) 3.3、开环系统的能观性分析 (12) 3.4、系统极点配置 (13) 3.5、闭环系统的能控性和能观性分析 (16) 4、一级倒立摆系统Matlab仿真 (17) 4.1、系统开环Simulink搭建及仿真 (17) 4.2、系统极点配置后的Simulink仿真 (20) 5、总结 (24) 6、参考文献 (25)

一级倒立摆MATLAB仿真、能控能观性分析、数学模型、极点配置

题目一： 考虑如图所示的倒立摆系统。图中，倒立摆安装在一个小车上。这里仅考虑倒立摆在图面内运动的二维问题。倒立摆系统的参数包括：摆杆的质量（摆杆的质量在摆杆中心）、摆杆的长度、小车的质量、摆杆惯量等。 图倒立摆系统 设计一个控制系统，使得当给定任意初始条件(由干扰引起)时，最大超调量 %≤10%，调节时间ts ≤4s ，使摆返回至垂直位置，并使小车返回至参考位置(x=0)。 要求：1、建立倒立摆系统的数学模型 2、分析系统的性能指标——能控性、能观性、稳定性 3、设计状态反馈阵，使闭环极点能够达到期望的极点，这里所说的期望的极点确定 是把系统设计成具有两个主导极点，两个非主导极点，这样就可以用二阶系统的 分析方法进行参数的确定 4、用MATLAB 进行程序设计，得到设计后系统的脉冲响应、阶跃响应，绘出相应状 态变量的时间响应图。 解： 1 建立一级倒立摆系统的数学模型 1.1 系统的物理模型 如图1所示，在惯性参考系下，设小车的质量为M ，摆杆的质量为m ，摆杆长度为l，在某一瞬间时刻摆角(即摆杆与竖直线的夹角)为θ，作用在小车上的水平控制力为u。这样，整个倒立摆系统就受到重力,水平控制力和摩擦力的3外力的共同作用。

图1 一级倒立摆物理模型 1.2 建立系统状态空间表达式 为简单起见，本文首先假设:(1)摆杆为刚体 ；(2)忽略摆杆与支点之间的摩擦；( 3) 忽略小车与导轨之间的摩擦。 在如图一所示的坐标下，小车的水平位置是y,摆杆的偏离位置的角度是θ，摆球的水平位置为y+lsin θ。这样，作为整个倒立摆系统来说，在说平方方向上，根据牛顿第二定律，得到 u l y dt d m dt d M =++)sin (y 22 22θ （1） 对于摆球来说，在垂直于摆杆方向，由牛顿第二运动定律，得到 θθsin )sin y (m 22 mg l dt d =+ （2） 方程(1)，(2)是非线性方程，由于控制的目的是保持倒立摆直立，在施加合适的外力条件下，假定θ很小，接近于零是合理的。则sin θ≈θ，cos θ≈1。在以上假设条件下，对方程线性化处理后，得倒 u ml M =++.. ..y m θ）（ （3）