没有合适的资源?快使用搜索试试~ 我知道了~
资源推荐
资源详情
资源评论
第 38 卷 第 7 期
2012 年 7 月
北 京 工 业 大 学 学 报
JOURNAL OF BEIJING UNIVERSITY OF TECHNOLOGY
Vol.38 No.7
Jul.2012
无 陀 螺 捷 联 惯 导 系 统 中 圆 锥 误 差 的 抑 制
刘 涛
1
, 赵国荣
2
, 李冀鑫
3
, 徐珂文
4
(1.海军航空工程学院 飞行器工程系, 烟台 264001; 2.海军航空工程学院 控制工程系, 烟台 264001;
3.海军飞行学院 教研部, 辽宁 葫芦岛 125001; 4.海军航空工程学院 七系, 烟台 264001)
摘 要: 分析圆锥误差在无陀螺捷联惯导系统中的特性和表现形式,针对系统应用等效旋转矢量方法不能直接提
供角增量的特点,设计和优化了角增量的获取方法,利用混沌粒子群算法优化了四子样等效旋转矢量方法中等效
旋转矢量计算公式系数,并通过典型圆锥误差仿真实验验证了其能更好地消除圆锥误差的影响,提高系统导航精度.
关键词: 无陀螺捷联惯导系统; 圆锥误差; 等效旋转矢量; 混沌粒子群算法
中图分类号: V 241畅62 文献标志码: A 文章编号: 0254 -0037(2012)07 -1045 -07
Method of Restraining Coning Error in GFSINS
LIU Tao
1
, ZHAO Guo-rong
2
, LI Ji-xin
3
,XU Ke-wen
4
(1.Department of Airborne Vehicle Engineering, Naval Aeronautical and Astronautical University, Yantai 264001, China;
2.Department of Control Engineering, Naval Aeronautical and Astronautical University, Yantai 264001, China;
3.Department of Education and Research, Naval Flying Academy, Huludao 125001, Liaoning, China;
4.No.7 Department, Naval Aeronautical and Astronautical University, Yantai 264001, China)
Abstract: The coning error owns new existing form and characteristics in gyroscope-free strap-down
inertial navigation system ( GFSINS ).For GFSINS cannot directly give out angle increment when
adopting four sub samples equivalent rotation vector algorithm, the getting method was designed and
optimized to improve the efficiency of gesture updating.Finally, the coefficients in the calculating formula
of equivalent rotation vector was optimized by chaos particle swarm optimization algorithm.Simulation
result shows that it can effectively eliminate the influence of coning error and improve the navigation
precision.
Key words: gyroscope-free strap-down inertial navigation system; coning error; equivalent rotation
vector; chaos particle swarm optimization algorithm
收稿日期: 2010-06-05.
基金项目: 教育部新世纪优秀人才支持计划资助项目(NCET -04-1001).
作者简介: 刘 涛(1982—), 男, 讲师,主要从事导航技术、兵器发射理论方面的研究,E-mail:haitianlt@163.com.
刚体的圆锥效应使得传统捷联惯导系统中的陀
螺仪产生一定的测量误差,即圆锥误差,在姿态更新
算法中采用等效旋转矢量的方法可以有效抑制圆锥
误差.无陀螺捷联惯导系统虽然舍弃了陀螺,但在
圆锥运动的情况下,圆锥误差仍然存在,且其对系统
导航精度影响不容忽视
[ 1-6 ]
.然而由 于存在的形式
与传统的捷联惯导系统不同,因此如何应用等效旋
转矢量方法成为研究的重点.
1 圆锥误差分析
假设载体没有线运动,角运动仅仅为俯仰轴和
滚转轴做同频不同相的角振动,即
矰(t) =矰
m
sin Ωt
γ( t) =γ
m
cos Ωt
ψ(t) =0
(1)
北 京 工 业 大 学 学 报 2012 年
式中:矰为 俯 仰 角; ψ为 偏 航 角 ; γ为 滚 转 角 ; 矰
m
为俯仰角最 大 值;γ
m
为 滚 转 角 最 大 值;Ω为 振 动
频率.
由公式
ω
b
z
ω
b
x
ω
b
y
=
-ψ
·
sin γcos 矰+矰
·
cos γ
ψ
·
sin 矰+γ
·
ψ
·
cos γcos 矰+矰
·
sin γ
(2)
可以得到载体姿态角为
ω
b
z
ω
b
x
ω
b
y
=
矰
m
Ωcos Ωtcos (γ
m
cos Ωt)
-γ
m
Ωsin Ωt
矰
m
Ωcos Ωtsin(γ
m
cos Ωt)
(3)
因此,偏航轴出现值为 矰
m
Ωcos Ωtsin (γ
m
cos Ωt)
的 角 速 度 误 差.对 于 传 统 捷 联 惯 导 系 统 ,该 数 值
将 被 陀 螺 仪 所 敏 感 , 从 而 产 生 测 量 误 差 , 即 圆 锥
误差
[ 7 ]
.
下面考察其对无陀螺捷联惯导系统导航精度的
影响,即对加速度计输出的影响.
由于振动较微小,因此有 cos γ≈1 和 sin γ≈γ,
带入式(3) 得到
ω
b
z
ω
b
x
ω
b
y
=
矰
m
Ωcos Ωt
-γ
m
Ωsin Ωt
矰
m
γ
m
Ωcos
2
Ωt
(4)
对式(4) 进行求导
ω
·
b
z
ω
·
b
x
ω
·
b
y
=
-矰
m
Ω
2
sin Ωt
-γ
m
Ω
2
cos Ωt
-矰
m
γ
m
Ω
2
sin 2Ωt
(5)
由加速度计比力方程得到加速度计位置的轴向
比力输出公式为
f
b
=[
f
x
f
y
f
z
]
T
=
V
·
x
V
·
y
V
·
z
-
g
x
g
y
g
z
+
0 -ε
z
ε
y
ε
z
0 -ε
x
-ε
y
ε
x
0
V
x
V
y
V
z
+
-(ω
2
y
+ω
2
z
+ε
y
ω
y
+ε
z
ω
z
) ω
y
ω
x
-ω
·
z
+ε
y
ω
x
ω
z
ω
x
+ω
·
y
+ε
z
ω
x
ω
x
ω
y
+ω
·
z
+ε
x
ω
y
-(ω
2
z
+ω
2
x
+ε
z
ω
z
+ε
x
ω
x
) ω
z
ω
y
-ω
·
x
+ε
z
ω
y
ω
x
ω
z
-ω
·
y
+ε
x
ω
z
ω
y
ω
z
+ω
·
x
+ε
y
ω
z
-(ω
2
x
+ω
2
y
+ε
x
ω
x
+ε
y
ω
y
)
l
x
l
y
l
z
(6)
式中:V 和 ω分 别 为 载 体 的 线 速 度 和 角 速 度; ε =
2ω
b
ie
+ω
b
en
;g 为重力加速度;l 为加速度计离载体质
心的距离.
如果不存在圆锥误差,由载体运动状态得到偏
航角速度 ω
y
=0,ω
·
y
=0,因此:
^
f
b
=
V
·
x
V
·
y
V
·
z
-
g
x
g
y
g
z
+
0 -ε
z
ε
y
ε
z
0 -ε
x
-ε
y
ε
x
0
V
x
V
y
V
z
+
-(ω
2
z
+ε
z
ω
z
) -ω
·
z
+ε
y
ω
x
ω
z
ω
x
+ε
z
ω
x
ω
·
z
-(ω
2
z
+ω
2
x
+ε
z
ω
z
+ε
x
ω
x
) -ω
·
x
ω
x
ω
z
+ε
x
ω
z
ω
·
x
+ε
y
ω
z
-(ω
2
x
+ε
x
ω
x
)
l
x
l
y
l
z
(7)
式中
^
f
b
代表理想加速度计轴向输出,设 f
b
为圆锥误
差带来的加速度计轴向输出误差,得到
f
b
=
^
f
b
-f
b
=
ω
2
y
+ε
y
ω
y
-ω
y
ω
x
-ω
·
y
-ω
x
ω
y
-ε
x
ω
y
0 -ω
z
ω
y
-ε
z
ω
y
ω
·
y
ω
y
ω
z
ω
2
y
+ε
y
ω
y
l
x
l
y
l
z
(8)
因此由式(4) 、(5) 得到此时加速度计位置的 3
个轴向比力都含有圆锥误差,从而使加速度计输出
产生测量误差,引入到姿态角速度的解算中,产生解
算误差,影响系统导航精度.
2 等效旋转矢量方法
2畅1 等效旋转矢量
等效旋转矢量法建立在刚体矢量旋转思想基础
上,与四元数不同的是角增量进一步微小化,使得有
限转动尽量接近无限转动.等效旋转矢量法进行姿
态更新的步骤为:
1) 根据速率陀螺输出 的 角 增量信 息估 计 姿态
更新周期内的等效旋转矢量 Φ;
2) 由 Φ计算出姿态更新周期内的等效旋转四
元数 Δq,并由 Δq 对姿态四元数 q 进行更新.
6401
剩余6页未读,继续阅读
资源评论
weixin_38742571
- 粉丝: 13
- 资源: 955
上传资源 快速赚钱
- 我的内容管理 展开
- 我的资源 快来上传第一个资源
- 我的收益 登录查看自己的收益
- 我的积分 登录查看自己的积分
- 我的C币 登录后查看C币余额
- 我的收藏
- 我的下载
- 下载帮助
最新资源
资源上传下载、课程学习等过程中有任何疑问或建议,欢迎提出宝贵意见哦~我们会及时处理!
点击此处反馈
安全验证
文档复制为VIP权益,开通VIP直接复制
信息提交成功