CN103235328A - 一种gnss与mems组合导航的方法 - Google Patents
一种gnss与mems组合导航的方法 Download PDFInfo
- Publication number
- CN103235328A CN103235328A CN201310138456XA CN201310138456A CN103235328A CN 103235328 A CN103235328 A CN 103235328A CN 201310138456X A CN201310138456X A CN 201310138456XA CN 201310138456 A CN201310138456 A CN 201310138456A CN 103235328 A CN103235328 A CN 103235328A
- Authority
- CN
- China
- Prior art keywords
- gnss
- ins
- carrier
- error
- gyroscope
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 34
- 230000001133 acceleration Effects 0.000 claims abstract description 36
- 238000004364 calculation method Methods 0.000 claims abstract description 22
- 239000011159 matrix material Substances 0.000 claims description 27
- 238000005516 engineering process Methods 0.000 claims description 13
- 238000001914 filtration Methods 0.000 claims description 9
- 238000005259 measurement Methods 0.000 claims description 9
- 230000005484 gravity Effects 0.000 claims description 6
- 230000007704 transition Effects 0.000 claims description 6
- 238000005070 sampling Methods 0.000 claims description 5
- 230000005856 abnormality Effects 0.000 claims description 2
- 238000006243 chemical reaction Methods 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 5
- 238000001514 detection method Methods 0.000 description 4
- 230000010354 integration Effects 0.000 description 3
- 238000009825 accumulation Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000004377 microelectronic Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Landscapes
- Navigation (AREA)
- Gyroscopes (AREA)
Abstract
本发明公开了一种GNSS与MEMS组合导航的方法,该方法包括:根据全球卫星导航系统GNSS接收机测量到的载体速度vGNSS与微机械技术MEMS传感器测量到的载体加速度与角速度,获得载体的姿态角观测量;将所述载体的姿态角观测量与GNSS接收机测量到的载体的速度vGNSS与位置rGNSS作为INS卡尔曼滤波器的直接观测量,构成全维状态观测量;所述INS卡尔曼滤波器基于全维状态观测量估算INS计算单元计算到的载体姿态角、速度与位置的误差,并反馈至所述INS计算单元进行导航修正。通过采用本发明公开的导航方法提高了导航的精度。
Description
技术领域
本发明涉及导航技术领域,尤其涉及一种GNSS与MEMS组合导航的方法。
背景技术
美国的全球卫星导航系统(GPS)的成功,极大推动了卫星导航技术向各个行业快速的扩张。全球卫星导航系统(GNSS)除美国的GPS和俄罗斯的GLONASS外,欧盟和中国也正在大力发展各自的卫星导航系统(Galileo和北斗),随着我国今年第16颗北斗卫星成功发射,北斗区域导航能力正式建成。
由于技术自身的限制,通过无线电传输的卫星导航信号会被建筑和树木遮挡导致定位精度下降或系统失效,不能确保定位导航服务的连续性。要克服卫星导航的这一先天缺陷,与其它传感器组合是必然选择。惯性导航技术(INS)具有短期的高精度,可以弥补卫星导航失效时留下的空白,两者组合可为用户提供更全面、更可靠的导航定位解决方案。但是,采用高精度的INS系统,使组合系统成本高、体积大、功耗高,应用领域有限。
近年来,随着微电子微机械技术(MEMS)的长足进步,MEMS惯性传感器也取得突破性进展,芯片级的MEMS惯性传感器已应用在智能手机、机器人和汽车上,但过快的误差积累成为其导航应用的瓶颈。目前各国都在大力研制GPS和MEMS惯性传感器的组合导航系统,市场上也出现了一些GPS结合MEMS惯性传感器的产品,由于对克服MEMS惯性传感器误差积累仍没有好的对策,限制了其向导航应用市场的推广。
现有技术基于GPS/INS组合技术设计的MEMS惯性卫星组合系统中,MEMS惯性卫星组合导航系统通常由MEM加速度计、陀螺仪、和GPS接收机单元组成。其原理框图如图1所示,加速度计和陀螺仪分别敏感载体的加速度和角速度,GPS单元测量载体的速度和位置。利用陀螺仪输出的角速度通过姿态运动方程获得当前时刻的姿态角,利用加速度计输出的加速度通过一次积分得到当前时刻的速度,再进一步积分得到当前位置。INS的位置和速度与GPS输出的位置和速度比较,得到INS的位置和速度误差,它们构成组合卡尔曼滤波器的观测量,INS的误差方程用作卡尔曼滤波器的状态方程,通过卡尔曼滤波,估计出INS的位置、速度和姿态误差,以及加速度计和陀螺仪的误差,这些误差估计被反馈给捷联惯性计算单元,修正INS的导航解,和传感器误差,从而抑制INS误差随时间的增长,获得稳定的导航解。
卡尔曼滤波是上世纪六十年代提出的基于时域的最优状态估计理论,自其提出之后,得到迅速而广泛的应用,也是GPS/INS组合导航技术的核心和基石。给定系统的状态方程和观测方程分别为:xk+1=Φk+1|kxk+Gk+1|kwk;zk=Hkxk+vk;
其中,x是系统的状态向量,Φ是系统的状态转移矩阵,w是系统噪声(零均值,方差为Q),G是系统噪声增益矩阵;z是系统的观测向量,H是系统的观测矩阵,v是测量噪声(零均值,方差为R)。离散形式的卡尔曼滤波由如下五个方程组成:
以上五个方程形成一个完整的递推循环,即给定初始时刻(k=0)的状态和其方差P0|0,通过以上五个方程,可以得到下一时刻(k=1)的状态估计和其方差P1|1,依次类推,得到k=2,3,…,N时刻的状态估计和其方差。
GPS/INS组合卡尔曼滤波器的状态中包含位置、速度和姿态角分量,所以当状态估计通过卡尔曼滤波获得后,也相应地获得位置、速度、和姿态角的估计。
现有技术中基于GPS/INS组合技术设计的MEMS惯性卫星组合系统,其缺点主要体现在:
(1)以GPS的位置和速度为观测量,由于姿态角不是直接观测量,姿态角的可观测性弱,姿态估计精度低。
(2)因为MEMS陀螺仪误差大,不能实现INS静基座对准,而姿态角可观测性差,动态对准需要载体做特定机动,而且航向角对准和收敛时间很长。
(3)双天线GPS与MEMS组合系统可以提供直接的真航向角辅助,但双天线GPS定姿需要具有精确载波相位输出功能的接收机,将带来组合系统硬件复杂度、成本、功耗都将大幅提升;另一方面确定载波相位的整周模糊度,算法的复杂度将大幅提升;GPS定姿受环境影响大,特别是多路径效应,很容易造成定姿失败,从而影响整个组合导航的精度。
发明内容
本发明的目的是提供一种GNSS与MEMS组合导航的方法,提高了导航的精度。
本发明的目的是通过以下技术方案实现的:
一种GNSS与MEMS组合导航的方法,该方法包括:
根据全球卫星导航系统GNSS接收机测量到的载体速度vGNSS与微机械技术MEMS传感器测量到的载体加速度与角速度,获得载体的姿态角观测量;
将所述载体的姿态角观测量与GNSS接收机测量到的载体的速度vGNSS与位置rGNSS作为INS卡尔曼滤波器的直接观测量,构成全维状态观测量;
所述INS卡尔曼滤波器基于全维状态观测量估算INS计算单元计算到的载体姿态角、速度与位置的误差,并反馈至所述INS计算单元进行导航修正。
由上述本发明提供的技术方案可以看出,在不增加硬件的基础上,结合GNSS速度与MEMS的加速度计和陀螺仪数据,获得载体姿态角,并将其与GNSS的位置与速度一起作为INS卡尔曼滤波器的直接观测量,构成全维状态观测量,估计惯性导航系统的误差,提高了姿态的可观测性和估计精度,进而提高了组合导航的精度。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域的普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他附图。
图1为本背景技术提供的基于GPS/INS组合技术设计的MEMS惯性卫星组合系统的示意图;
图2为本发明实施例一提供的一种GNSS与MEMS组合导航的方法的流程图;
图3为本发明实施例二提供的一种GNSS与MEMS组合导航的方法的示意图;
图4为本发明实施例二提供的系统初始化工作流程的示意图;
图5为本发明实施例二提供的陀螺仪单元完成陀螺仪温度误差模型的检测和修正的流程图;
图6为本发明实施例二提供的加速度计完成加速度计温度误差模型的检测和修正的流程图;
图7为本发明实施例二提供的GNSS接收机完成初始位置确定的流程图。
具体实施方式
下面结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明的保护范围。
实施例一
图2为本发明实施例一提供的一种GNSS与MEMS组合导航的方法的流程图。如图2所示,主要包括如下步骤:
步骤21、根据全球卫星导航系统GNSS接收机测量到的载体速度vGNSS与微机械技术MEMS传感器测量到的载体加速度与角速度,获得载体的姿态角观测量。
本步骤所述的GNSS接收机可以是GPS、GLONASS、Galileo和北斗中的任一种或其多个相结合的混合导航系统接收机。
MEMS传感器包括:加速度计与陀螺仪;其中加速度计用于测量载体的加速度,陀螺仪用于测量载体的角速度。
步骤22、将所述载体的姿态角观测量与GNSS接收机测量到的载体的速度vGNSS与位置rGNSS作为INS卡尔曼滤波器的直接观测量,构成全维状态观测量。
MEMS惯性传感器误差大,利用GNSS位置和速度虽然可以通过调节滤波参数获得稳定的导航解,但由于姿态分量可观测性差,估计精度有限。在对姿态精度要求较高的应用中(例如,自动化精确农业应用MEMS惯性卫星组合导航系统提供一定精度的姿态信息,以满足自动控制车辆和耕种的要求),需要提高姿态角度的可观测性;因此,将载体的姿态角管测量与GNSS的位置和速度一起作为INS卡尔曼滤波器的直接观测量,以提高姿态估计精度。
步骤23、所述INS卡尔曼滤波器基于全维状态观测量估算INS计算单元计算到的载体姿态角、速度与位置的误差,并反馈至所述INS计算单元进行导航修正。
基于全维状态观测量估算INS计算单元计算到的载体姿态角、速度与位置的误差,提高了姿态的可观测性和估计精度。在自动化精确农业应用测试结果显示,本发明实施例的技术相比与背景技术的方案可以把姿态估计精度提高2~3倍,完全满足自动化精确农业应用对姿态精度的要求。
本发明实施例通过结合GNSS速度与MEMS的加速度计和陀螺仪数据,获得载体姿态角,并将其与GNSS的位置与速度一起作为INS卡尔曼滤波器的直接观测量,构成全维状态观测量,估计惯性导航系统的误差,提高了姿态的可观测性和估计精度,进而提高了组合导航的精度。
实施例二
为了便于理解本发明,现结合附图3对发明做进一步说明。
如图3所示,为本发明提供的一种GNSS与MEMS组合导航的方法的示意图。如图3所示,本发明实施例包括9个单元,由这9个单元协同工作实现精确导航。
本发明实施例采用的MEMS传感器包括:三轴陀螺仪与加速度计,分别敏感载体的三轴角速度与线加速度。GNSS接收机单元(可以是GPS、GLONASS、Galileo和北斗中的任一种或其多个相结合的混合导航系统接收机。)提供时间、载体的位置与速度。在现场可编程门阵列(FPGA)上实现MEMS数据与GNSS数据的时间同步,两者的融合在FPGA的软核处理器(CPU)上实现。
系统运行可以分为初始化和正常更新两种工作模式,当系统加电开始运行后,可以静止放置一段时间(如,1分钟)等待系统完成初始化。初始化完成后,系统转入正常更新模式。
初始化模式下,系统要完成初始姿态和初始位置确定,以及温度补偿模型的检测和修正。其中,MEMS中的陀螺仪完成温度补偿模型的检测和修正,加速度计完成温度补偿模型的检测和修正与初始姿态角的确定,GNSS接收机完成初始位置确定;工作流程由加速度计、陀螺仪、和GNSS三个单元独立并行完成。
如图4所示,图4中的陀螺仪单元完成陀螺仪温度误差模型的检测和修正,具体的:如图5所示,陀螺仪输出平均值后与陀螺仪温度误差模型的估计值比较,如果它们的差值(σg)超过预设的门限值(μg),则更新陀螺仪温度误差模型。
其中,陀螺仪的温度误差模型可以采用二阶多项式拟合,陀螺仪温度误差模型与陀螺仪输出值的关系式为:所述ε为陀螺仪输出的平均值,Tε为陀螺仪温度,ag、bg与cg为温差误差模型参数;通过三个以上温度段的采样,得到三个以上的上述方程,通过最小二乘法,得到ag、bg与cg的估值,完成对陀螺仪温度误差模型的更新。
图4中的加速度计完成加速度计温度误差模型的检测和修正的工作原理与陀螺仪的类似。具体的:如图6所示,加速度计输出平均值后与加速度计温度误差模型的估计值比较,如果它们的差值(σa)超过预设的门限值(μa),则更新加速度计的温度误差模型。
其中,加速度计的温度误差模型可以采用二阶多项式拟合,加速度计温度误差模型与加速度计输出值的关系式为:所述为加速度计输出的平均值,为加速度计温度,aa、ba与ca为温差误差模型参数;通过三个以上温度段的采样,得到三个以上的上述方程,通过最小二乘法,得到aa、ba与ca的估值,完成对加速度计温度误差模型的更新。
再通过加速度计完成初始姿态角的确定。初始姿态角可利用加速度计输出的平均值计算,其公式为:
其中,fx、fy与fz为加速度计输出的三轴平均值;roll1为滚转角,pitch1是俯仰角;由于MEMS陀螺仪精度低,不能用来确定初始方位,所以初始航向角(yaw1)可以设为零或用上次运行存储的最后时刻的航向角作为当前的初始值。
图4中的GNSS接收机完成初始位置确定。其工作流程如图7所示,GNSS输出位置平均值作为系统的初始位置。
当初始化完成之后,系统转入正常更新模式。此时,由温度补偿单元进行温度补偿。温度补偿可根据初始化步骤确定的温度误差模型来实现:即,根据当前的温度及对应的温度补偿模型估计加速度计与陀螺仪误差并进行补偿,将补偿后的加速度计与陀螺仪的输出值作为所述MEMS传感器测量到的载体加速度与角速度输出至INS计算单元。
所述INS计算单元包括:姿态角更新单元、速度更新单元与位置更新单元。INS计算单元接受到MEMS传感器输出的数据后进行姿态角、速度、和位置更新;
另一方面,MEMS传感器测量到的载体加速度与角速度还用于和GNSS接收机测量到的数据相结合,计算载体的姿态角观测量。
通常情况下,我们将GNSS接收机计算到的载体速度与位置输入至GNSS卡尔曼滤波器中进行速度、加速度与位置的估计,将获得的估计值作为GNSS接收机测量到的载体初始速度、加速度与位置。
具体的:将GNSS接收机计算的载体速度v与位置r作为GNSS卡尔曼滤波器的观测量zGNSS,其中,ZGNSS=[r v]。
所述GNSS卡尔曼滤波器的观测方程可以写为:zGNSS=HGNSSxGNSS+vGNSS;观测方程的含义表示观测量zGNSS中初始速度v与位置r与待估计参数xGNSS间的函数关系。
其中,xGNSS为GNSS卡尔曼滤波器的状态向量,xGNSS=[r v a],a为加速度;HGNSS为观测矩阵: I3×3是3×3的单位矩阵,03×3是3×3的零矩阵;观测噪声vGNSS为零均值,方差为RGNSS的白噪声;
采用常值加速度模型作为GNSS卡尔曼滤波器的状态方程:xGNSS(k+1)=ΦGNSSxGNSS+GGNSSwGNSS;
其中状态转移矩阵为: △t为GNSS信号的采样时间间隔;加速度误差wGNSS为零均值,方差为QGNSS的白噪声;噪声增益矩阵
可以利用卡尔曼滤波方程求解上述GNSS卡尔曼滤波器的观测方程与状态方程,获得状态向量xGNSS=[r v a]中的位置、速度与加速度的估计值rGNSS、vGNSS与aGNSS,并将该估计值作为所述GNSS接收机的测量值。
之后,利用姿态角估计单元完成姿态角的估算,并将该结果作为载体的姿态角观测量,所述姿态角观测量中包括滚转角、俯仰角与航向角。
主要有以下两种方式:
1)利用GNSS接收机测量到的载体速度与MEMS传感器测量到的载体加速度与角速度相结合,计算载体的姿态角观测量,公式为:
其中,roll2为滚转角,pitch2为俯仰角,yaw2为航向角;fby与fbz为加速度计测量到的y轴与z轴加速度;与为陀螺仪测量到的y轴与z轴的角速度;ve与vn为GNSS接收机测量到的水平面速度,vGNSS为GNSS接收机测量到的速度,g为重力加速度。
2)利用GNSS接收机测量到的载体速度和加速度,与MEMS传感器测量到的载体加速度与角速度相结合,计算载体的姿态角观测量,滚轴角与航向角的计算公式与1)中的类似,仅俯仰角的计算方法存在区别:
其中,aGNSS为GNSS卡尔曼滤波器估计的加速度。
再将所述载体的姿态角观测量与GNSS接收机测量到的载体的速度vGNSS与位置rGNSS作为INS卡尔曼滤波器的直接观测量,构成全维状态观测量;并计算INS计算单元的载体速度vins、位置rins与姿态角的误差。
其中,δr=rins-rGNSS为三维位置误差,δv=vins-vGNSS为三维速度误差,ψ为三维姿态角误差;所述三维姿态角误差ψ包括:滚转角误差(δrroll=rins-roll2)、俯仰角误差(δppitch=pins-pitch2)及航向角误差(δyyaw=yins-yaw2);且其转换关系为:
其中,sinp与cosp为俯仰角的正弦和余弦,siny与cosy为航向角的正弦和余弦。
将上述误差δr、δv与ψ作为INS卡尔曼滤波器的观测量zins;其观测方程由全维状态观测方程单元提供,可写为:zins=Hinsxins+vins;
优选的,还可基于INS卡尔曼滤波器的观测方程,估计MEMS中加速度计与陀螺仪的误差;即,xins为INS卡尔曼滤波器的状态向量, 与ε*分别为加速度计与陀螺仪的误差(初值在温度补偿时获得);Hins为观测矩阵: 观测噪声vins是零均值、方差为Rins的白噪声。
对应的状态方程由误差方程单元提供,可写为:
为在计算设备上(例如数字计算机)实现INS卡尔曼滤波器,需要对所述INS卡尔曼滤波器的状态方程离散化。可以使用下述离散化的方法,把上述方程写为矩阵形式:
其中,F为连续时间形式的状态转移矩阵,G是噪声增益矩阵,Wins是零均值方差为Q的系统噪声。其离散化形式如下:
Xins(k)=Φk,k-1Xins(k-1)+Γk,k-1Wins(k-1);
其中,Γ为离散形式的系统噪声增益矩阵,离散形式的状态转移矩阵Φ和系统噪声方差矩阵如下计算:
根据上述计算获得对应的离散形式,再利用卡尔曼滤波方程求解INS卡尔曼滤波器的观测方程与离散形式的状态方程,获得状态向量 的估计值,从而获得INS计算单元的速度、位置与姿态角误差的估计值以及加速度计与陀螺仪误差的估计值;并将获得的误差估计值反馈INS计算单元及MEMS中;同时对对位置、速度、姿态、加速度计与陀螺仪进行导航修正。
本发明实施例在不增加硬件的基础上,结合GNSS速度与MEMS的加速度计和陀螺仪数据,获得载体姿态角,并将其与GNSS的位置与速度一起作为INS卡尔曼滤波器的直接观测量,构成全维状态观测量,估计惯性导航系统的误差,提高了姿态的可观测性和估计精度,进而提高了组合导航的精度。
通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到上述实施例可以通过软件实现,也可以借助软件加必要的通用硬件平台的方式来实现。基于这样的理解,上述实施例的技术方案可以以软件产品的形式体现出来,该软件产品可以存储在一个非易失性存储介质(可以是CD-ROM,U盘,移动硬盘等)中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述的方法。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明披露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应该以权利要求书的保护范围为准。
Claims (8)
1.一种GNSS与MEMS组合导航的方法,其特征在于,该方法包括:
根据全球卫星导航系统GNSS接收机测量到的载体速度vGNSS与微机械技术MEMS传感器测量到的载体加速度与角速度,获得载体的姿态角观测量;
将所述载体的姿态角观测量与GNSS接收机测量到的载体的速度vGNSS与位置rGNSS作为INS卡尔曼滤波器的直接观测量,构成全维状态观测量;
所述INS卡尔曼滤波器基于全维状态观测量估算INS计算单元计算到的载体姿态角、速度与位置的误差,并反馈至所述INS计算单元进行导航修正。
2.根据权利要求1所述的方法,其特征在于,所述获得载体的姿态角观测量之前还包括,对MEMS传感器进行温度补偿并将补偿后的值作为测量值的步骤,且该步骤包括:
确定MEMS传感器中加速度计与陀螺仪的温度补偿模型,所述加速度计与陀螺仪的温度误差模型均采用二阶多项式拟合;
根据当前的温度及对应的温度补偿模型估计加速度计与陀螺仪误差并进行补偿,将补偿后的加速度计与陀螺仪的输出值作为所述MEMS传感器测量到的载体加速度与角速度。
5.根据权利要求1-4任一项所述的方法,其特征在于,所述GNSS接收机测量的载体速度、位置包括:
通过GNSS卡尔曼滤波器对GNSS接收机计算到的载体的速度与位置进行估算,获得速度、位置及加速度的估计值,并估计值作为GNSS接收机的测量值;
具体的:所述GNSS接收机将计算的载体速度r与位置v作为GNSS卡尔曼滤波器的观测量zGNSS,其中,ZGNSS=[r v];
所述GNSS卡尔曼滤波器的观测方程为:zGNSS=HGNSSxGNSS+vGNSS;
其中,xGNSS为GNSS卡尔曼滤波器的状态向量,xGNSS=[r v a],a为加速度;HGNSS为观测矩阵: I3×3是3×3的单位矩阵,03×3是3×3的零矩阵;观测噪声vGNSS为零均值,方差为RGNSS的白噪声;
采用常值加速度模型作为GNSS卡尔曼滤波器的状态方程:xGNSS(k+1)=ΦGNSSxGNSS+GGNSSwGNSS;
其中,状态转移矩阵为: △t为GNSS信号的采样时间间隔;加速度误差wGNSS为零均值,方差为QGNSS的白噪声;噪声增益矩阵
利用卡尔曼滤波方程求解GNSS卡尔曼滤波器的观测方程与状态方程,获得状态向量xGNSS=[r v a]中的位置、速度与加速度的估计值rGNSS、vGNSS与aGNSS,并将该估计值作为所述GNSS接收机的测量值。
7.根据权利要求1所述的方法,其特征在于,所述INS卡尔曼滤波器基于全维状态观测量估算INS计算单元计算到的载体姿态角、速度与位置的误差的步骤包括:
利用全维状态观测量中载体速度vGNSS、位置rGNSS与姿态角计算INS计算单元的载体速度vins、位置rins与姿态角的误差,并将该误差作为INS卡尔曼滤波器的观测量zins,其中,观测向量Zins=[δr δv ψ];包括δr=rins-rGNSS为三维位置误差,δv=vins-vGNSS为三维速度误差,ψ为三维姿态角误差;
所述INS卡尔曼滤波器的观测方程为:zins=Hinsxins+vins;
所述INS卡尔曼滤波器的状态方程为:
对所述INS卡尔曼滤波器的状态方程离散化获得到对应的离散形式,利用卡尔曼滤波方程求解GNSS卡尔曼滤波器的观测方程与离散形式的状态方程,获得状态向量 的估计值,从而获得INS计算单元中的速度、位置与姿态角误差的估计值以及加速度计与陀螺仪误差的估计值;并将获得的误差估计值反馈至INS计算单元及MEMS中,对位置、速度、姿态、加速度计与陀螺仪进行导航修正。
8.根据权利要求7所述的方法,其特征在于,所述三维姿态角误差ψ包括:滚转角误差δrroll、俯仰角误差δppitch及航向角误差δyyaw;且其转换关系为:
其中,sinp与cosp为俯仰角的正弦和余弦,siny与cosy为航向角的正弦和余弦。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310138456.XA CN103235328B (zh) | 2013-04-19 | 2013-04-19 | 一种gnss与mems组合导航的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310138456.XA CN103235328B (zh) | 2013-04-19 | 2013-04-19 | 一种gnss与mems组合导航的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103235328A true CN103235328A (zh) | 2013-08-07 |
CN103235328B CN103235328B (zh) | 2015-06-10 |
Family
ID=48883379
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310138456.XA Active CN103235328B (zh) | 2013-04-19 | 2013-04-19 | 一种gnss与mems组合导航的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103235328B (zh) |
Cited By (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104864867A (zh) * | 2015-05-18 | 2015-08-26 | 南京邮电大学 | 适用gnss的车辆在vsyr盲区定位误差修正方法 |
CN105607106A (zh) * | 2015-12-18 | 2016-05-25 | 重庆邮电大学 | 一种低成本高精度bd/mems融合姿态测量方法 |
CN105806340A (zh) * | 2016-03-17 | 2016-07-27 | 孙红星 | 一种基于窗口平滑的自适应零速更新算法 |
CN105823481A (zh) * | 2015-12-21 | 2016-08-03 | 上海华测导航技术股份有限公司 | 一种基于单天线的gnss-ins车辆定姿方法 |
CN106443746A (zh) * | 2016-07-19 | 2017-02-22 | 招商局重庆交通科研设计院有限公司 | 一种低成本双天线gnss/ahrs组合测姿方法 |
CN106931966A (zh) * | 2017-02-24 | 2017-07-07 | 西北工业大学 | 一种基于泰勒高阶余项拟合的组合导航方法 |
CN107167131A (zh) * | 2017-05-23 | 2017-09-15 | 北京理工大学 | 一种微惯性测量信息的深度融合与实时补偿的方法及系统 |
CN108267765A (zh) * | 2018-03-13 | 2018-07-10 | 北京沙谷科技有限责任公司 | 使用不完整gnss信息的mems组合导航建模方法 |
CN108318033A (zh) * | 2017-12-28 | 2018-07-24 | 和芯星通(上海)科技有限公司 | 行人导航方法和系统、电子设备及存储介质 |
CN108387918A (zh) * | 2018-01-18 | 2018-08-10 | 和芯星通(上海)科技有限公司 | 一种行人导航方法和云系统服务器、存储介质、电子设备 |
CN108802805A (zh) * | 2018-06-07 | 2018-11-13 | 武汉大学 | 六自由度宽频带一体化地震监测系统 |
CN109211230A (zh) * | 2018-09-07 | 2019-01-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态和加速度计常值误差估计方法 |
CN109211231A (zh) * | 2018-09-07 | 2019-01-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态估计方法 |
CN109781096A (zh) * | 2017-11-15 | 2019-05-21 | 洛阳中科晶上智能装备科技有限公司 | 一种用于智能农机的组合导航定位系统和方法 |
CN110426033A (zh) * | 2019-07-30 | 2019-11-08 | 上海理工大学 | 基于松耦合imu阵列导航系统的时间同步算法 |
CN111288990A (zh) * | 2020-03-19 | 2020-06-16 | 云南电网有限责任公司电力科学研究院 | 一种架空检修机器人组合姿态测量方法 |
CN112595314A (zh) * | 2020-12-11 | 2021-04-02 | 北京大学 | 一种可实时测量重力加速度的惯性导航系统 |
CN113167588A (zh) * | 2018-12-04 | 2021-07-23 | 塔莱斯公司 | 包括用于测量计算出的姿态的完整性的设备的混合ahrs系统 |
CN113783652A (zh) * | 2021-09-13 | 2021-12-10 | 广东汇天航空航天科技有限公司 | 一种组合导航系统的数据同步方法和装置 |
CN113793509A (zh) * | 2018-03-12 | 2021-12-14 | 深圳鼎然信息科技有限公司 | 基于运动传感器的路况分析方法、装置、设备及介质 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101109959A (zh) * | 2007-08-06 | 2008-01-23 | 北京航空航天大学 | 一种适用于任意运动微小型系统的定姿系统 |
CN101915588A (zh) * | 2010-07-14 | 2010-12-15 | 北京航空航天大学 | 一种惯性器件的温度误差补偿方法 |
CN102508275A (zh) * | 2011-10-28 | 2012-06-20 | 北京航空航天大学 | 多天线gps/gf-ins深度组合定姿方法 |
-
2013
- 2013-04-19 CN CN201310138456.XA patent/CN103235328B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101109959A (zh) * | 2007-08-06 | 2008-01-23 | 北京航空航天大学 | 一种适用于任意运动微小型系统的定姿系统 |
CN101915588A (zh) * | 2010-07-14 | 2010-12-15 | 北京航空航天大学 | 一种惯性器件的温度误差补偿方法 |
CN102508275A (zh) * | 2011-10-28 | 2012-06-20 | 北京航空航天大学 | 多天线gps/gf-ins深度组合定姿方法 |
Non-Patent Citations (1)
Title |
---|
杨艳娟等: "一种新的INS/GPS组合导航技术", 《中国惯性技术学报》, vol. 12, no. 2, 30 April 2004 (2004-04-30) * |
Cited By (35)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104864867B (zh) * | 2015-05-18 | 2017-07-14 | 南京邮电大学 | 适用gnss的车辆在vsyr盲区定位误差修正方法 |
CN104864867A (zh) * | 2015-05-18 | 2015-08-26 | 南京邮电大学 | 适用gnss的车辆在vsyr盲区定位误差修正方法 |
CN105607106B (zh) * | 2015-12-18 | 2018-08-21 | 重庆邮电大学 | 一种低成本高精度bd/mems融合姿态测量方法 |
CN105607106A (zh) * | 2015-12-18 | 2016-05-25 | 重庆邮电大学 | 一种低成本高精度bd/mems融合姿态测量方法 |
CN105823481A (zh) * | 2015-12-21 | 2016-08-03 | 上海华测导航技术股份有限公司 | 一种基于单天线的gnss-ins车辆定姿方法 |
US10605605B2 (en) | 2015-12-21 | 2020-03-31 | Shanghai Huace Navigation Technology Ltd. | Method of determining GNSS-INS vehicle attitude based on single antenna |
WO2017107434A1 (zh) * | 2015-12-21 | 2017-06-29 | 上海华测导航技术股份有限公司 | 一种基于单天线的gnss-ins车辆定姿方法 |
CN105823481B (zh) * | 2015-12-21 | 2019-02-12 | 上海华测导航技术股份有限公司 | 一种基于单天线的gnss-ins车辆定姿方法 |
CN105806340A (zh) * | 2016-03-17 | 2016-07-27 | 孙红星 | 一种基于窗口平滑的自适应零速更新算法 |
CN105806340B (zh) * | 2016-03-17 | 2018-09-07 | 武汉际上导航科技有限公司 | 一种基于窗口平滑的自适应零速更新算法 |
CN106443746B (zh) * | 2016-07-19 | 2019-05-10 | 招商局重庆交通科研设计院有限公司 | 一种低成本双天线gnss/ahrs组合测姿方法 |
CN106443746A (zh) * | 2016-07-19 | 2017-02-22 | 招商局重庆交通科研设计院有限公司 | 一种低成本双天线gnss/ahrs组合测姿方法 |
CN106931966A (zh) * | 2017-02-24 | 2017-07-07 | 西北工业大学 | 一种基于泰勒高阶余项拟合的组合导航方法 |
CN107167131B (zh) * | 2017-05-23 | 2019-07-02 | 北京理工大学 | 一种微惯性测量信息的深度融合与实时补偿的方法及系统 |
CN107167131A (zh) * | 2017-05-23 | 2017-09-15 | 北京理工大学 | 一种微惯性测量信息的深度融合与实时补偿的方法及系统 |
CN109781096A (zh) * | 2017-11-15 | 2019-05-21 | 洛阳中科晶上智能装备科技有限公司 | 一种用于智能农机的组合导航定位系统和方法 |
CN108318033A (zh) * | 2017-12-28 | 2018-07-24 | 和芯星通(上海)科技有限公司 | 行人导航方法和系统、电子设备及存储介质 |
CN108387918A (zh) * | 2018-01-18 | 2018-08-10 | 和芯星通(上海)科技有限公司 | 一种行人导航方法和云系统服务器、存储介质、电子设备 |
CN113793509B (zh) * | 2018-03-12 | 2024-04-16 | 深圳鼎然信息科技有限公司 | 基于运动传感器的路况分析方法、装置、设备及介质 |
CN113793509A (zh) * | 2018-03-12 | 2021-12-14 | 深圳鼎然信息科技有限公司 | 基于运动传感器的路况分析方法、装置、设备及介质 |
CN108267765A (zh) * | 2018-03-13 | 2018-07-10 | 北京沙谷科技有限责任公司 | 使用不完整gnss信息的mems组合导航建模方法 |
CN108267765B (zh) * | 2018-03-13 | 2021-08-03 | 北京沙谷科技有限责任公司 | 使用不完整gnss信息的mems组合导航建模方法 |
CN108802805A (zh) * | 2018-06-07 | 2018-11-13 | 武汉大学 | 六自由度宽频带一体化地震监测系统 |
CN108802805B (zh) * | 2018-06-07 | 2019-10-11 | 武汉大学 | 六自由度宽频带一体化地震监测系统 |
CN109211231A (zh) * | 2018-09-07 | 2019-01-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态估计方法 |
CN109211231B (zh) * | 2018-09-07 | 2022-02-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态估计方法 |
CN109211230B (zh) * | 2018-09-07 | 2022-02-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态和加速度计常值误差估计方法 |
CN109211230A (zh) * | 2018-09-07 | 2019-01-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态和加速度计常值误差估计方法 |
CN113167588A (zh) * | 2018-12-04 | 2021-07-23 | 塔莱斯公司 | 包括用于测量计算出的姿态的完整性的设备的混合ahrs系统 |
CN110426033A (zh) * | 2019-07-30 | 2019-11-08 | 上海理工大学 | 基于松耦合imu阵列导航系统的时间同步算法 |
CN111288990A (zh) * | 2020-03-19 | 2020-06-16 | 云南电网有限责任公司电力科学研究院 | 一种架空检修机器人组合姿态测量方法 |
CN111288990B (zh) * | 2020-03-19 | 2023-11-10 | 云南电网有限责任公司电力科学研究院 | 一种架空检修机器人组合姿态测量方法 |
CN112595314A (zh) * | 2020-12-11 | 2021-04-02 | 北京大学 | 一种可实时测量重力加速度的惯性导航系统 |
CN113783652A (zh) * | 2021-09-13 | 2021-12-10 | 广东汇天航空航天科技有限公司 | 一种组合导航系统的数据同步方法和装置 |
CN113783652B (zh) * | 2021-09-13 | 2023-06-16 | 广东汇天航空航天科技有限公司 | 一种组合导航系统的数据同步方法和装置 |
Also Published As
Publication number | Publication date |
---|---|
CN103235328B (zh) | 2015-06-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103235328B (zh) | 一种gnss与mems组合导航的方法 | |
CN108226980B (zh) | 基于惯性测量单元的差分gnss与ins自适应紧耦合导航方法 | |
CN105300379B (zh) | 一种基于加速度的卡尔曼滤波姿态估计方法及系统 | |
EP3408688B1 (en) | Gnss and inertial navigation system utilizing relative yaw as an observable for an ins filter | |
CN105371844B (zh) | 一种基于惯性/天文互助的惯性导航系统初始化方法 | |
US9091552B2 (en) | Combined location and attitude determination system and methods | |
CN102486377B (zh) | 一种光纤陀螺捷联惯导系统初始航向的姿态获取方法 | |
CN103900565B (zh) | 一种基于差分gps的惯导系统姿态获取方法 | |
US8560234B2 (en) | System and method of navigation based on state estimation using a stepped filter | |
JP5586994B2 (ja) | 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム | |
CN106767797B (zh) | 一种基于对偶四元数的惯性/gps组合导航方法 | |
CN105091907B (zh) | Sins/dvl组合中dvl方位安装误差估计方法 | |
CN106679657A (zh) | 一种运动载体导航定位方法及装置 | |
CN113203418A (zh) | 基于序贯卡尔曼滤波的gnssins视觉融合定位方法及系统 | |
CN103674064B (zh) | 捷联惯性导航系统的初始标定方法 | |
CN104075713A (zh) | 一种惯性/天文组合导航方法 | |
JP5119967B2 (ja) | 測位方法、プログラム及び測位装置 | |
CN105606093B (zh) | 基于重力实时补偿的惯性导航方法及装置 | |
Abdel-Hafez | On the development of an inertial navigation error-budget system | |
CN113783652A (zh) | 一种组合导航系统的数据同步方法和装置 | |
CN104359496A (zh) | 基于垂线偏差补偿的高精度姿态修正方法 | |
JP5994237B2 (ja) | 測位装置及びプログラム | |
CN106054227B (zh) | 惯导辅助下的伪距差值单星高动态定位方法 | |
CN105549058B (zh) | 原子钟、微惯性测量组合和导航系统的耦合方法及系统 | |
CN104101345A (zh) | 基于互补重构技术的多传感器姿态融合方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right |
Effective date of registration: 20210120 Address after: Room 1-1405, Huayu Meiju, Keji 6th Road, Zhangba Street office, high tech Zone, Xi'an City, Shaanxi Province, 710075 Patentee after: Xi'an naweiyite Electronic Technology Co.,Ltd. Address before: 6-2, no.19-1, qiaobeiyuan, Jiangbei District, Chongqing 400023 Patentee before: Li Yong |
|
TR01 | Transfer of patent right |