CN103941274B - 一种导航方法及导航终端 - Google Patents
一种导航方法及导航终端 Download PDFInfo
- Publication number
- CN103941274B CN103941274B CN201410150552.0A CN201410150552A CN103941274B CN 103941274 B CN103941274 B CN 103941274B CN 201410150552 A CN201410150552 A CN 201410150552A CN 103941274 B CN103941274 B CN 103941274B
- Authority
- CN
- China
- Prior art keywords
- sin
- cos
- navigation
- omega
- error
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 23
- 238000005259 measurement Methods 0.000 claims abstract description 86
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 43
- 238000001914 filtration Methods 0.000 claims abstract description 35
- 238000012545 processing Methods 0.000 claims abstract description 9
- 239000013598 vector Substances 0.000 claims description 88
- 239000011159 matrix material Substances 0.000 claims description 76
- 238000004364 calculation method Methods 0.000 claims description 41
- 238000007781 pre-processing Methods 0.000 claims description 25
- 238000005070 sampling Methods 0.000 claims description 21
- 238000005295 random walk Methods 0.000 claims description 9
- 238000006243 chemical reaction Methods 0.000 claims description 8
- 230000036544 posture Effects 0.000 claims description 6
- 230000021615 conjugation Effects 0.000 claims description 5
- 230000017105 transposition Effects 0.000 claims description 5
- 230000008901 benefit Effects 0.000 description 6
- 230000008859 change Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 238000009825 accumulation Methods 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000017525 heat dissipation Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000035945 sensitivity Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000026676 system process Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
- G01S19/49—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
Abstract
本发明提供了一种导航方法及导航终端;方法包括:接收北斗卫星导航信号,接收内部射频和基带芯片数据,经位置、速度、时间解算处理后,得到北斗卫星导航预处理数据;获取外部观测信息及原始惯性测量数据;根据所述外部观测信息及所述原始惯性测量数据计算误差数据;所述外部观测信息包括温度、启动时间;对所述原始惯性测量数据采用捷联惯性导航算法进行解算,得到解算结果;根据北斗卫星导航预处理数据、所述误差数据和所述解算结果进行组合导航滤波,输出滤波结果。本发明将卫星导航和惯性导航有机结合,获得优于任何单一导航***的导航精度和可靠性。
Description
技术领域
本发明涉及导航领域,尤其涉及一种导航方法及导航终端。
背景技术
全球卫星导航***(GNSS)可为全球范围提供全天候、连续、精密的三维定位和导航服务,已广泛应用于航空、航天、航海及地面运载工具的导航和定位,其中北斗卫星导航***是中国正在实施的自主发展、独立运行的全球卫星导航***,是独立自主、开放兼容、技术先进、稳定可靠的卫星导航***。北斗卫星导航***的突出优点是其导航定位精度高,并且导航定位精度基本不受时间和地域的限制。但是当卫星信号受到遮挡或干扰时,其优势就不能发挥出来,在需要获得载体连续的位置、速度、姿态等控制信息时,也不能满足其性能要求。因此目前GNSS还只能作为一种辅助导航设备,而不能作为唯一的导航设备使用。
SINS(捷联式惯性导航***)直接利用安装在载体上的惯性测量单元(IMU)测量出载体沿三个轴的加速度和角速率,经过变换和积分等运算得到载体的姿态、速度、位置等信息。微型捷联惯导***(MSINS)在体积、功耗、耐冲击等方面的优点使惯性***的应用领域更加宽广,纯惯导***的优点是不依赖于任何外界信息就能够实现完全自主的导航,抗干扰能力强,隐蔽性、实时性好。但目前SINS的精度比较低,导致惯导***误差随着时间积累而增大,因此,单独使用SINS来实现较高精度的载体制导任务就难以胜任。为此,需要利用其它定位手段作为参考信息源,定期对SINS进行校正和对漂移进行补偿。
发明内容
本发明要解决的技术问题是如何将卫星导航和惯性导航有机结合,获得优于任何单一导航***的导航精度和可靠性。
为了解决上述问题,本发明提供了一种导航方法,包括:
接收北斗卫星导航信号,接收内部射频和基带芯片数据,经位置、速度、时间解算处理后,得到北斗卫星导航预处理数据;
获取外部观测信息及原始惯性测量数据;根据所述外部观测信息及所述原始惯性测量数据计算误差数据;所述外部观测信息包括温度、启动时间;
对所述原始惯性测量数据采用捷联惯性导航算法进行解算,得到解算结果;
根据北斗卫星导航预处理数据、所述误差数据和所述解算结果进行组合导航滤波,输出滤波结果。
可选地,所述原始惯性测量数据包括:陀螺仪原始测量数据、加速度计原始测量数据、磁力计原始测量数据;
根据外部观测信息及所述原始惯性测量数据计算误差数据的步骤包括:
计算各轴的位置误差C1为:
C1=(Z–B)/(1+S)
其中Z为所计算的轴的原始观测数据,B为所计算的轴的标定偏置误差,S为所计算的轴的刻度因子误差;
计算陀螺仪的稳定零偏误差:
W稳定零偏=a0+a1t+a2T+a3T2+a4T3+a5△T;
其中,t为陀螺仪的启动时间,T为陀螺仪的内部温度,△T为温度变化梯度,a0为常数项,a1~a5为系数;
计算姿态误差角C2为:
C2=A1×B1–B2×A2
A1为解算前上一个采样点陀螺仪的原始观测数据,B1为解算前上一个采样点的加速度计的原始观测数据,A2为解算时当前采样点陀螺仪的观测数据,B2为解算时当前采样点的加速度计的观测数据;
计算速度误差C3为:
C3=1/2×(A2×B2+B1×A1+B1×A2)/12.0。
可选地,对所述原始惯性测量数据采用捷联惯性导航算法进行解算,得到解算结果的步骤包括:
计算解算点的地球曲率半径:
其中a为地球长半轴半径,e为地球扁率,lat为捷联导航解算点的纬度;
进行速度解算:
Rd=Vn×0.5×Dt/(Rm+Dr)
V1=Vn+0.5×Dv
进行位置解算:
Wen=Vn×k(Mv+Rn×Dv)
R=R1–Dt×Dv
Rd为载体坐标系上四元数表示的投影分量,Vn为当前坐标系下的速度分量,V1为迭代后的三轴速度分量,Dt是时间历元,Dv为导航系下的速度向量,Dr为地理坐标系下的位置向量,Rm为地球子午线对应的曲率半径;Wen为导航系下的转换速率,Rn为卯酉圈的曲率半径,Mv为差值速度向量,k为转换系数;R1为上一解算时刻的位置矢量,R为解算后的位置矢量;
进行姿态解算:
其中,为转动矢量矩阵,ψ为载体的航向角,θ均为俯仰角,γ为横滚角,φ为等效转动矢量,ω角速度矢量,i为算法的i阶,j为算法的j阶,m为姿态个数,N为算法的阶数,kij为算法系数。
可选地,所述根据北斗卫星导航预处理数据、所述误差数据和所述解算结果进行组合导航滤波的步骤包括:
根据所述误差数据建立卡尔曼滤波器的状态方程;
根据所述卡尔曼滤波状态方程,建立误差协方差矩阵:
根据所述卡尔曼滤波状态方程构建***噪声矩阵;
根据所述北斗卫星导航预处理数据及所述解算结果,以及所述状态方程建立量测方程。
可选地,所述卡尔曼滤波器的状态方程为:
X为状态向量,表示东、北、天方向的姿态误差角,δVe、δVn、δVu和δL、δλ、δh分别表示东、北、天方向的速度误差和纬度、经度、高度的位置误差,εx、εy、εz表示沿载体系xyz轴上的角度随机游走系数,表示沿载体系xyz轴上的陀螺仪零偏;
所述误差协方差矩阵为如下的15×15维的矩阵:
其中,0表示零矩阵,下标表示该零矩阵是几乘几的矩阵;
F11、F12、F13、F14、F21、F22、F23、F24、F32、F33、F43分别为:
其中,L为纬度,h为高度,Vn为导航坐标系下的速度分量;Rn为卯酉面曲率半径,Rm为子午面曲率半径,Ve为地球坐标系下的速度矢量,ωie为地球自转角速率;
其中,α为速度分量方差,β为位置分量方差;
其中,fu、fn、fe为分别为地理坐标系下天向、北向、东向方向上的比力;
所述***噪声矩阵如下:
M为代表速度和位置标准差的6维向量,H表示转置共轭;
所述量测方程如下:
Z1=H1X+γn
其中,量测噪声γn是零均值的白噪声,量测矩阵H1为:
其中,Vn为导航坐标系下的速度矢量,Ve为地球坐标系下的速度矢量,后括号中的数字是指在矩阵中相应行和列上的元素。
本发明还提供了一种导航终端,包括:
北斗卫星导航模块,用于接收北斗卫星导航信号,接收内部射频和基带芯片数据,经位置、速度、时间解算处理后,得到北斗卫星导航预处理数据;
惯性导航模块,用于获取原始惯性测量数据;对所述原始惯性测量数据采用捷联惯性导航算法进行解算,得到解算结果;
外部观测模块,用于获取外部观测信息,根据所述外部观测信息及所述原始惯性测量数据计算误差数据;所述外部观测信息包括温度、启动时间;
组合导航模块,用于根据北斗卫星导航预处理数据、所述误差数据和所述解算结果进行组合导航滤波,输出滤波结果。
可选地,所述原始惯性测量数据包括:陀螺仪原始测量数据、加速度计原始测量数据、磁力计原始测量数据;
所述外部观测模块根据外部观测信息及所述原始惯性测量数据计算误差数据是指:
所述外部观测模块计算各轴的位置误差C1为:
C1=(Z–B)/(1+S)
其中Z为所计算的轴的原始观测数据,B为所计算的轴的标定偏置误差,S为所计算的轴的刻度因子误差;
计算陀螺仪的稳定零偏误差:
W稳定零偏=a0+a1t+a2T+a3T2+a4T3+a5△T;
其中,t为陀螺仪的启动时间,T为陀螺仪的内部温度,△T为温度变化梯度,a0为常数项,a1~a5为系数;
计算姿态误差角C2为:
C2=A1×B1–B2×A2
A1为解算前上一个采样点陀螺仪的原始观测数据,B1为解算前上一个采样点的加速度计的原始观测数据,A2为解算时当前采样点陀螺仪的观测数据,B2为解算时当前采样点的加速度计的观测数据;
计算速度误差C3为:
C3=1/2×(A2×B2+B1×A1+B1×A2)/12.0。
可选地,所述惯性导航模块对原始惯性测量数据采用捷联惯性导航算法进行解算,得到解算结果是指:
所述惯性导航模块计算解算点的地球曲率半径:
其中a为地球长半轴半径,e为地球扁率,lat为捷联导航解算点的纬度;
进行速度解算:
Rd=Vn×0.5×Dt/(Rm+Dr)
V1=Vn+0.5×Dv
进行位置解算:
Wen=Vn×k(Mv+Rn×Dv)
R=R1–Dt×Dv
Rd为载体坐标系上四元数表示的投影分量,Vn为当前坐标系下的速度分量,V1为迭代后的三轴速度分量,Dt是时间历元,Dv为导航系下的速度向量,Dr为地理坐标系下的位置向量,Rm为地球子午线对应的曲率半径;Wen为导航系下的转换速率,Rn为卯酉圈的曲率半径,Mv为差值速度向量,k为转换系数;R1为上一解算时刻的位置矢量,R为解算后的位置矢量;
进行姿态解算:
其中,为转动矢量矩阵,ψ为载体的航向角,θ均为俯仰角,γ为横滚角,φ为等效转动矢量,ω角速度矢量,i为算法的i阶,j为算法的j阶,m为姿态个数,N为算法的阶数,kij为算法系数。
可选地,所述组合导航模块根据北斗卫星导航预处理数据、所述误差数据和所述解算结果进行组合导航滤波是指:
所述组合导航模块根据所述误差数据建立卡尔曼滤波器的状态方程;根据所述卡尔曼滤波状态方程,建立误差协方差矩阵:根据所述卡尔曼滤波状态方程构建***噪声矩阵;根据所述北斗卫星导航预处理数据及所述解算结果,以及所述状态方程建立量测方程。
可选地,所述卡尔曼滤波器的状态方程为:
X为状态向量,表示东、北、天方向的姿态误差角,δVe、δVn、δVu和δL、δλ、δh分别表示东、北、天方向的速度误差和纬度、经度、高度的位置误差,εx、εy、εz表示沿载体系xyz轴上的角度随机游走系数,表示沿载体系xyz轴上的陀螺仪零偏;
所述误差协方差矩阵为如下的15×15维的矩阵:
其中,0表示零矩阵,下标表示该零矩阵是几乘几的矩阵;
F11、F12、F13、F14、F21、F22、F23、F24、F32、F33、F43分别为:
其中,L为纬度,h为高度,Vn为导航坐标系下的速度分量;Rn为卯酉面曲率半径,Rm为子午面曲率半径,Ve为地球坐标系下的速度矢量,ωie为地球自转角速率;
其中,α为速度分量方差,β为位置分量方差;
其中,fu、fn、fe为分别为地理坐标系下天向、北向、东向方向上的比力;
所述***噪声矩阵如下:
M为代表速度和位置标准差的6维向量,H表示转置共轭;
所述量测方程如下:
Z1=H1X+γn
其中,量测噪声γn是零均值的白噪声,量测矩阵H1为:
其中,Vn为导航坐标系下的速度矢量,Ve为地球坐标系下的速度矢量,后括号中的数字是指在矩阵中相应行和列上的元素。
本发明的一个实施例利用卫星导航***不随时间积累的定位能力和SINS短时高精度自主导航能力,将北斗卫星导航***和SINS有机地结合起来,利用两者性能互补的特点,不仅可充分发挥各自的特长,还可以相互弥补存在的不足,具备良好的发展前景和广泛的使用价值。一个优选实施例中,随着结合程度的加深、两者互相辅助,还能带来附加的好处。另一个优选实施例中,通过改进组合导航算法及采用辅助约束信息如零速修正等技术,可以大幅度的提高导航的效果。
附图说明
图1是实施例一的导航方法的流程示意图;
图2是实施例二的导航终端的示意框图。
具体实施方式
下面将结合附图及实施例对本发明的技术方案进行更详细的说明。
需要说明的是,如果不冲突,本发明实施例以及实施例中的各个特征可以相互结合,均在本发明的保护范围之内。另外,虽然在流程图中示出了逻辑顺序,但是在某些情况下,可以以不同于此处的顺序执行所示出或描述的步骤。
实施例一、一种导航方法,如图1所示,包括:
接收北斗卫星导航信号,接收内部射频和基带芯片数据,经PVT(位置、速度、时间)解算处理后,得到北斗卫星导航预处理数据;
获取原始惯性测量数据,对所述原始惯性测量数据采用捷联惯性导航算法进行解算,得到解算结果;
获取外部观测信息,根据所述外部观测信息及所述原始惯性测量数据计算误差数据;所述外部观测信息包括温度、启动时间等;
根据北斗卫星导航预处理数据、所述误差数据和所述解算结果进行组合导航滤波,输出滤波结果。
本实施例还能够同步输出北斗卫星导航、组合导航两种解算结果,两种导航结果通过组合滤波后能够相互辅助,在北斗信号失锁后,能继续提供全姿态的导航数据,最终提高全天候的导航结果的精度和可靠性。
本实施例的一种实施方式中,所述原始惯性测量数据可以但不限于包括:陀螺仪原始测量数据、加速度计原始测量数据、磁力计原始测量数据。
本实施方式中,根据所述外部观测信息及所述原始惯性测量数据计算误差数据的步骤具体可以包括:
分别对陀螺仪和加速度计各轴的原始测量数据进行数据误差补偿,计算各轴的位置误差C1为:
C1=(Z–B)/(1+S) (1)
其中Z为所计算的轴的原始观测数据,B为所计算的轴的标定偏置误差,S为所计算的轴的刻度因子误差;B和S可以根据经验值或仪器厂商提供的参数得到;
计算陀螺仪的稳定零偏误差:
W稳定零偏=a0+a1t+a2T+a3T2+a4T3+a5△T;
其中,t为陀螺仪的启动时间,T为陀螺仪的内部温度,△T为温度变化梯度,a0为常数项,a1~a5为系数;△T、a0、a1~a5可以根据经验或仿真值设定;
本实施方式中,在导航开始后,评估高频IMU原始测量数据的零偏误差、刻度因子误差,角度随机游走系数,并据此补偿高频IMU原始测量数据,可提高原始测量数据输出的精度。MEMS(Micro Electro Mechanical systems,微电子机械***)陀螺仪的零偏误差同时受到多个变量因素影响,温度是其影响因素之一,本实施方式针对MEMS陀螺仪特点,设计了MEMS陀螺的温度区间零偏计算模型,可以据此进行零偏补偿。
本实施方式还可以包括:计算由于圆锥运动导致等效陀螺仪等输出漂移,本实施方式采用圆锥补偿算法来消除圆锥误差的影响,从而提高姿态计算的精度;计算姿态误差角C2为:
C2=A1×B1–B2×A2 (2)
A1为解算前上一个采样点陀螺仪的原始观测数据,B1为解算前上一个采样点的加速度计的原始观测数据,A2为解算时当前采样点陀螺仪的观测数据,B2为解算时当前采样点的加速度计的观测数据。
计算由于Sculling Motion(划船运动)导致等效陀螺仪等输出漂移,对划船效应误差进行补偿,这样能有效提高速度更新中比力的转换精度,减少了速度误差;计算速度误差C3为:
C3=1/2×(A2×B2+B1×A1+B1×A2)/12.0 (3)
A1为解算前上一个采样点陀螺仪的原始观测数据,B1为解算前上一个采样点的加速度计的原始观测数据,A2为解算时当前采样点陀螺仪的观测数据,B2为解算时当前采样点的加速度计的观测数据。
本实施方式中,零偏补偿、数据误差补偿、圆锥误差补偿及划船效应补偿的先后顺序可以不限,也可以按照预定顺序进行。
本实施例的一种实施方式中,所述对观测值采用捷联导航算法进行解算的步骤具体可以包括:
计算解算点的地球曲率半径:
其中a为地球长半轴半径,e为地球扁率,lat为捷联导航解算点的纬度。
进行速度解算,计算旋转矢量的变化值,即经度、纬度、高度的变化量测值,并转化为导航坐标系到载体坐标系上四元数表示的投影分量值。通过对投影分量值的时间历元处理转化为旋转矢量上投影分量,最后利用上一次迭代的速度和当前观测加速度的积分值,求出当前时刻的导航坐标***的速度分量,主要解算公式如下:
Rd=Vn×0.5×Dt/(Rm+Dr) (5)
V1=Vn+0.5×Dv (6)
其中Rd为载体坐标系上四元数表示的投影分量,Vn为当前坐标系下的速度分量,V1为迭代后的三轴速度分量,Dt是时间历元,Dv为导航系下的速度向量,Dr为地理坐标系下的位置向量,Rm为地球子午线对应的曲率半径。
进行位置解算,主要解算公式如下:
Wen=Vn×k(Mv+Rn×Dv) (7)
R=R1–Dt×Dv (8)
其中Wen为导航系下的转换速率,Vn为当前坐标系下的速度分量,Rn为卯酉圈的曲率半径,Mv为差值速度向量,k为转换系数,可以根据经验值或实验值确定;R1为上一解算时刻的位置矢量,R为解算后的位置矢量。
采用等效转动矢量法辅助姿态算法,进行姿态解算,姿态解算公式以及等效转动矢量最终结果公式如下所示:
(9)式中,为转动矢量矩阵,ψ为载体的航向角,θ均为俯仰角,γ为横滚角,(10)式中,φ为等效转动矢量,ω角速度矢量,i为算法的i阶,j为算法的j阶,m为姿态个数,N为算法的阶数,kij为算法系数。
等效转动矢量的迭代计算采用较高的频率,而用了等效转动矢量后的方向余弦矩阵计算则用较低迭代频率,两种方式的结合构成了捷联矩阵的计算。
本实施例的一种实施方式中,所述PVT解算处理的步骤具体可以包括:
Q=PQ+DM+KF+Sn+F+J+Sa+C+RD+Hdop+Cn0 (11)
方程中:Q表示组合算法估计出的定位质量系数,其中PQ表示定位质量,DM表示定位模式,KF表示解算模式质量因子,Sn表示参与解算的卫星数,F表示错误模式,J表示判停模式,C表示载体速度,Sa表示方位角,Hdop表示水平定位精度,Cn0表示灵敏度质量因子,以上参数都可以从标准的PVT解算结果中获取。
北斗卫星导航信号PVT解算的质量对***误差影响很大,本实施方式针对北斗卫星导航的特点设计了PVT解算质量估计模型,通过模型可以有效的提高PVT解算的数据质量,提高组合导航的精度。
经过式(11)所示的PVT解算质量估计模型得到的定位质量系数将作为组合导航滤波时的量测误差量之一。
本实施例的一种实施方式中,所述根据北斗卫星导航预处理数据、所述误差数据和解算结果进行组合导航滤波的步骤具体可以包括:
根据所述误差数据建立卡尔曼滤波器的状态方程,具体地,选取式(1)、(4)、(2)计算的位置误差、速度误差、姿态误差角、以及陀螺仪角度随机游走系数和零偏作为状态量。
式中,X为状态向量,表示东、北、天方向的姿态误差角,δVe、δVn、δVu和δL、δλ、δh分别表示东、北、天方向的速度误差和纬度、经度、高度的位置误差,εx、εy、εz表示沿载体系xyz轴上的角度随机游走系数,表示沿载体系xyz轴上的陀螺仪零偏。
根据上述卡尔曼滤波状态方程,建立误差协方差矩阵A(t),A(t)为15×15维的矩阵;A(t)表示为如下形式:
其中,0表示零矩阵,下标表示该零矩阵是几乘几的矩阵;
F11、F12、F13、F14、F21、F22、F23、F24、F32、F33、F43分别为:
其中,L为纬度,h为高度,Vn为导航坐标系下的速度分量;Rn为卯酉面曲率半径,Rm为子午面曲率半径,Ve为地球坐标系下的速度矢量,ωie为地球自转角速率。
其中,α为速度分量方差,β为位置分量方差。
其中,fu、fn、fe为分别为地理坐标系下天向、北向、东向方向上的比力。
其中,为式(9)中求得的。
进一步的构建***噪声矩阵R,对于北斗(BD)量测卡尔曼更新,R是MN×MN维的矩阵其表示形式速度和位置标准差的对角阵如下:
其中,X为式(12)中得到的X;M为代表速度和位置标准差的6维向量,N和式(10)的N含义相同;H表示转置共轭。
根据所述北斗卫星导航预处理数据及所述解算结果,以及所述状态方程建立量测方程,具体地,取北斗PVT解算位置信息与SINS捷联解算位置信息的差值以及北斗PVT解算速度信息与SINS捷联解算的速度信息的差值作为观测量值,量测方程公式如下:
Z(t)=H(t)X(t)+w(t) (27)
X(t)为式(12)求得的状态向量,ω(t)为***过程白噪声,H为观测矩阵。
H(t)为观测矩阵定义如式(28)。
建立非完整性约束组合导航滤波方程,加入载体约束条件,在不增加硬件的基础上提高导航精度、重新建立量测方程,选取两轴上的速度直接误差作为外部观测量Z1,
其中,为载体系上迭代计算后的x轴与z轴的速度误差。
根据速度坐标转换得到量测方程如下:
其中,量测噪声γn是零均值的白噪声,量测矩阵H为:
其中,Vn为导航坐标系下的速度矢量,Ve为地球坐标系下的速度矢量,后括号中的数字是指在矩阵中相应行和列上的元素,比如(1,2)就是指中第1行第2列的元素;其它可以类推。
最后可以根据组合导航卡尔曼滤波的结果反馈给SINS***做位置、速度、姿态信息的修正。
实施例二、一种导航终端,如图2所示,包括以下模块:
北斗卫星导航模块,用于接收北斗卫星导航信号,接收内部射频和基带芯片数据,经PVT解算处理后,得到北斗卫星导航预处理数据;
惯性导航模块,用于获取原始惯性测量数据;对所述原始惯性测量数据采用捷联惯性导航算法进行解算,得到解算结果;
外部观测模块,用于获取外部观测信息,根据所述外部观测信息及所述原始惯性测量数据计算误差数据;所述外部观测信息包括温度、启动时间;
组合导航模块,用于根据北斗卫星导航预处理数据、所述误差数据和所述解算结果进行组合导航滤波,输出滤波结果。
本实施例中,所述导航终端还可以包括:
低压差稳压源,提供稳定输入的电源;放置位置应远离惯测量性器件和磁强计以最大程度上减小热量散发对器件造成零偏影响;
数据I/O(输入/输出)接口,采用高速I2C硬件接口,用于实时输出所述滤波结果给外部模块;还可以另外输出所述北斗卫星导航预处理数据、解算结果等;
存储芯片,可以但不限于为EEPROM。
本实施例中,所述外部观测模块可以但不限于包括:
温度传感器模块,用于提供计算误差数据所需的温度。
时间等其它外部观测数据可以直接从相应仪器或模块中读取,或预先输入/保存在外部观测模块中。
本实施例的一种实施方式中,所述惯性导航模块中除了用于采用捷联惯性导航算法进行解算的处理单元之外,还可以包括测量单元;所述测量单元可以但不限于包括三轴陀螺仪、三轴加速度计、三轴磁力计。
相应地,所述原始惯性测量数据包括:陀螺仪原始测量数据、加速度计原始测量数据、磁力计原始测量数据;
所述外部观测模块根据外部观测信息及所述原始惯性测量数据计算误差数据具体可以是指:
所述外部观测模块计算各轴的位置误差C1为:
C1=(Z–B)/(1+S)
其中Z为所计算的轴的原始观测数据,B为所计算的轴的标定偏置误差,S为所计算的轴的刻度因子误差;
计算陀螺仪的稳定零偏误差:
W稳定零偏=a0+a1t+a2T+a3T2+a4T3+a5△T;
其中,t为陀螺仪的启动时间,T为陀螺仪的内部温度,△T为温度变化梯度,a0为常数项,a1~a5为系数;
计算姿态误差角C2为:
C2=A1×B1–B2×A2
A1为解算前上一个采样点陀螺仪的原始观测数据,B1为解算前上一个采样点的加速度计的原始观测数据,A2为解算时当前采样点陀螺仪的观测数据,B2为解算时当前采样点的加速度计的观测数据;
计算速度误差C3为:
C3=1/2×(A2×B2+B1×A1+B1×A2)/12.0。
本实施例的一种实施方式中,所述惯性导航模块对原始惯性测量数据采用捷联惯性导航算法进行解算,得到解算结果具体可以是指:
所述惯性导航模块计算解算点的地球曲率半径:
其中a为地球长半轴半径,e为地球扁率,lat为捷联导航解算点的纬度;
进行速度解算:
Rd=Vn×0.5×Dt/(Rm+Dr)
V1=Vn+0.5×Dv
进行位置解算:
Wen=Vn×k(Mv+Rn×Dv)
R=R1–Dt×Dv
Rd为载体坐标系上四元数表示的投影分量,Vn为当前坐标系下的速度分量,V1为迭代后的三轴速度分量,Dt是时间历元,Dv为导航系下的速度向量,Dr为地理坐标系下的位置向量,Rm为地球子午线对应的曲率半径;Wen为导航系下的转换速率,Rn为卯酉圈的曲率半径,Mv为差值速度向量,k为转换系数;R1为上一解算时刻的位置矢量,R为解算后的位置矢量;
进行姿态解算:
其中,为转动矢量矩阵,ψ为载体的航向角,θ均为俯仰角,γ为横滚角,φ为等效转动矢量,ω角速度矢量,i为算法的i阶,j为算法的j阶,m为姿态个数,N为算法的阶数,kij为算法系数。
本实施例的一种实施方式中,所述组合导航模块根据北斗卫星导航预处理数据、所述误差数据和所述解算结果进行组合导航滤波具体可以是指:
所述组合导航模块根据所述误差数据建立卡尔曼滤波器的状态方程;根据所述卡尔曼滤波状态方程,建立误差协方差矩阵:根据所述卡尔曼滤波状态方程构建***噪声矩阵;根据所述北斗卫星导航预处理数据及所述解算结果,以及所述状态方程建立量测方程。
该实施方式中,所述卡尔曼滤波器的状态方程可以为:
其中,X为状态向量,表示东、北、天方向的姿态误差角,δVe、δVn、δVu和δL、δλ、δh分别表示东、北、天方向的速度误差和纬度、经度、高度的位置误差,εx、εy、εz表示沿载体系xyz轴上的角度随机游走系数,表示沿载体系xyz轴上的陀螺仪零偏。
所述误差协方差矩阵为如下的15×15维的矩阵:
其中,0表示零矩阵,下标表示该零矩阵是几乘几的矩阵;
F11、F12、F13、F14、F21、F22、F23、F24、F32、F33、F43分别为:
其中,L为纬度,h为高度,Vn为导航坐标系下的速度分量;Rn为卯酉面曲率半径,Rm为子午面曲率半径,Ve为地球坐标系下的速度矢量,ωie为地球自转角速率;
其中,α为速度分量方差,β为位置分量方差;
其中,fu、fn、fe为分别为地理坐标系下天向、北向、东向方向上的比力;
所述***噪声矩阵可以如下:
M为代表速度和位置标准差的6维向量,H表示转置共轭;
所述量测方程可以如下:
Z1=H1X+γn
其中,量测噪声γn是零均值的白噪声,量测矩阵H1为:
其中,Vn为导航坐标系下的速度矢量,Ve为地球坐标系下的速度矢量,后括号中的数字是指在矩阵中相应行和列上的元素。
当然,本发明还可有其他多种实施例,在不背离本发明精神及其实质的情况下,熟悉本领域的技术人员当可根据本发明作出各种相应的改变和变形,但这些相应的改变和变形都应属于本发明的权利要求的保护范围。
Claims (8)
1.一种导航方法,包括:
接收北斗卫星导航信号,接收内部射频和基带芯片数据,经位置、速度、时间解算处理后,得到北斗卫星导航预处理数据;
获取外部观测信息及原始惯性测量数据;根据所述外部观测信息及所述原始惯性测量数据计算误差数据;所述外部观测信息包括温度、启动时间;
对所述原始惯性测量数据采用捷联惯性导航算法进行解算,得到解算结果;
根据北斗卫星导航预处理数据、所述误差数据和所述解算结果进行组合导航滤波,输出滤波结果;
对所述原始惯性测量数据采用捷联惯性导航算法进行解算,得到解算结果的步骤包括:
计算解算点的地球曲率半径:
其中a为地球长半轴半径,e为地球扁率,lat为捷联导航解算点的纬度;
进行速度解算:
Rd=Vn×0.5×Dt/(Rm+Dr)
V1=Vn+0.5×Dv
进行位置解算:
Wen=Vn×k(Mv+Rn×Dv)
R=R1–Dt×Dv
Rd为载体坐标系上四元数表示的投影分量,Vn为当前坐标系下的速度分量,V1为迭代后的三轴速度分量,Dt是时间历元,Dv为导航系下的速度向量,Dr为地理坐标系下的位置向量,Rm为地球子午线对应的曲率半径;Wen为导航系下的转换速率,Rn为卯酉圈的曲率半径,Mv为差值速度向量,k为转换系数;R1为上一解算时刻的位置矢量,R为解算后的位置矢量;
进行姿态解算:
其中,为转动矢量矩阵,ψ为载体的航向角,θ均为俯仰角,γ为横滚角,φ为等效转动矢量,ω为角速度矢量,i为算法的i阶,j为算法的j阶,m为姿态个数,N为算法的阶数,kij为算法系数。
2.如权利要求1所述的导航方法,其特征在于:
所述原始惯性测量数据包括:陀螺仪原始测量数据、加速度计原始测量数据、磁力计原始测量数据;
根据外部观测信息及所述原始惯性测量数据计算误差数据的步骤包括:
计算各轴的位置误差C1为:
C1=(Z–B)/(1+S)
其中Z为所计算的轴的原始观测数据,B为所计算的轴的标定偏置误差,S为所计算的轴的刻度因子误差;
计算陀螺仪的稳定零偏误差:
W稳定零偏=a0+a1t+a2T+a3T2+a4T3+a5ΔT;
其中,t为陀螺仪的启动时间,T为陀螺仪的内部温度,ΔT为温度变化梯度,a0为常数项,a1~a5为系数;
计算姿态误差角C2为:
C2=A1×B1–B2×A2
A1为解算前上一个采样点陀螺仪的原始观测数据,B1为解算前上一个采样点的加速度计的原始观测数据,A2为解算时当前采样点陀螺仪的观测数据,B2为解算时当前采样点的加速度计的观测数据;
计算速度误差C3为:
C3=1/2×(A2×B2+B1×A1+B1×A2)/12.0。
3.如权利要求1所述的方法,其特征在于,所述根据北斗卫星导航预处理数据、所述误差数据和所述解算结果进行组合导航滤波的步骤包括:
根据所述误差数据建立卡尔曼滤波器的状态方程;
根据所述卡尔曼滤波状态方程,建立误差协方差矩阵:
根据所述卡尔曼滤波状态方程构建***噪声矩阵;
根据所述北斗卫星导航预处理数据及所述解算结果,以及所述状态方程建立量测方程。
4.如权利要求3所述的方法,其特征在于:
所述卡尔曼滤波器的状态方程为:
X为状态向量,表示东、北、天方向的姿态误差角,δVe、δVn、δVu和δL、δλ、δh分别表示东、北、天方向的速度误差和纬度、经度、高度的位置误差,εx、εy、εz表示沿载体系xyz轴上的角度随机游走系数,表示沿载体系xyz轴上的陀螺仪零偏;
所述误差协方差矩阵为如下的15×15维的矩阵:
其中,0表示零矩阵,下标表示该零矩阵是几乘几的矩阵;
F11、F12、F13、F14、F21、F22、F23、F24、F32、F33、F43分别为:
其中,L为纬度,h为高度,Vnd为导航坐标系下的速度分量;Ve为地球坐标系下的速度矢量,ωie为地球自转角速率;
其中,α为速度分量方差,β为位置分量方差;
其中,fu、fn、fe为分别为地理坐标系下天向、北向、东向方向上的比力;
所述***噪声矩阵如下:
X为卡尔曼滤波器的状态方程得到的状态向量,R是MN×MN维的矩阵,其表示形式为速度和位置标准差的对角阵,H表示转置共轭;
所述量测方程如下:
Z1=H1X+γn
其中,量测噪声γn是零均值的白噪声,量测矩阵H1为:
其中,Vn为导航坐标系下的速度矢量,Ve为地球坐标系下的速度矢量,后括号中的数字是指在矩阵中相应行和列上的元素。
5.一种导航终端,其特征在于,包括:
北斗卫星导航模块,用于接收北斗卫星导航信号,接收内部射频和基带芯片数据,经位置、速度、时间解算处理后,得到北斗卫星导航预处理数据;
惯性导航模块,用于获取原始惯性测量数据;对所述原始惯性测量数据采用捷联惯性导航算法进行解算,得到解算结果;
外部观测模块,用于获取外部观测信息,根据所述外部观测信息及所述原始惯性测量数据计算误差数据;所述外部观测信息包括温度、启动时间;
组合导航模块,用于根据北斗卫星导航预处理数据、所述误差数据和所述解算结果进行组合导航滤波,输出滤波结果;
所述惯性导航模块对原始惯性测量数据采用捷联惯性导航算法进行解算,得到解算结果是指:
所述惯性导航模块计算解算点的地球曲率半径:
其中a为地球长半轴半径,e为地球扁率,lat为捷联导航解算点的纬度;
进行速度解算:
Rd=Vn×0.5×Dt/(Rm+Dr)
V1=Vn+0.5×Dv
进行位置解算:
Wen=Vn×k(Mv+Rn×Dv)
R=R1–Dt×Dv
Rd为载体坐标系上四元数表示的投影分量,Vn为当前坐标系下的速度分量,V1为迭代后的三轴速度分量,Dt是时间历元,Dv为导航系下的速度向量,Dr为地理坐标系下的位置向量,Rm为地球子午线对应的曲率半径;Wen为导航系下的转换速率,Rn为卯酉圈的曲率半径,Mv为差值速度向量,k为转换系数;R1为上一解算时刻的位置矢量,R为解算后的位置矢量;
进行姿态解算:
其中,为转动矢量矩阵,ψ为载体的航向角,θ均为俯仰角,γ为横滚角,φ为等效转动矢量,ω为角速度矢量,i为算法的i阶,j为算法的j阶,m为姿态个数,N为算法的阶数,kij为算法系数。
6.如权利要求5所述的导航终端,其特征在于:
所述原始惯性测量数据包括:陀螺仪原始测量数据、加速度计原始测量数据、磁力计原始测量数据;
所述外部观测模块根据外部观测信息及所述原始惯性测量数据计算误差数据是指:
所述外部观测模块计算各轴的位置误差C1为:
C1=(Z–B)/(1+S)
其中Z为所计算的轴的原始观测数据,B为所计算的轴的标定偏置误差,S为所计算的轴的刻度因子误差;
计算陀螺仪的稳定零偏误差:
W稳定零偏=a0+a1t+a2T+a3T2+a4T3+a5ΔT;
其中,t为陀螺仪的启动时间,T为陀螺仪的内部温度,ΔT为温度变化梯度,a0为常数项,a1~a5为系数;
计算姿态误差角C2为:
C2=A1×B1–B2×A2
A1为解算前上一个采样点陀螺仪的原始观测数据,B1为解算前上一个采样点的加速度计的原始观测数据,A2为解算时当前采样点陀螺仪的观测数据,B2为解算时当前采样点的加速度计的观测数据;
计算速度误差C3为:
C3=1/2×(A2×B2+B1×A1+B1×A2)/12.0。
7.如权利要求5所述的导航终端,其特征在于,所述组合导航模块根据北斗卫星导航预处理数据、所述误差数据和所述解算结果进行组合导航滤波是指:
所述组合导航模块根据所述误差数据建立卡尔曼滤波器的状态方程;根据所述卡尔曼滤波状态方程,建立误差协方差矩阵:根据所述卡尔曼滤波状态方程构建***噪声矩阵;根据所述北斗卫星导航预处理数据及所述解算结果,以及所述状态方程建立量测方程。
8.如权利要求7所述的导航终端,其特征在于:
所述卡尔曼滤波器的状态方程为:
X为状态向量,表示东、北、天方向的姿态误差角,δVe、δVn、δVu和δL、δλ、δh分别表示东、北、天方向的速度误差和纬度、经度、高度的位置误差,εx、εy、εz表示沿载体系xyz轴上的角度随机游走系数,表示沿载体系xyz轴上的陀螺仪零偏;
所述误差协方差矩阵为如下的15×15维的矩阵:
其中,0表示零矩阵,下标表示该零矩阵是几乘几的矩阵;
F11、F12、F13、F14、F21、F22、F23、F24、F32、F33、F43分别为:
其中,L为纬度,h为高度,Vnd为导航坐标系下的速度分量;Ve为地球坐标系下的速度矢量,ωie为地球自转角速率;
其中,α为速度分量方差,β为位置分量方差;
其中,fu、fn、fe为分别为地理坐标系下天向、北向、东向方向上的比力;
所述***噪声矩阵如下:
X为卡尔曼滤波器的状态方程得到的状态向量,R是MN×MN维的矩阵,其表示形式为速度和位置标准差的对角阵,H表示转置共轭;
所述量测方程如下:
Z1=H1X+γn
其中,量测噪声γn是零均值的白噪声,量测矩阵H1为:
其中,Vn为导航坐标系下的速度矢量,Ve为地球坐标系下的速度矢量,后括号中的数字是指在矩阵中相应行和列上的元素。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410150552.0A CN103941274B (zh) | 2014-04-15 | 2014-04-15 | 一种导航方法及导航终端 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410150552.0A CN103941274B (zh) | 2014-04-15 | 2014-04-15 | 一种导航方法及导航终端 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103941274A CN103941274A (zh) | 2014-07-23 |
CN103941274B true CN103941274B (zh) | 2017-01-18 |
Family
ID=51189020
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410150552.0A Active CN103941274B (zh) | 2014-04-15 | 2014-04-15 | 一种导航方法及导航终端 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103941274B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105068104B (zh) * | 2015-08-31 | 2017-08-18 | 北京航空航天大学 | 一种基于惯性/双星间断伪距约束的定位方法 |
CN106842271B (zh) * | 2015-12-03 | 2020-05-12 | 宁波芯路通讯科技有限公司 | 导航定位方法及装置 |
CN107390247A (zh) * | 2017-07-27 | 2017-11-24 | 河南省科学院应用物理研究所有限公司 | 一种导航方法、***及导航终端 |
CN109343081A (zh) * | 2018-10-10 | 2019-02-15 | 中国人民解放军国防科技大学 | 一种gps信号动态接收环境仿真方法及*** |
CN109945860B (zh) * | 2019-05-07 | 2021-04-06 | 深圳市联和安业科技有限公司 | 一种基于卫星紧组合的ins和dr惯性导航方法与*** |
CN111076722B (zh) * | 2019-11-18 | 2022-07-19 | 广州南方卫星导航仪器有限公司 | 基于自适应的四元数的姿态估计方法及装置 |
CN110954092B (zh) * | 2019-11-28 | 2023-09-15 | 上海航天控制技术研究所 | 基于相对测量信息辅助的协同导航方法 |
CN111024126B (zh) * | 2019-12-26 | 2022-03-22 | 北京航天控制仪器研究所 | 一种行人导航定位中的自适应零速修正方法 |
CN116660965B (zh) * | 2023-07-26 | 2023-09-29 | 北京北斗星通导航技术股份有限公司 | 一种北斗惯性导航定位方法、装置及存储介质 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101706284A (zh) * | 2009-11-09 | 2010-05-12 | 哈尔滨工程大学 | 提高船用光纤陀螺捷联惯导***定位精度的方法 |
CN103389506A (zh) * | 2013-07-24 | 2013-11-13 | 哈尔滨工程大学 | 一种用于捷联惯性/北斗卫星组合导航***的自适应滤波方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN201266089Y (zh) * | 2008-09-05 | 2009-07-01 | 北京七维航测科技发展有限公司 | Ins/gps组合导航*** |
CN102608642A (zh) * | 2011-01-25 | 2012-07-25 | 北京七维航测科技股份有限公司 | 北斗/惯性组合导航*** |
US8589072B2 (en) * | 2011-04-13 | 2013-11-19 | Honeywell International, Inc. | Optimal combination of satellite navigation system data and inertial data |
US9026263B2 (en) * | 2011-11-30 | 2015-05-05 | Alpine Electronics, Inc. | Automotive navigation system and method to utilize internal geometry of sensor position with respect to rear wheel axis |
-
2014
- 2014-04-15 CN CN201410150552.0A patent/CN103941274B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101706284A (zh) * | 2009-11-09 | 2010-05-12 | 哈尔滨工程大学 | 提高船用光纤陀螺捷联惯导***定位精度的方法 |
CN103389506A (zh) * | 2013-07-24 | 2013-11-13 | 哈尔滨工程大学 | 一种用于捷联惯性/北斗卫星组合导航***的自适应滤波方法 |
Non-Patent Citations (3)
Title |
---|
"MEMS陀螺仪零位误差分析与处理";陈旭光等人;《传感技术学报》;20120531;第25卷(第5期);第628-632页 * |
"北斗/微惯导组合导航方法研究";何晓峰;《中国博士学位论文全文数据库信息科技辑》;20110415;第37-38、88-89、94页 * |
"捷联式惯性***陀螺仪数据分析与温度建模";陈刚等人;《***仿真学报》;20060630;第18卷(第6期);第1428-1433页 * |
Also Published As
Publication number | Publication date |
---|---|
CN103941274A (zh) | 2014-07-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103941274B (zh) | 一种导航方法及导航终端 | |
CN104181572B (zh) | 一种弹载惯性/卫星紧组合导航方法 | |
CN107655476B (zh) | 基于多信息融合补偿的行人高精度足部导航方法 | |
CN109459044B (zh) | 一种gnss双天线辅助的车载mems惯导组合导航方法 | |
CN111947652B (zh) | 一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法 | |
CN103917850B (zh) | 一种惯性导航***的运动对准方法 | |
CN103630137B (zh) | 一种用于导航***的姿态及航向角的校正方法 | |
CN104457754B (zh) | 一种基于sins/lbl紧组合的auv水下导航定位方法 | |
CN103900565B (zh) | 一种基于差分gps的惯导***姿态获取方法 | |
CN103675861B (zh) | 一种基于星载gnss多天线的卫星自主定轨方法 | |
CN100541135C (zh) | 基于多普勒的光纤陀螺捷联惯导***初始姿态确定方法 | |
CN101788296B (zh) | 一种sins/cns深组合导航***及其实现方法 | |
CN107390247A (zh) | 一种导航方法、***及导航终端 | |
CN106405670B (zh) | 一种适用于捷联式海洋重力仪的重力异常数据处理方法 | |
CN102538792B (zh) | 一种位置姿态***的滤波方法 | |
CN102393201B (zh) | 航空遥感用位置和姿态测量***(pos)动态杆臂补偿方法 | |
CN101216321A (zh) | 捷联惯性导航***的快速精对准方法 | |
CN103941273B (zh) | 机载惯性/卫星组合导航***的自适应滤波方法与滤波器 | |
CN102853837B (zh) | 一种mimu和gnss信息融合的方法 | |
CN110133692B (zh) | 惯导技术辅助的高精度gnss动态倾斜测量***及方法 | |
CN103712621B (zh) | 偏振光及红外传感器辅助惯导***定姿方法 | |
CN111121766A (zh) | 一种基于星光矢量的天文与惯性组合导航方法 | |
CN103604428A (zh) | 基于高精度水平基准的星敏感器定位方法 | |
CN111189474A (zh) | 基于mems的marg传感器的自主校准方法 | |
CN103278165A (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 |