全球旧事资料 分类
2dt2

b
dxdt

ml
d2dt2
cos

mlddt
2
si


F
(214)
然后通过对摆杆垂直方向上的合力进行分析,得到系统的第二个运动方程。对摆杆垂直方向上的合力进行分析,得到方程如下:
P

mg

m
d2dt2
l
cos
(215)
P

mg

ml
d2dt2
si


mlddt
2
cos
力矩平衡方程如下:
Pl
si


Nl
cos

I
d2dt2
(216)(217)
此方程中力矩的方向,如图所示则cossi
si
si
,故等
式前面有负号。
合并这两个方程,约去P和N,得到第二个运动方程:
I

ml2
d2dt2

mgl
si


ml
d2xdt2
cos
5
(218)
f倒立摆系统的控制器设计
设(是摆杆与垂直向上方向之间的夹角),假设与1(单位是弧度)
相比很小,即1,则可以进行近似认为cos1si
d20。用u来代dt
表被控对象的输入力F,线性化后两个运动方程如下3:
I

ml2
d2dt2

mgl

mld2x2dt2
M

m
d2xdt2
b
dxdt

ml
d2dt2

u
假设初始条件为0,对式39进行拉普拉斯变换,得到:
Iml2ss2mglsmlXss2
M

mX
ss2

bX
ss

mlss2

Us
(219)(2110)
由于输出为角度φ,求解方程组的第一个方程,可以得到:
X
s


I
mlml
2


gs2

s
(2111)
s
mls2

XsIml2s2mgl
(2112)
令v

x,则有:
sVs

I

mlml2s2

mgl
(2113)
把上式代入方程组的第二个运动方程,得到:
M

m
I
ml2ml

gs

ss2

b
I
ml2ml

gs2

ss

mlss2

U
s
(2114)
mls2
整理后得到传递函数:sUs

s4

bI

ml2
s3

qM

mmgl
s2

bmgl
s
q
q
q
(2115)
其中qMmIml2m2l2。
6
f倒立摆系统的控制器设计
22拉氏变换后实际系统的模型
本系统采用以小车的加速度作为系统的输入,把上述参数代入,可以得到系统的实际模型。
摆杆角度和小车位移的传递函数:
sXs

002725s200102125s2026705
摆杆角度和小车加速度之间的传递函数为:
(221)
sVs

00272500102125s2026705
(222)
摆杆角度和小车所受外界作用力的传递函数:
sUs

s3

235655s00883167s2279169s

230942
(223)
7
f倒立摆系统的控制器设计
3开环响应分析
当输入为小车加速度时,分析摆杆角度与小车位置的脉冲响应和阶跃响应。由式(221)、(212)或者通过受力分析物理公式均可得到小车位移和小车加速度的传递函数:
XsVs

1s2
利用Matlab中的Simuli
k仿真工具进行仿真,仿真系统的结构如图
(31)
摆杆角度的单位脉冲、阶跃响应,小车位置的单位脉冲、阶跃响应如下图
8
f倒立摆系统r
好听全球资料 返回顶部