倒立摆建模

系统建模

系统建模可以分为两种:机理建模和实验建模.实验建模就是通过在研究对象上加上一系列的研究者先确定的输入信号,激励研究对象并通过传感器的检测其可观测的输出,应用数学手段建立起系统输入---输出关系.这里包括输入信号的设计选取,输出信号的精确检测,数学算法的研究等等内容.机理建模就是在了解研究对象在运动规律基础上,通过物理,化学的知识和数学手段建立起的系统内部的输入输出状态关系.系统的建模原则：

1) 建模之前，要全面了解系统的自然特征和运动机理，明确研究目的和准确性要求，选择合适的分析方法。

2) 按照所选分析法，确定相应的数学模型的形式；

3) 根据允许的误差范围，进行准确性考虑，然后建立尽量简化的合理的数学模型。

小车—倒立摆系统是各种控制理论的研究对象。只要一提小车—倒立摆系统，一般均认为其数学模型也已经定型。事实上，小车—倒立摆的数学模型与驱动系统有关，常见到的模型只是对应于直流电机的情况，如果执行机构是交流伺服电机，就不是这个模型了。本文主要分析由直流电机驱动的小车—倒立摆系统。小车倒立摆系统是检验控制方式好坏的一个典型对象，其特点是高阶次、不稳定、非线性、强耦合，只有采取有效的控制方式才能稳定控制.

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

图中F是施加于小车的水平方向的作用力，x是小车的位移，φ是摆的倾斜角。若不给小车施加控制力，倒摆会向左或向右倾斜，控制的目的是当倒摆出现偏角时，在水平方向上给小车以作用力，通过小车的水平运动，使倒摆保持在垂直的位置。即控制系统的状态参数，以保持摆的倒立稳定。

M 小车的质量 0.5Kg

m 摆杆的质量 0.2Kg

B 小车的摩擦力 0.1N/m/sec

L 摆杆转动轴心到杆之质心的长度 0.3m

I 摆杆惯量 0.006kg×m2

T 采样频率 0.005sec

F 加在小车上的力

X 小车位置

θ摆杆与垂直方向向下的夹角

φ摆杆与垂直方向向上的夹角

倒立摆系统最终的控制目的是使倒立摆这样一个不稳定的被控对象，通过引入适当的控制策略使之成为一个能够满足各种性能指标的稳定系统，单节倒立摆系统的控制模型是目前国内外广泛采用的模型是研究各种控制算法的基础。

该系统由计算机，运动控制卡，伺服机构，倒立摆，本体和光电码盘等几部分组成了一个闭环系统。如图所示：光电码盘1将小车的位移速度信号反馈给伺服驱动器和运动控制卡，摆杆的位置，速度信号由光电码盘2也反馈回运动控制卡。计算机从运动控制卡中读取实时数据，确定控制决策（小车向哪个方向移动，移动速度，加速度等。）并实现该控制决策，产生相应的控制量，使电机带动小车,保持平衡。

1.结构参数

倒立摆是不稳定的，如果没有适当的控制力作用在它的上面，它将随时可能向任何方向倾倒。这里只考虑二维问题，即认为倒立摆只在图3所示平面内运动。控制力F作用于小车上。摆杆长度为l，质量为m，小车的质量为M，小车瞬时位移为x，摆杆瞬时位置为（x+2L*sinφ），在外力的作用下，系统产生运动。假设摆杆的重心位于其几何中心。设输入为作用力F，输出为摆角φ。

2.系统的运动方程

控制要求：在摆受到外力F时，调节小车的位置x，保持摆杆平衡。

图3 小车受力分析图 图4 一级摆受力分析图 应用牛顿力学可推导出该倒立摆系统的运动学方程

⎪⎪⎩⎪⎪⎨⎧=----=--+=-=+θ

I Nlcos θPlsin θcos θθml sin θθml mg P sin θθml cos θθml x m N x b F N x M 2

注意:此方程中力矩的方向,由于ϕπθ+=,ϕθcos cos -=,ϕθsin sin -=,故等式前有负号.

约去P 和N,得到方程:

F ml ml x b x

m M =-+++θθθθsin cos )(2 (1) θθcos sin )(x

ml mgl x m M -=++ (2) 3. 线性化

设ϕπθ+=假设ϕ与1(单位是弧度) 相比很小，即ϕ远远小于1,则可以进行近似处理

0,sin ,1cos 2=⎪⎭

⎫ ⎝⎛-=-=dt d θϕθθ 设u 代表被控对象的输入力F ,方程(1) 和方程（2）经过线性化后

⎩⎨⎧=-++=-+u ml x b x m M x ml mgl ml I ϕϕϕ

)()(2 (3) 其中 23

1ml I = 因此倒立摆的状态方程为:

⎪⎪⎩

⎪⎪⎨⎧+-+-=+-++-=F m M m M mg x F m M l m M l m M g 4443)4(3)4()(3θθθ 4. 单节倒立摆传递函数的推导

对式(3) 进行拉氏变换,得到:

⎩⎨⎧=-++=-+)

()()()()()()()()(222

22s U s s ml s s bX s s X m M s s mlX s mgl s s ml I ϕϕϕ (4) 初始条件为0 时,

由于输出角度为φ,求解方程组的第一个方程,可以得到

)()()(22s s g ml

ml I s X ϕ⎥⎦⎤⎢⎣⎡-+= 把上式代入到(4)中的第二个方程中,得到:

)()()()()()()(22222s U s s ml s s s g ml

ml I b s s s g ml ml I m M =-⎥⎦⎤⎢⎣⎡+++⎥⎦⎤⎢⎣⎡-++ϕϕϕ 整理后得到:

den num q

bmgl s q mgl m M s q ml I b s s q ml s U s =-+-++=)()()()(223ϕ 其中])())([(2

2ml ml I m M q -++= 5. 状态空间方程的推导

系统的状态方程：⎩⎨⎧+=+=Du

CX y Bu AX X

其中: A 为状态矩阵。B 为输入矩阵。 C 为输出矩阵。 D 为前馈矩阵。

方程组(3) 求解得：

⎪⎪⎪⎩

⎪⎪⎪⎨⎧+++++++++-==+++++++++-==u Mml m M I ml Mml m M I m M mgl x Mml m M I mbl u Mml m M I ml I Mml m M I gl m x Mml m M I b ml I x x x 2222

2

22222)()()()()()()()(ϕϕϕϕϕ 整理后,系统状态空间方程为

u Mml m M I ml Mml m M I ml I x x Mml m M I m M mgl Mml m M I mlb Mml m M I gl m Mml m M I b ml I x x ⎥⎥⎥⎥⎥⎥⎦

⎤⎢⎢⎢⎢⎢⎢⎣⎡++++++⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡+⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎣⎡+++++-+++++-=⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡2222222222)(0)(00)()()(010000)()()(00010ϕϕϕϕ