CN105954783B - 一种改进gnss/ins实时紧组合导航实时性能的方法 - Google Patents
一种改进gnss/ins实时紧组合导航实时性能的方法 Download PDFInfo
- Publication number
- CN105954783B CN105954783B CN201610262477.6A CN201610262477A CN105954783B CN 105954783 B CN105954783 B CN 105954783B CN 201610262477 A CN201610262477 A CN 201610262477A CN 105954783 B CN105954783 B CN 105954783B
- Authority
- CN
- China
- Prior art keywords
- moment
- time
- gnss
- real
- state
- 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
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)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种改进GNSS/INS实时紧组合导航实时性能的方法,包括(1)保存GNSS采样时刻k的预测误差协方差矩阵和机械编排解算的导航状态;(2)在时刻k时GNSS观测数据的接收时刻,采用Kalma滤波法进行组合更新解算,得时刻k的状态参数估计量以及状态参数协方差估计量(3)根据和估计组合更新解算完成时刻j的状态参数估计量以及状态参数协方差估计量(4)采用以及修正时刻j的惯导误差。本发明可降低GNSS数据延迟和组合解算耗时对实时导航输出的影响,可有效改善实时组合导航的实时性能,对组合导航算法在运算能力较低的处理器上的实现以及对实时性要求严格的应用场合有格外重要的意义。
Description
技术领域
本发明属于实时组合导航***技术领域,尤其涉及一种改进GNSS/INS实时紧组合导航实时性能的方法。
背景技术
多种手段组合导航是当前导航技术的发展趋势,基于全球卫星导航***(GlobalNavigation Satellite System,GNSS)和惯性导航***(Inertial Navigation System,INS)的组合是目前最具有应用价值的组合模式之一,特别是基于GNSS原始观测量和INS数据的紧组合。该组合模式下,即使在可见卫星不足以单独进行GNSS解算时,仍可有效利用有限的GNSS观测数据和INS数据通过Kalman滤波进行紧组合解算,得到可靠的导航信息。因此,GNSS/INS紧组合在工程中得到了越来越广泛的应用。
然而,GNSS/INS紧组合实时应用中的GNSS观测数据时间延迟和组合解算时间延迟(这里统称为时间延迟)问题,会分别导致当前时刻观测数据无法实时得到以及观测数据无法及时处理的问题,直接影响GNSS/INS紧组合***的实时性能。目前,时间延迟的解决策略主要采用增广状态方法和基于新息重组理论建立最优滤波器。其中,增广状态方法会增加状态维度,使得计算量增大;而新息重组的方法,需要建立多个观测方程,如果有多步延迟,则不利于对Kalman滤波器的灵活拓展与应用。而且这些方法只能解决观测数据传输延迟,对于更新计算延迟则无能为力。GNSS/INS实时紧组合法主要包括“机械编排、Kalman预测”以及“Kalman观测更新”两部分,前者一般可以在IMU(Inertial Measurement Unit)采样间隔内完成计算;后者则比较耗时,普通嵌入式处理器中无法在足够短的时间内(例如下一个惯导数据到来前)及时完成,再加上GNSS观测数据大都是从商业接收机板卡中获取,观测数据传输会有一定的延迟,这就导致Kalman滤波的观测更新计算不能及时完成。这种情况下,如果使用标准Kalman滤波算法,就需要将后续IMU观测数据缓存起来不处理,等待观测更新完成才能进行下一步计算,这就会造成组合导航结果输出的阻塞和延迟,影响***的实时性能。开发GNSS/INS实时紧组合***时,就需要一种方法解决在存在时间延迟的情况下,及时完成导航解算。
发明内容
针对现有GNSS/INS实时紧组合导航中GNSS观测数据传输延迟和更新计算耗时较长所带来的时间延迟问题,本发明提出了一种改进GNSS/INS实时紧组合导航实时性能的方法。
本发明采用如下技术方案:
一种改进GNSS/INS实时紧组合导航实时性能的方法,包括:
将GNSS/INS紧组合分解成机械编排、Kalman预测任务和Kalman观测更新任务,下述步骤实施过程中保持机械编排、Kalman预测任务优先级高于Kalman观测更新任务:
(1)将GNSS采样时刻记为时刻k,保存时刻k的预测误差协方差矩阵和机械编排解算的导航状态;
(2)在时刻k时GNSS观测数据的接收时刻,基于时刻k的GNSS观测数据、和根据时刻k的机械编排解算的导航状态形成的状态向量zk,采用Kalman滤波法进行组合更新解算,得时刻k的状态参数估计量以及状态参数协方差估计量
(3)将组合更新解算完成时刻记为时刻j,基于公式估计时刻j的状态参数估计量以及状态参数协方差估计量Φj/k表示时刻k到时刻j的累积状态转移矩阵;Mj,k+1为时刻k+1到时刻j的累计状态噪声矩阵,
(4)采用以及修正时刻j的惯导误差。
和现有技术相比,本发明具有如下优点和有益效果:
1、本发明针对GNSS/INS组合导航***,基于Kalman滤波法,将滞后的状态参数估计量以及状态参数协方差估计量转移到当前时刻,从而降低GNSS数据延迟和组合解算耗时对实时导航输出的影响,可有效改善实时组合导航的实时性能。
2、本发明对组合导航算法在运算能力较低的处理器上的实现以及对实时性要求严格的应用场合有格外重要的意义。
3、在DSP硬件平台上实现和验证本发明,车载实测结果表明:相对于标准组合导航解算法,本发明能够在保障组合导航***精度的前提下,最大限度地减小输出导航结果的时间延迟,保障组合导航结果的实时性。
附图说明
图1为GNSS/INS实时紧组合导航***结构图;
图2为时间延迟的处理时序示意图;
图3为实施例中车载测试轨迹;
图4为GNSS数据延迟的统计直方图,其中,横坐标表示GNSS数据延迟,单位为ms;
图5为200Hz中断计算耗时的统计直方图,其中,横坐标表示200Hz中断计算耗时,单位为ms;
图6为组合更新计算耗时的统计直方图,其中,横坐标表示组合更新计算耗时,单位为ms;
图7为本发明导航解算延迟示意图;
图8为实施例的导航误差曲线。
具体实施方式
GNSS/INS紧组合可分解成具有优先级别的两个任务“机械编排、Kalman预测”和“Kalman观测更新”独立进行,其中,任务“机械编排、Kalman预测”的优先级高于任务“Kalman观测更新”。
本发明具体步骤如下:
(1)将GNSS采样时刻记为时刻k,保存时刻k的预测误差协方差矩阵和机械编排解算的导航状态。
(2)见图2,将时刻k时GNSS观测数据的实际接收时刻记为时刻ts,在时刻ts采用Kalman滤波法进行组合更新解算(见式(12)~(13)),获得时刻k的状态参数估计量以及状态参数协方差估计量
组合更新解算完成后,还需要将滞后计算出来的反映时刻k的状态参数估计量以及状态参数协方差估计量转移到组合更新完成时刻j,以修正时刻j的惯导误差,即反馈修正。本发明利用状态转移模型达到该目的,所述的状态转移即根据时刻k的状态参数估计时刻j的状态参数。
根据k个时刻的观测向量z1、z2……zk对时刻j的状态参数xj作线性最小方差估计
式(1)中,z1、z2……zk分别表示时刻1、2、……k的观测向量,E(·)表示数学期望。
GNSS/INS紧组合导航***中,状态参数x由INS误差状态和GNSS接收机时钟误差共同组成,可以表示为:
式(2)中:δrn、δvn、ψ分别表示位置误差、速度误差、姿态角误差;bg、sg分别表示陀螺的零偏和比例因子;ba、sa分别表示加速度计的零偏和比例因子;表示接收机钟差误差;δfR表示接收机钟漂误差。
δrn、δvn、ψ、bg、sg、ba、sa为INS误差状态,δfR为GNSS接收机时钟误差。
考虑如下线性离散***:
xk=Φk/k-1xk-1+Gk/k-1wk-1 (3)
zk=Hkxk+uk (4)
式(3)~(4)中:
xk、xk-1分别表示时刻k、k-1的状态参数;
Φk/k-1为时刻k-1到时刻k的状态转移矩阵,其值由状态参数的动力学模型决定;
Gk/k-1为时刻k-1到时刻k的***噪声驱动矩阵;
wk-1为时刻k-1的***噪声;
zk为时刻k的观测向量,其由INS推算的GNSS伪距、多普勒值与GNSS接收机观测的伪距、多普勒观测值作差得到;
Hk为时刻k的设计矩阵;
uk为时刻k的观测噪声矩阵。
根据式(3),并且考虑到Φk+1/k-1=Φk+1/kΦk/k-1,从时刻k的状态参数xk转移时刻j的状态参数xj,如下:
上述Φk+1/k-1表示时刻k-1到时刻k+1的状态转移矩阵,Φk+1/k、Φj/k分别表示时刻k到时刻k+1、时刻j的状态转移矩阵,Φj/i表示时刻i到时刻j的状态转移矩阵;Gi/i-1表示时刻i-1到时刻i的***噪声驱动矩阵;wi-1表示时刻i-1的***噪声。
式(5)代入式(1)得到:
由式(3)可知,wk-1只影响到xk,所以wk-1与z1、z2……zk不相关,且E(wk-1)=0,E(·)表示数学期望,因此有:
由式(3)可知,wk-1只影响到xk,所以wi-1与z1、z2……zk不相关,且E(wi-1)=0,i≥k+1且i≤j,因此有:
式(7)中,表示xk的更新估计量。
的误差为:
对于预测误差协方差矩阵T表示矩阵的转置:
式中,表示xk的误差;为x在时刻j的预测误差协方差矩阵,为x在时刻k的协方差矩阵;Qi-1为wi-1的协方差矩阵。GNSS/INS紧组合中Gi/i-1为正定矩阵,因此,
令Mj,k+1表示时刻k+1到时刻j的累计状态噪声矩阵。具体实施时采用公式(10)累积状态噪声矩阵:
式(10)中,Qm、Qk分别表示wm、wk的协方差矩阵,wm、wk分别表示时刻m、k时的***噪声,m为大于k的时刻;Φm+1/m表示时刻m到时刻m+1的转移矩阵;Mm,k+1表示时刻k+1到时刻m的累计状态噪声矩阵,Mk+1,k+1表示时刻k+1的累计状态噪声矩阵。
综上,可获得状态转移公式,如下:
由式(11)可以看出,状态转移可以由累积状态转移矩阵Φj/k及累计状态噪声矩阵Mj,k+1得到,Φj/k为时刻k到时刻j时间段内相邻时刻的状态转移矩阵的连乘,Mj,k+1由式(10)获得。把GNSS采样时刻看作时刻k,组合更新解算完成时刻看作时刻j,利用式(11)把时刻k的状态参数估计量以及状态参数协方差估计量转移到时刻j,进而对时刻j的惯导误差进行反馈修正。
本发明组合更新解算采用标准Kalman滤波法,如下:
式中,表示根据时刻1、2…k-1的观测向量估计的时刻k的状态参数;Kk为卡尔曼滤波增益矩阵;为时刻k的状态参数协方差估计量;为步骤(1)中保存的时刻k的预测误差协方差矩阵;I表示单位矩阵;Rk为观测信息先验方差矩阵,按卫星高度角确定观测值先验方差。
在步骤(1)~(2)处理过程中保持优先进行INS机械编排和Kalman预测。这样,只要能保证“惯性机械编排、Kalman预测”在IMU采样间隔内完成,并保证“Kalman观测更新”计算在GNSS采样间隔内完成,就能够保证组合导航解算的实时性。
实施例
本实施例基于DSP(Digital Signal Processor)嵌入式平台实现并验证本发明方法。
本实施例采用基于TMS320C6747开发的GNSS/INS实时紧组合***,IMU采样率为200Hz,主要性能参数见表1,GNSS采样率为1Hz,导航结果输出率为200Hz。
表1 IMU主要性能参数
GNSS/INS实时紧组合导航***结构见图1,主要包括有2个处理器MCU(Microcontroller Unit)和DSP(Digital Signal Processor),MCU负责从陀螺仪及加速度计采集原始数据并利用GNSS板卡提供的1PPS(Pulse Per Sond)把IMU数据标记上GPS时间标志,通过串口向外部和DSP发送带有时间标志的IMU数据,DSP负责实时组合导航的计算。为了实现多任务模式的解算,在DSP中进行了中断优先级和中断嵌套设计,DSP分为4kHz的中断、200Hz中断以及主函数三部分,4kHz中断优先级高于200Hz中断,负责把GNSS、IMU原始数据采集到原始数据环形缓存中以及把导航结果环形缓存中的数据通过串口发送到外部;200Hz的中断从IMU原始数据环形缓存中获取IMU观测数据进行“机械编排、Kalman预测”以及从主函数获取组合更新量进行反馈,再把导航结果存入导航结果环形缓存中;主函数负责从GNSS原始数据环形缓存中获取GNSS观测数据进行“Kalman观测更新”,并将组合更新量传入200Hz中断。
对时间延迟的具体处理时序见图2,以GNSS采样时刻t0的处理为例,具体步骤如下:
步骤1:200Hz中断进行“机械编排、Kalman预测”的同时,利用IMU数据的时间判断当前时刻是否为GNSS采样时刻,若是GNSS采样时刻,保存当前时刻的预测误差协方差矩阵以及机械编排解算的导航状态,并且开始累计计算状态转移矩阵以及状态噪声矩阵。
步骤2:由于GNSS观测数据会滞后到来,主函数在该GNSS采样时刻的数据接收完成之后,利用之前保存的预测误差协方差矩阵以及导航状态,再加上接收到的GNSS观测信息形成Kalman观测更新方程进行“Kalman观测更新”,得到GNSS采样时刻的组合更新量。
步骤3:200Hz中断判断该GNSS采样时刻的组合更新是否完成,如果完成,则利用累计到此刻的状态转移矩阵以及状态噪声矩阵,使用状态转移的方法将主函数传递过来的该GNSS采样时刻的组合更新量变换到当前时刻,使用转移后的组合更新量进行反馈,以修正当前时刻的惯导误差,输出最优的组合结果。最后清除累计的状态转移矩阵以及状态噪声矩阵,为下一轮计算做准备。
为验证GNSS/INS实时紧组合导航***的性能,使用DSP片内计时器统计200Hz中断内从IMU原始数据获取到输出导航结果以及主函数中组合更新的运行时间,并在导航结果中记录输出,作为评价运行耗时的依据。
测试验证
图3为2015年9年29武汉市文化大道附近的实际车载测试轨迹,测试时长40多分钟,平均速率为20km/h,最大速率达38km/h,测试环境为开阔天空。本次测试,使用TrimbleNet R9作为静止参考站,基线长度约16km,在测试车中搭载GNSS/INS实时紧组合导航***,同时采集GNSS原始观测数据、IMU原始观测数据以及实时组合导航解算结果。采用武汉迈普时空导航公司开发的GINS v1.5软件提供的PPK(Post Processed Kinematic)/INS松组合平滑结果作为位置、速度和姿态的参考真值(基线小于20km的情况下,位置精度为0.05m,速度精度为0.01m/s,航向精度为0.02~0.05deg,横滚俯仰精度为0.01~0.02deg)。
1)实时性验证
根据实时记录的计算耗时,绘制GNSS数据延迟、200Hz中断计算耗时以及组合更新计算耗时的统计直方图,见图4~6。从图4可以看出,56ms、59ms以及48ms左右获取的GNSS数据有明显的延迟,时间延迟的差异可能是观测卫星数目不同以及导航星历消息数据更新引起的传输数据大小不同导致的。从图5可以看出,200Hz中断函数的执行时间95%左右的都大约是0.75ms,2%左右的大约是1ms,少部分大约在2.8ms,没有大于3ms的部分,可以认为中断函数可以在200Hz中断间隔中执行完毕。从图6可以看出,组合更新执行时间大部分在45ms~70ms左右,没有大于90ms的部分,结合图4,可以看出GNSS延迟更新时间大约为150ms,完全可以在一个GNSS采样间隔内完成组合更新计算。
图7为本发明导航解算延迟示意图,从图7看出,本发明导航解算延迟都在5ms之内,在IMU采样间隔内即可完成导航解算,延迟时间大致可以分为2部分,延迟较小的部分完成的是“机械编排、Kalman预测”,延迟较大的部分要多处理组合更新量的状态转移以及反馈。由此看来,本发明方法可有效减少时间延迟,确保***的实时有效性能。
2)实测精度验证
将测试采集的实时导航结果与参考真值做比较,导航误差见图8和表2,从图8和表2可以看出,北向、东向、垂向的位置误差Std分别为0.408m、0.363m、0.366m,北向、东向、垂向的速度误差Std分别为0.034m/s、0.034m/s、0.014m/s,横滚、俯仰、航向的姿态误差Std分别为0.017deg、0.021deg、0.184deg,导航误差均在伪距紧组合理论精度范围内,可以认为运用本发明方法实现的GNSS/INS实时紧组合***计算精度满足设计要求。
表2 实时导航误差统计
Claims (1)
1.一种改进GNSS/INS实时紧组合导航实时性能的方法,其特征是:
将GNSS/INS紧组合分解成机械编排、Kalman预测任务和Kalman观测更新任务,下述步骤实施过程中保持机械编排、Kalman预测任务优先级高于Kalman观测更新任务:
(1)将GNSS采样时刻记为时刻k,保存时刻k的预测误差协方差矩阵和机械编排解算的导航状态;
(2)在时刻k时GNSS观测数据的接收时刻,基于时刻k的GNSS观测数据、和根据时刻k的机械编排解算的导航状态形成的状态向量zk,采用Kalman滤波法进行组合更新解算,得时刻k的状态参数估计量以及状态参数协方差估计量
(3)将组合更新解算完成时刻记为时刻j,基于公式估计时刻j的状态参数估计量以及状态参数协方差估计量Φj/k表示时刻k到时刻j的累积状态转移矩阵;Mj,k+1为时刻k+1到时刻j的累计状态噪声矩阵,Qi-1为时刻i-1的***噪声的协方差矩阵;
(4)采用以及修正时刻j的惯导误差。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610262477.6A CN105954783B (zh) | 2016-04-26 | 2016-04-26 | 一种改进gnss/ins实时紧组合导航实时性能的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610262477.6A CN105954783B (zh) | 2016-04-26 | 2016-04-26 | 一种改进gnss/ins实时紧组合导航实时性能的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105954783A CN105954783A (zh) | 2016-09-21 |
CN105954783B true CN105954783B (zh) | 2017-03-29 |
Family
ID=56915553
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610262477.6A Active CN105954783B (zh) | 2016-04-26 | 2016-04-26 | 一种改进gnss/ins实时紧组合导航实时性能的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105954783B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110398765A (zh) * | 2018-04-25 | 2019-11-01 | 北京京东尚科信息技术有限公司 | 定位方法和装置、无人驾驶设备 |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107884800B (zh) * | 2016-09-30 | 2020-06-26 | 华为技术有限公司 | 观测时滞***的组合导航数据解算方法、装置及导航设备 |
CN106597507B (zh) * | 2016-11-28 | 2019-03-19 | 武汉大学 | Gnss/sins紧组合滤波平滑的高精度快速算法 |
CN106813663B (zh) * | 2017-02-24 | 2020-02-14 | 北京航天自动控制研究所 | 一种惯性导航数据与卫星导航数据同步方法 |
CN108120995A (zh) * | 2017-12-07 | 2018-06-05 | 深圳市华信天线技术有限公司 | 一种提高卫星导航***数据输出频率的方法及装置 |
CN108549397A (zh) * | 2018-04-19 | 2018-09-18 | 武汉大学 | 基于二维码和惯导辅助的无人机自主降落方法及*** |
CN112146653A (zh) * | 2020-08-03 | 2020-12-29 | 河北汉光重工有限责任公司 | 一种提高组合导航解算频率的方法 |
CN112269201B (zh) * | 2020-10-23 | 2024-04-16 | 北京云恒科技研究院有限公司 | 一种gnss/ins紧耦合时间分散滤波方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2541198B1 (en) * | 2011-06-30 | 2015-02-25 | Furuno Electric Company Limited | Road map feedback corrections in tightly coupled gps and dead reckoning vehicle navigation |
CN103969672B (zh) * | 2014-05-14 | 2016-11-02 | 东南大学 | 一种多卫星***与捷联惯性导航***紧组合导航方法 |
CN104316947B (zh) * | 2014-08-26 | 2017-04-12 | 南京航空航天大学 | Gnss/ins超紧组合导航装置及相对导航*** |
-
2016
- 2016-04-26 CN CN201610262477.6A patent/CN105954783B/zh active Active
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110398765A (zh) * | 2018-04-25 | 2019-11-01 | 北京京东尚科信息技术有限公司 | 定位方法和装置、无人驾驶设备 |
CN110398765B (zh) * | 2018-04-25 | 2022-02-01 | 北京京东乾石科技有限公司 | 定位方法和装置、无人驾驶设备 |
Also Published As
Publication number | Publication date |
---|---|
CN105954783A (zh) | 2016-09-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105954783B (zh) | 一种改进gnss/ins实时紧组合导航实时性能的方法 | |
Kepper et al. | A navigation solution using a MEMS IMU, model-based dead-reckoning, and one-way-travel-time acoustic range measurements for autonomous underwater vehicles | |
CN102508278B (zh) | 一种基于观测噪声方差阵估计的自适应滤波方法 | |
CN108594272B (zh) | 一种基于鲁棒卡尔曼滤波的抗欺骗干扰组合导航方法 | |
KR101755307B1 (ko) | 수중 이동체의 위치 측정 오차 보정 방법 | |
CN104380044B (zh) | 实时定位或导航***中使用历史状态的顺序估计 | |
KR101789188B1 (ko) | 수중 이동체의 위치 추적을 위한 수중 통합 항법 시스템 | |
CN108827305A (zh) | 一种基于鲁棒信息滤波的auv协同导航方法 | |
CN104280025A (zh) | 基于无色卡尔曼滤波的深海机器人超短基线组合导航方法 | |
EP2881708A1 (en) | System and method for indoor localization using mobile inertial sensors and virtual floor maps | |
CN106679662A (zh) | 一种基于tma技术的水下机器人单信标组合导航方法 | |
CN109782289A (zh) | 一种基于基线几何结构约束的水下航行器定位方法 | |
CN103604430A (zh) | 一种基于边缘化ckf重力辅助导航的方法 | |
CN109975851A (zh) | 一种列车线路故障点精确定位方法与*** | |
CN110646783A (zh) | 一种水下航行器的水下信标定位方法 | |
CN110231620A (zh) | 一种噪声相关***跟踪滤波方法 | |
CN111708008B (zh) | 一种基于imu和tof的水下机器人单信标导航方法 | |
KR101141984B1 (ko) | Dr/gps 데이터 융합 방법 | |
CN108885269A (zh) | 导航方法、导航装置和导航*** | |
CN102636773B (zh) | 基于信道多途特性的单基元抗距离模糊方法 | |
CN109269498A (zh) | 面向具有数据缺失uwb行人导航的自适应预估ekf滤波算法及*** | |
CN106840150A (zh) | 一种针对组合导航中dvl失效的混合处理方法 | |
CN104280026A (zh) | 基于aukf的深海机器人长基线组合导航方法 | |
CN102830408B (zh) | 一种惯性信息辅助的卫星接收机基带信号处理方法 | |
CN113821766B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |