直线型倒立摆的力学分析

倒立摆的力学应用

一、综述、

杂技表演中，艺人用手托起一根立起的竹竿时，他会通过手臂的不断移动来保持平衡，使竹竿不倒，人和竹竿组成的这个系统就叫做一级倒立摆系统。假如两根竹竿上下立在一起（自由连接），下面一根杆和作直线运动的小车自由连接，这个就叫做二级倒立摆系统。

倒立摆是常用的进行控制理论教学及开展各种控制实验的理想实验平台，是检验各种控制理论的重要工具。同时，倒立摆在实际应用中也有着广泛的应用。如：机器人的站立于行走问题类似于双倒立摆系统；在火箭飞行器的飞行过程中保持正确姿态；通信卫星保持稳定姿态以使卫星天线一直指向地球，并使太阳能电池板指向太阳；多极火箭发射的垂直度问题也可以简化为一个多级倒立摆模型。

作为控制课的一部分，我们于本学期开始进行在直线型倒立摆上开展控制实验，为了解决状态空间法设计控制算法的基本问题，对倒立摆进行力学建模是必要的。

用于倒立摆系统建模的主要方法有两种:一种是采用牛顿力学的分析方法，分别对小车和倒立摆进行动力学分析，列出其动力学方程，联立采用小角度线性化得到倒立摆系统的近似线性模型。另一种是拉格朗日方法，将倒立摆系统作为一个整体分析，建立系统的动态微分方程，再采用小角度线性化的方法得到倒立摆系统的近似模型。下面将先后用这两种方法分别对一级和二级倒立摆进行建模。

二、力学分析

1、用动力学方程求解一级倒立摆的运动微分方程

直线型电机一级倒立摆由直线运动的摆杆底座和一级摆杆组成。如图1：

其中，为了简化模型，可以认为摆杆和底座为刚体，忽略空气阻力和摆杆与底座轴承的摩擦力。图中，m 为摆杆质量，M 为摆杆底座的质量，L 为摆杆转动轴心到摆杆质心的长度，I 为摆杆惯量,F 为加在小车上的力，x 为小车在x 轴上的的位移，Φ为摆杆与y 轴正方向的夹角。

小车与摆杆的受力分析如图2所示。其中N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量，b 为小车的阻尼系数。θ为摆杆与y 轴负方向的夹角。 对摆杆水平方向进行受力分析可得：

2

2

(sin )

t d N m x l d θ=+ （1）

即：

2cos sin N mx ml ml θθθθ=+- （2）

对底座水平方向进行受力分析可得：

Mx F N bx =-- （3）

将（2）式代入（3）得

2()sin M m x bx ml ml F θθθ+++-= （4）

对摆杆垂直方向上的合力进行分析可得：

2

2(cos )

d P mg m l dt θ-=- （5）

对于摆杆，力矩平衡方程为：

sin cos Pl Nl I θθθ--= （6）

再从几何关系分析：

+θφ=π,cos cos θφ=-，sin sin θφ=-， 故等式前面有号负号。

,

合并（5）（6），有

22()sin cos I ml mgl mlx θθθ++=-因为是小角度变化，故设Φ约等于0

图2

所以，

cos 1θ=-，sin θθ=-，2

0d dt θ⎛⎫

= ⎪⎝⎭

。按照惯例，把控制输入力F 记为u 。线性化后可得

2()()m M x ml bx u I ml mgl mlx φφφ+-+=+-=

接下来，用控制方面的知识进行状态空间计算： 对上式进行拉普拉斯变化（初始条件为0），可得：

2222

2

()()()()()()()()()

I ml s s mgl s mglX s s M m X s s ml s s bX s s U s φφφ+-=+-+=

由于输出角度为Φ，求解第一行可得：22

2()()[]()I ml g

X s s ml s

φ+=- 即2

2()

()()s mls X s I ml s mgl φ=+-

再令a x =，有 22()

()

()s ml

a s I ml s mgl

φ=

+-

将该式代入方程组（10）的第二个方程，可得：

2232

4()

/()()()

lg /s mls q

b I ml s M m mgls U s s bm s q

q q

φ=+++-- 其中22

[()()()]q m M I ml ml =++- 设系统的状态空间方程为：

X AX Bu y CX Du

=+=+

去状态变量：1x x =，2x x =，3x φ=，4x φ=，则状态向量为，[]T X x x φφ=

对方程

2

()()m M x ml bx u I ml mgl mlx

φφφ+-+=+-=求代数方程，可得

222222

2

222

()()()()()()()()()x x

I ml bx m l g I ml u x M m I Mml M m I Mml M m I Mml mlbx mlg M m mlu

M m I Mml M m I Mml M m I Mml φφφφφ=-++=++++++++=-+=

++

++++++

2、用拉格朗日方程来求解二级倒立摆的运动微分方程

为了简化模型，作如下假设：小车在水平导轨上作直线运动;各摆杆及小车均为刚体；由于采用磁悬浮轨道，小车所受摩擦力忽略不计；两摆杆之间的连接处无摩擦且质量不计；两摆杆质量及绕其质心转动的转动惯量相同，长度为2l ；质量为m,转动惯量为J 。

小车质量为M ，水平方向上的位移为x ，计摆杆质心坐标为Gi （xi,yi ），摆杆与竖直方向的夹角为θ，记顺时针为正。小车所受控制力合力为u 。

小车的动能为：201

2T Mx = 摆杆的动能为：22211

()22

i i i i T m x y J θ=+

+

系统的总动能为：

222222201211122211111

()()22222

T T T T Mx m x y J m x y J θθ=++=

++++++ 总势能为：

1122V m gy m gy =+

第1级摆杆的质心坐标为：