一种基于GPS-磁强计-加速度计的组合导航_定姿方法
第29卷 第1期2011年2月
飞 行 力 学
FLIGHTDYNAMICS
Vo.l29 No.1Feb.2011
一种基于GPS/磁强计/加速度计
的组合导航/定姿方法
刘 凯,郭建国,葛致磊,周 军
(西北工业大学精确制导与控制研究所,陕西西安710072)
摘 要:针对当前常用的导航、定姿方法存在的不足,提出了一种采用单天线GPS、磁强计和加速度计的组合导航、定姿方法。以常见的匀加速模型作为系统方程,以GPS输出的位置和速度作为观测量,设计了卡尔曼滤波器,获得更精确的载体速度、位置和加速度信息。在获得加速度估值之后,根据地磁场和载体比力在载体坐标系和导航坐标系的投影关系构造姿态矩阵,并从姿态矩阵中提取载体姿态。仿真结果表明了该方法能够具备比较高的导航和定姿精度。
关 键 词:组合导航、定姿;磁强计;加速度计;卡尔曼滤波
中图分类号:V249 32 文献标识码:A 文章编号:1002 0853(2011)01 0093 04
引言
在飞行器的位置和姿态测量中,惯性导航是一种常用的方法,但是导航和定姿的精度会随时间逐渐降低。随着GPS应用技术的不断发展,GPS不仅应用在导航方面,也逐渐应用到飞行器的姿态测量中,例如多天线GPS定姿等。多天线GPS定姿方法具有较高的精度,已经成功应用于飞机、航天器和无人机等机动不剧烈的载体中。由于物体的高速运动会导致GPS接收机丢星,所以多天线GPS定姿技术的应用受到一定的限制。随着磁测技术的不断发展以及磁传感器技术的进步,地磁场逐渐应用到导航、定姿等多个领域
[1 2]
地磁场模型计算载体所在位置的地磁场强度B,利用GPS的信息计算载体在地理坐标系下的比力f
bg
g
和载体坐标系与地理坐标系之间的旋转矩阵为Cg,可得到以下关系式:
B=CgBf=Cgf
gb
b
g
g
b
b
g
(1)(2)
[4]
一般情况下B的指向和f的指向是不平行的,对这两个向量进行交叉乘积,得到关系式
B f=Cg(B f)
和M,即
M=CgM
其中:
M=M=
b
gb
b
b
g
g
b
b
b
g
g
:(3)
b
由此得到载体坐标系和地理坐标系的信息矩阵M
,但是磁传感器不能独立确定姿
(4)
3 33 3
g
态,需要与其它姿态传感器配合才能确定姿态角。在一些微小卫星上,GPS与磁强计组合导航定姿已经得到了应用
[3]
BB
bg
ff
bg
B f
g
b
。
B f
针对常用的导航、定姿方法存在的不足,本文提出了一种采用单天线GPS、磁强计和加速度计的组合导航、定姿方法。仿真实验验证了该方法的有效性,同时表明了该方法不但能够解算载体的飞行姿态,而且对于GPS的导航精度也有较大的提高。
式中,M为载体坐标系下的信息矩阵;M为地理坐标系下的信息矩阵。由式(4)即可求出转换矩阵为:
Cg=M(M)
g
b
Tb
b
g
-1
(5)
由姿态矩阵Cb=(Cg),进一步可以提取出载体的三维姿态角。
根据哥氏加速度定理可以确定f与速度变化量v以及重力加速度g之间的关系:
g
g
g
1 导航定姿原理
三轴磁强计捷连安装在载体上,测量得到沿载体坐标系下的地磁场分量B;3个加速度计互相垂直安装在载体上,输出载体的比力信息f;GPS可以实时得到载体的位置、高度和速度信息。根据IGRF
b
b
v=f-( eg+2 ie) v+g
gg
(6)
式中, eg为地理坐标系转动角速度在地理系上的投影; ie为地球自转角速度在地理系上的投影。由式
g
收稿日期:2010 04 22;修订日期:2010 07 26
基金项目:国家自然科学基金(40704008);教育部高等学校博士学科点专项基金(20070699001)

刘凯 ),男,,,
因此微机械陀螺必须与其它姿态传感器 (例如GPS、倾斜计、磁强计等)组合使用才能给出长期的稳定可靠的姿态和指向信息。 本文研究了利用磁强计和微机械陀螺/加速度计...
磁强计和微机械陀螺/加速度计组合定姿的_计算机软件及应用_IT/计算机_专业资料。电子罗盘/加速度计方法研究第2 2卷 第 4期 黑龙江大学自然科学学报 JOURN ...
一种基于GPS-磁强计-加速度... 4页 10财富值 MIMU_GPS_磁强计组合导航序....鉴于GPS是一种高精度半自主的导航方法,本文提出使用GPS和磁强计冗余 的联合算法...
单独的三轴加速度计只能确定出横滚角、 俯仰 角, 与磁强计组合, 则可确定出...( 5 ): 1203-1205. 〔 15〕 刘晓艳. 基于惯性测量单元及 GPS 的运动记录...
Kalman filter ing; magnetometer ; g yr oscope 0 引言在组合导航系统中, 姿态解算是一个重要的研 计了一个利用加速度计和磁强计来补偿误差的扩展 卡尔曼...
一种基于GPS-磁强计-加速度... 4页 10财富值 基于GPS的汽车横摆角速度和....[4-5] ;二是 与其他传感器测量信息进行 组合,以状态滤波方法 定姿 [6-7]...
利用磁强计及微机械加速度计和陀螺的姿态估计扩展...文献 〔1〕 描述 了一 个利用 GPS 和磁 强计来...哈尔 滨工 业 大学 博 士生 ,从事 组合 导航研...
盯面 2信息融合方法图1信息融合结构图 k〕7其中,乩,6A,趴分别为纬 本文研究的微小型组合导航系统由微机械陀 螺和加速度计、GPS接收机、磁强计、谐振式气体压...
磁强计加速度计陀螺姿态估计磁强计加速度计陀螺姿态估计隐藏>> 第1 卷第 23期...组合 。 U姿态估计的扩展卡尔曼滤波器。此滤波器的状态转 M) 移阵利用基于四...
( 1) : 53 - 60. 〔12〕 刘凯,郭建国,葛致磊,等. 一种基于 GPS /磁强计/加速度 计的组合导航/定姿方法 〔J〕 .飞行力学, 2011, 29( 1) : 93 ...
热门文档