没有合适的资源?快使用搜索试试~ 我知道了~
表1 模糊规则表u eceNBNMNSZEPSPMPMNBNBNBNBNBNMNMZENMNBNBNBNBNMNMZENSNMNMNMNMZEZEPSZENMN
资源详情
资源评论
资源推荐
Matlab 大作业
徐可心 201820504011 控制科学与工程
欠驱动系统是控制数量小于自由度的一类非线性系统,因其结构简单、能耗
低、硬件成本低等优点,在航天航空、机器人等领域被广泛应用。具有旋转激励
的平移振荡器(Translational Oscillators with Rotating Actuator,简称 TORA)作为其
中一种典型的欠驱动系统,该模型原本作为双自旋航天器的简化模型用来研究共
振现象,其组成结构包括一个不可直接驱动的平移振荡小车和一个可直接驱动的
旋转小球。本次报告的控制目标是运用模糊控制,实现对 TORA 系统的轨迹跟
踪,考虑了有摩擦和无摩擦的两种情况,并且检测了加入外界干扰时系统的控制
特性。除此之外,本次报告还结合了神经网络,使神经网络仿真的曲线逼近系统
的角度变化曲线。
1,TORA 系统的动态模型
图 1-1 TORA 系统的动态模型
TORA 系统的动力学方程如下所示:
2
) ( cos sin ) 0M m x me kx
q q q q
+ + - + =
&& &
&&
(
cos ( )mex me I T
q q
+ + =
&&
&&
其中,小车的质量为
M
,弹簧的弹性系数为
k
;可驱动小球的质量为
m
,关于
质心的转动惯量为
I
,质心距离旋转轴的距离为
e
;
( )x t
、
( )x t
&
分别代表小车偏
离平衡点的水平位移和速度;以小球逆时针偏离竖直方向为正方向,
( )t
q
、
( )t
q
&
分别代表旋转小球旋转角度、角速度;
( )x t
&&
、
( )t
q
&&
分别表示小车的加速度和可驱
k
M
N
q
m
e
I
动小球的角加速度;
T
表示施加到旋转小球上的输入转矩。
将动力学方程写成矩阵形式:
( ) ( , ) ( )M q q C q q q G q U+ + =
&& & &
其中,
x
q
q
é ù
=
ê ú
ë û
cos
( )
2
cos
M m mr
M q
mr mr I
q
q
+
é ù
=
ê ú
+
ê ú
ë û
0 sin
( , )
0 0
mr
C q q
q q
é ù
-
=
ê ú
ë û
&
&
( )
sin
kx
G q
mgr
q
é ù
=
ê ú
ë û
0
U
t
é ù
=
ê ú
ë û
由动力学模型可知,TORA 系统需要通过唯一的控制输入控制小车的平移位移和
小球的旋转角度。
2,期望轨迹设定
TORA 系统各自由度之间存在非线性耦合,当平移小车的运动状态实现目标
周期性轨迹跟踪时,需要控制旋转小球与平移小车保持相对静止,使得
q
稳定在
定值
d
q
确保
x
运动轨迹周期不变。
设定驱动小球达到的定值
d
q
为:
( )
d
n
q a p
= +
其中,
a
为旋转小球与 x 轴的关系角,
(0,1)
a
Î
,
0, 1, 2,n = ± ± ×××
。
设定
x
的目标周期性轨迹
( )
d
x t
表示为:
0
2
( ) sin( )
d A
x t x x t
T
p
j
= + +
其中,
0
x
、
A
x
、
j
分别为给定动态轨迹的初始位置、振幅、初相角。
3,模糊控制设计
由于 TORA 系统的状态变量多达四个:小车的位移
x
及速度
x
&
,小球的转角
q
和角速度
q
&
。若每个变量划分 7 个模糊集,则模糊规则会达到 2401 条,显然
这么多规则是不宜实现的。为解决以上情况,在控制器前加一个线性融合函数,
将这四个变量融合为综合误差
e
和综合误差变化率
ec
,将状态变量减为两个,模
糊规则也减至 49 条。设计的控制系统结构如下:
设计融合函数的步骤:
1,设定状态反馈矩阵为
x x
K K K K K
q
q
é ù
=
ë û
&
&
;
2,构造融合函数为
0 0
( )
0 0
x
k
x
K K
F X
K K
q
q
é ù
=
ê ú
ë û
&
&
3,得到融合误差
e
和融合误差率
ec
为
( )
d
d
k
d
d
x x
x x
e
F X
ec
q q
q q
-
é ù
ê ú
-
é ù
ê ú
=
ê ú
ê ú
-
ë û
ê ú
-
ë û
& &
&
模糊控制器的输入量为
e
和
ec
,输出量为
u
,模糊论域为
[ 3,3]-
,模糊论域
对应的量化因子分别为
e
K
、
ec
K
,比例因子为
u
K
。模糊输入输出都采用三角形、
全交迭、均匀分布的隶属函数,每个变量用 7 个模糊子集[NB,NM,NS,ZE,
PS,PM,PB]描述,模糊规则如表 1,模糊控制器采用常见的重心法来实现解模
糊化。
表 1 模糊规则表
u
ec
NB
NM
NS
ZE
PS
PM
PM
NB
NB
NB
NB
NB
NM
NM
ZE
NM
NB
NB
NB
NB
NM
NM
ZE
NS
NM
NM
NM
NM
ZE
ZE
PS
ZE
NM
NM
NS
ZE
PS
PM
PM
PS
NS
NS
ZE
PM
PM
PM
PM
e
PM
ZE
ZE
PM
PB
PB
PB
PN
融合函数
Ke
Kec
模 糊 控
制器
Ku
TORA 系
统
,
d d
x
q
,
d d
x
q
&
&
e
ec
u
t
,x
q
,x
q
&
&
剩余11页未读,继续阅读
杜拉拉到杜拉拉
- 粉丝: 19
- 资源: 325
上传资源 快速赚钱
- 我的内容管理 展开
- 我的资源 快来上传第一个资源
- 我的收益 登录查看自己的收益
- 我的积分 登录查看自己的积分
- 我的C币 登录后查看C币余额
- 我的收藏
- 我的下载
- 下载帮助
安全验证
文档复制为VIP权益,开通VIP直接复制
信息提交成功
评论0