CN110487271A - 一种GNSS信号受阻时Elman神经网络辅助紧组合导航方法 - Google Patents

一种GNSS信号受阻时Elman神经网络辅助紧组合导航方法 Download PDF

Info

Publication number
CN110487271A
CN110487271A CN201910915008.3A CN201910915008A CN110487271A CN 110487271 A CN110487271 A CN 110487271A CN 201910915008 A CN201910915008 A CN 201910915008A CN 110487271 A CN110487271 A CN 110487271A
Authority
CN
China
Prior art keywords
neural network
error
output
network
elman neural
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.)
Pending
Application number
CN201910915008.3A
Other languages
English (en)
Inventor
赵琳
彭子航
丁继成
王坤
柏亚国
张永超
王仁龙
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin Engineering University
Original Assignee
Harbin Engineering University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Harbin Engineering University filed Critical Harbin Engineering University
Priority to CN201910915008.3A priority Critical patent/CN110487271A/zh
Publication of CN110487271A publication Critical patent/CN110487271A/zh
Priority to US17/013,750 priority patent/US11821729B2/en
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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/183Compensation of inertial measurements, e.g. for temperature effects
    • G01C21/188Compensation of inertial measurements, e.g. for temperature effects for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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/165Navigation; 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining 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/42Determining position
    • G01S19/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/47Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06NCOMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
    • G06N3/00Computing arrangements based on biological models
    • G06N3/02Neural networks
    • G06N3/04Architecture, e.g. interconnection topology
    • G06N3/044Recurrent networks, e.g. Hopfield networks
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06NCOMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
    • G06N3/00Computing arrangements based on biological models
    • G06N3/02Neural networks
    • G06N3/08Learning methods
    • G06N3/084Backpropagation, e.g. using gradient descent
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06NCOMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
    • G06N5/00Computing arrangements using knowledge-based models
    • G06N5/04Inference or reasoning models
    • G06N5/046Forward inferencing; Production systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Software Systems (AREA)
  • Artificial Intelligence (AREA)
  • Mathematical Physics (AREA)
  • Computing Systems (AREA)
  • Computational Linguistics (AREA)
  • Data Mining & Analysis (AREA)
  • Evolutionary Computation (AREA)
  • General Engineering & Computer Science (AREA)
  • Biophysics (AREA)
  • Molecular Biology (AREA)
  • General Health & Medical Sciences (AREA)
  • Biomedical Technology (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Health & Medical Sciences (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Navigation (AREA)

Abstract

本发明公开了一种GNSS信号受阻时Elman神经网络辅助紧组合导航方法,以惯性和GNSS紧组合导航系统模型为基础,针对GNSS信号失锁时的紧组合导航问题,动态Elman神经网络预测模型,来对惯导的误差模型和GNSS的补偿模型进行学习;当GNSS信号缺失时,利用训练好的神经网络预测出GNSS的输出误差并补偿惯导的输出,使误差不会急剧发散,让系统继续进行组合导航。最后利用设计的低成本下的紧组合导航模块进行实地测量,将采集的信息进行预处理,组成训练神经网络的样本数据对Elman神经网络模型进行训练。本算法能在GNSS信号缺失100s的情况进行预测,使系统仍然能进行紧组合导航。

Description

一种GNSS信号受阻时Elman神经网络辅助紧组合导航方法
技术领域
本发明涉及一种紧组合导航方法,特别是一种GNSS信号受阻时Elman神经网络辅助紧组合导航方法,属于导航技术领域。
背景技术
惯导系统可以全面自主的提供的导航信息,但在低成本设备下,惯导系统其误差会随着时间不断积累。GNSS的定位范围广、精度高,其缺点是容易发生信号遮挡及干扰。因此惯导和GNSS特征具有互补性,将惯导和GNSS进行紧组合能够充分发挥这两个系统的优点。紧组合还能提高导航系统的精度与可靠性。但对于紧组合导航系统来说,当有遮挡或干扰等原因导致卫星信号短时间不可用时,系统只能工作在纯惯性导航的方式下,此时的导航精度决定于惯导器件精度和GNSS失效前一时刻紧组合导航的精度。由于低成本惯导系统误差随时间积累且得不到校正,导航精度将会迅速降低甚至完全不可用。
紧组合导航系统在GNSS失效时精度快速降低的主要因为缺乏外部观测的辅助条件下,先验来确定的惯导误差模型难以符合实际的情况。假如得到了当前时刻惯导的准确的误差模型,即便在GNSS信号受阻时,亦可使用此模型来计算惯导系统的误差,最终实现对惯导的误差补偿。神经网络具有良好的非线性映射能力,能模拟实际模型的输入输出。传统的神经网络例如:BP神经网络、多层感知器的神经网络、径向基函数的神经网络等都可以来推导惯导的误差模型,但这些神经网络都属于静态网络。这些神经网络结构不易准确地描述非线性系统的动态特性。
发明内容
针对上述现有技术,本发明要解决的技术问题是提供一种能够准确描述非线性系统的动态特性的GNSS信号受阻时Elman神经网络辅助紧组合导航方法,Elman神经网络是一种典型的多层动态递归神经网络,可对GNSS信号短暂受阻时的惯导误差信号进行预测,并用预测的数据来补偿修正惯性导航的输出。来期望在GNSS信号短暂缺失时,组合导航系统能继续提供导航数据。
为解决上述技术问题,本发明的一种GNSS信号受阻时Elman神经网络辅助紧组合导航方法,包括以下步骤:
步骤1:构建Elman神经网络模型并选择Elman神经网络隐藏层传递函数;
步骤2:设计Elman学习算法;
步骤3:构建紧组合卡尔曼滤波数学模型;
步骤4:当GNSS信号可用时,神经网络处于训练模式,将惯导系统输出的三维位置信息作为步骤2得到的神经网络训练的输入样本;将经过步骤3中卡尔曼滤波数学模型器融合后输出的惯导误差补偿值作为网络训练的期望输出样本,带入步骤2得到的Elman神经网络进行训练,当Elman神经网络实际输出与期望输出样本之间的误差值大于设定的阈值,循环利用步骤2中的Elman神经网络算法得到网络权值的更新值,直至网络的实际输出与期望的输出之间的误差小于设定的阈值;
步骤5:当GNSS信号缺失时,神经网络进入预测模式,以惯导系统输出的导航位置信息作为步骤4训练后的网络的输入,利用步骤4训练后的神经网络模型预测出惯导系统的误差值,利用该误差值修正惯导的导航输出,得到修正后的导航信息。
本发明还包括:
1.Elman神经网络包括输入层、隐藏层、连接层与输出层,Elman神经网络的数学模型为:
xh(k)=f(W1P(k)+W3x(k))
xc(k)=αxh(k-1)
y(k)=g(W2x(k))
式中向量P(k)表示Elman神经网络在k时间的输入向量,隐藏层的神经元在k时间下输出向量用xh(k)表示,xc(k)表示连接层在k时间的输出向量,y(k)表示整个网络输出层在k时间下的输出向量,W1,W2,W3分别是输入层到隐藏层,隐藏层到输出层,连接层到隐藏层的之间的连接权值,f(·)与g(·)分別是隐藏层和输出层的传递函数,α为连接反馈增益因子。
2.步骤1所述Elman神经网络隐藏层传递函数为S型正切函数。
3.步骤2具体为:
Elman神经网络计算过程分如下两步:工作信号的正向传播过程与误差反向传播,工作信号正向传播过程的计算过程和Elman神经网络数学模型一致,计算出网络输出的信号y(k);
误差反向传播具体为:假设k时间下网络实际输出为y(k),同时网络的期望输出响应为yd(k),则定义网络的误差表达式为:
分别求出误差函数对每个连接权值偏导数,然后将误差函数Ek对隐藏层到输出层的链接权值W2求出偏导可以得到如下式:
式中i表示从第i个隐藏层神经元,为W2权值矩阵的i行,j表示第j个输出层神经元,为W2权值矩阵的j列;
将Ek对输入层到隐藏层的连接权值W1求偏导数可得到:
将Ek对连接层到隐藏层的连接权值W3求偏导数可以得到:
其中,l为连接层的第l个神经元;
可以得到各个权值的更新值:
其中:
4.步骤3具体为:
选取系统状态变量为15维分别为:
其中δpos为ECEF坐标系三个轴向上位置误差,δV为东北天坐标系下三个轴向上分别速度误差,为惯导系统下三个轴向上分别姿态误差,ε为三个姿态角误差,为3个方向加速度零偏,bclk为钟差,dclk为钟漂;
利用惯导系统推算得到的伪距与伪距率信息与GNSS每颗卫星的伪距与伪距的量测信息之差Z作为外部观测量,系统的量测方程如下:
H为观测矩阵,V为观测噪声,伪距为ρ,伪距率为
利用扩展卡尔曼滤波对组合导航进行滤波计算,具体过程如下:
状态的一步预测:
Xk,k-1=φk,k-1Xk-1
状态估计:
Xk=Xk,k-1+Kk[Zk-hk(Xk,k-1)]
一步预测误差方差阵:
滤波增益矩阵:
估计误差方差阵:
Pk=(I-KkHK)Pk,k-1
式中φ为误差的状态转移矩阵,K为卡尔曼增益矩阵,P为误差协方差阵,R为噪声协方差阵;
经过上述卡尔曼滤波计算,得到经过修正以后的3个方向上的位置信息X,把修正前后的位置之差带入设计好的Elman神经网络中,作为神经网络训练时的输出量。
5.步骤4具体为:网络训练时,网络的输入、输出神经元数选取ECEF坐标系下三个方向上的位置参数个数,即m=3;隐藏层中神经元个数取I=3;网络的输入值是组合导航系统的纯惯性导航输出的位置信息网络目标输出值是紧组合系统滤波后的补偿惯性导航位置ΔE,根据输入输出的样本训练网络,带入步骤2中构建完成的Elman神经网络中的y(k)与yd(k)中进行训练,训练完成后则可以获得神经网络修正后的输出值关系如下:
将ΔE中的数据保存到Elman神经网络模型中,在修正时,调取相应的采样时刻的误差数据ΔE,完成神经网络对惯导的误差进行修正:
要进行预测时,需要的补偿的是惯导误差后的ECEF坐标系下3个方向位置为所以
根据训练完成的网络对组合导航中状态预报估值进行实时修正,修正过程中,利用代替组合系统EKF滤波器的状态变量
本发明有益效果:Elman神经网络是一种典型的多层动态递归神经网络,可对GNSS信号短暂受阻时的惯导误差信号进行预测,并用预测的数据来补偿修正惯性导航的输出。来期望在GNSS信号短暂缺失时,组合导航系统能继续提供导航数据。
本发明针对GNSS信号受阻时的紧组合导航问题,动态Elman神经网络预测模型,来对惯导的误差模型和GNSS的补偿模型进行学习;当GNSS信号缺失时,利用训练好的神经网络预测出GNSS的输出误差并补偿惯导的输出,使误差不会急剧发散,让系统继续进行组合导航。最后利用设计的低成本下的紧组合导航模块进行实地测量,将采集的信息进行预处理,组成训练神经网络的样本数据对Elman神经网络模型进行训练。本算法能在GNSS信号缺失100s的情况进行预测,使系统仍然能进行紧组合导航。
附图说明
图1为Elman神经网络拓扑图;
图2为S型对数函数;
图3为S型正切函数;
图4为线性函数;
图5为Elman神经网络训练;
图6为Elman神经网络预报过程;
图7为GNSS受阻前X轴位置误差图;
图8为GNSS受阻前Y轴位置误差图;
图9为GNSS受阻前Z轴位置误差图;
图10为GNSS受阻后X轴位置误差图;
图11为GNSS受阻后Y轴位置误差图;
图12为GNSS受阻后Z轴位置误差图;
图13为Elman学习次数与精度图;
图14为GNSS受阻后Elman神经网络预测X轴位置误差图;
图15为GNSS受阻后Elman神经网络预测Y轴位置误差图;
图16为GNSS受阻后Elman神经网络预测Z轴位置误差图;
具体实施方式
下面结合附图对本发明具体实施方式做进一步说明。
本发明提出的是一种在GNSS信号受阻下Elman神经网络辅助紧组合算法,为了在GNSS信号短暂缺失时,组合导航系统能继续提供导航数据。采取合适的隐藏层函数构建Elman神经网络模型。在GNSS信号受阻情况下利用Elman神经网络模型继续完成紧组合的导航定位。
具体的步骤如下:
步骤一:构建Elman神经网络模型并选择Elman神经网络隐藏层传递函数。
步骤二:设计Elman学习算法。
步骤三:构建紧组合卡尔曼滤波数学模型。
步骤四:将步骤三中构建好紧组合的卡尔曼滤波输入与输出带入步骤二中进行学习,学习完成后在GNSS信号受阻下带入惯导位置信息进入神经网络中,获得输出后完成Elman神经网络辅助紧组合算法。
(1)步骤一的具体内容如下:
附图1所示为本文设计的Elman神经网络结构。Elman神经网络属于反馈型的神经网络,它主要由输入层、隐藏层、连接层与输出层四层构成。连接层主要性质是连接了隐藏层的输出与输入,它的实际作用是将隐藏层的前一时刻的输出进行记忆并且保存下来,并且在当前时刻与新的输入一起作为隐藏层的输入,作用相当于一阶的延迟算子。通过连接层的延迟算子,会使得网络对历史数据变得敏感,增强了系统处理动态信息的能力。正因为有了连接层的存在,才让Elman神经网络拥有动态的记忆能力,使之能有对时变特性的系统进行学习。
Elman神经网络的数学模型可以表示为:
xh(k)=f(W1P(k)+W3x(k)) (1)
xc(k)=αxh(k-1) (2)
y(k)=g(W2x(k)) (3)
式中向量P(k)表示Elman神经网络在k时间的输入向量,隐藏层的神经元在k时间下输出向量用xh(k)表示,xc(k)表示连接层在k时间的输出向量,y(k)表示整个网络输出层在k时间下的输出向量,W1,W2,W3分别是输入层到隐藏层,隐藏层到输出层,连接层到隐藏层的之间的连接权值矩阵。f(·)与g(·)分別是隐藏层和输出层的传递函数,α为连接反馈增益因子。
传递函数主要用来限制神经元的输出,让神经元输出值保持在一定范围内,所以也被称为压制函数。能用于神经网络中的传递函数有很多类型,例如附图2-图4中通常使用的S型对数函数,S型正切函数和线性函数等。从图中可以发现三个传递函数的输入值可以是任意范围的数值,他们区别在于输出的振幅压缩的范围不同。一般来说,传递函数通常是根据应用的需求来选择的。在本发明中神经网络的输入是惯导推算的位置坐标信息,输出是经过GNSS补偿位置信息。因此输入和输出数据有正有负,将原始数据归一化后,坐标分量是分布在[-1,1]之间的,所以隐含层神经元的输出也必须在[-1,1]之间,这里选择隐含层神经元的传递函数则选为S型正切函数。
(2)步骤二具体内容如下:
Elman神经网络主要的计算过程分如下两步:工作信号的正向传播过程与误差反向传播。工作信号正向传播过程的计算过程和它的数学模型一致,可计算出网络输出的信号y(k)。误差反向传播具体为:假设k时间下网络实际输出为y(k),同时网络的期望输出响应为yd(k),则定义网络的误差表达式为:
分别求出误差函数对隐藏层、输出层等不同层之间权值偏导数:误差函数Ek对隐藏层到输出层的链接权值W2矩阵求出偏导可以得到如下式
式中i表示从第i个隐藏层神经元,为W2权值矩阵的i行,j表示第j个输出层神经元,为W2权值矩阵的j列
将Ek对输入层到隐藏层的连接权值W1求偏导数可得到:
类似的,将Ek对连接层到隐含层的连接权值W3求偏导数可以得到:
l为连接层的第l个神经元。
可以得到各个权值的更新值:
其中:
(3)步骤三具体内容如下:
设计完成Elman的网络结构,然后设计INS与GPS紧组合中的卡尔曼滤波。以便把滤波前后位置信息作为神经网络的输入与输出来训练神经网络。根据紧组合中INS与GPS误差方程,首先设计紧组合的卡尔曼滤波方程。选取系统状态变量为15维分别为:
其中δpos为ECEF坐标系三个下位置误差,δV为东北天坐标系下速度误差,为惯导系统下3个姿态误差ε为三个姿态角误差,为3个方向加速度零偏,bclk为钟差dclk为钟漂。
利用惯导系统推算得到的伪距与伪距率信息与GNSS每颗卫星的伪距与伪距率的量测信息之差Z作为外部观测量,可得系统的量测方程如下:
H为观测矩阵,V为观测噪声,伪距为ρ,伪距率为
因为惯导与GNSS组合导航系统本身是非线性系统,如果误差较小,惯导姿态误差一般会使用线性误差的状态方程,但是当惯性设备精度差或者惯性导航系统角度误差偏大时,则导航系统中的非线性因素不容忽视,就需要利用非线性的滤波算法对组合导航进行处理。EKF(Extended Kalman Filter,扩展卡尔曼滤波)通过扩展方法线性化进行组合滤波计算。具体过程如下:
状态的一步预测
Xk,k-1=φk,k-1Xk-1 (17)
状态估计
Xk=Xk,k-1+Kk[Zk-hk(Xk,k-1)] (18)
一步预测误差方差阵
滤波增益矩阵
估计误差方差阵
Pk=(I-KkHK)Pk,k-1 (21)
式中φ为误差的状态转移矩阵,K为卡尔曼增益矩阵,P为误差协方差阵,R为噪声协方差阵。
经过上述卡尔曼滤波计算,便可得到经过修正以后的3个方向上的位置信息X,把修正前后的位置之差以后带入设计好的Elman神经网络中,作为神经网络训练时的输出量。
(4)步骤四具体内容如下:
网络训练时,网络的输入、输出神经元数选取ECEF坐标系下三个方向上的位置参数个数,即m=3。隐藏层中神经元个数取I=3。网络的输入值是组合导航系统的纯惯性导航输出的位置信息网络目标输出值是紧组合系统滤波后的补偿惯性导航位置ΔE。根据输入输出的样本训练网络,带入步骤二中构建完成的Elman神经网络中的y(k)与yd(k)中进行训练,训练完成后则可以获得神经网络修正后的输出值关系如下:
将ΔE中的数据保存到Elman神经网络模型中。在修正时,只需要调取相应的采样时刻的误差数据ΔE即可,就能实现神经网络对惯导的误差进行修正:
要进行预测时,需要的补偿的是惯导误差后的ECEF坐标系下3个方向位置为所以
根据训练完成的网络对组合导航中状态预报估值进行实时修正,修正过程中,利用代替组合系统EKF滤波器的状态变量的修正。具体过程如附图5所示。
当GNSS信号可用时,神经网络处于训练模式,将惯导系统输出的三维位置信息作为网络训练的输入样本;将经过Kalman滤波器融合后输出的惯导误差补偿值作为网络训练的期望输出样本。当实际输出与期望输出之间的误差值大于设定的阈值(本专利设置为10-2满足导航误差要求),利用(2)中的网络权值更新算法更新各个神经元之间的权值信息,直到获得一组最优的权值集合,使得网络的实际输出与期望的输出之间的误差小于设定的阈值。
神经网络的预测过程如附图6所示。当GNSS信号缺失时,神经网络将进入预测模式,同样地,它以惯导系统输出的导航位置信息作为网络的输入;利用之前训练好的神经网络模型预测出惯导系统的误差值,并利用该误差值修正惯导的导航输出,为移动载体提供修正后的导航信息。
为了验证算法在实际应用中的可靠性,进行了实际测试实验,通过分析GNSS在信号受阻情况下的误差和在本发明的机器学习下,组合导航误差,最终结果验证了本算法的实际应用价值。
以下描述本发明的实施例:
为验证本文提出的基于外水平阻尼的双轴旋转惯导系统随机误差抑制技术对随机误差的抑制效果,本实验由GNSS模块ublox6、惯导模块HWT901和核心板STM32F4完成:
本次课题利用由维特智能公司将陀螺仪/磁强计/加速度计封装在一起的HWT901B模块与ublox的接收机相连,两个模块将数据通过串口发送到STM32F4,最后发送到电脑进行处理,保证了两个传感器时间对齐。HWT901B模块具体硬件指标如表1所示:
表1HWT901B模块具体硬件指标
实验一共采集500s数据,屏蔽后100s数据,以此来模拟信号受阻情况,屏蔽之前的位置误差如附图7-9所示:
屏蔽以后误差如附图10-图12:
从图中可以发现在400s时卫星信号受阻,因为采用低成本惯导器件,器件本身精度较低,只依靠惯导进行推位的导航系统开始迅速发散,误差增大致使系统完全无法定位。然后使用Elman神经网络算法进行学习,结果如附图13:
从图中可以看出,当学习次数到100次时,精度已经达到10-2,已接可以完全满足预测需要。本文设计的学习算法可以选择学习次数与到达精度,即使减少训练时间,选择50次,精度也可以达到10-1。当所有的样本实例的输出误差满足允许的范围时,网络训练结束。并且可以使用训练好的神经网络进行预测。预测完成位置误差结果如附图14-图16。
从图中可以发现,当GNSS信号受阻时,基于Elman预测三个方向位置误差与前面时刻相近,虽然到后面有一定的发散情况,但误差预测修正的位置误差仍在可接受范围内。这表明本文设计的GNSS信号受阻时,Elman补偿惯导信息效果明显,未出现图11-13中误差迅速发散的情况。实验验证了算法在实际应用中的可行性,可以充分的满足船舶的导航精度要求。

Claims (6)

1.一种GNSS信号受阻时Elman神经网络辅助紧组合导航方法,其特征在于,包括以下步骤:
步骤1:构建Elman神经网络模型并选择Elman神经网络隐藏层传递函数;
步骤2:设计Elman学习算法;
步骤3:构建紧组合卡尔曼滤波数学模型;
步骤4:当GNSS信号可用时,神经网络处于训练模式,将惯导系统输出的三维位置信息作为步骤2得到的神经网络训练的输入样本;将经过步骤3中卡尔曼滤波数学模型器融合后输出的惯导误差补偿值作为网络训练的期望输出样本,带入步骤2得到的Elman神经网络进行训练,当Elman神经网络实际输出与期望输出样本之间的误差值大于设定的阈值,循环利用步骤2中的Elman神经网络算法得到网络权值的更新值,直至网络的实际输出与期望的输出之间的误差小于设定的阈值;
步骤5:当GNSS信号缺失时,神经网络进入预测模式,以惯导系统输出的导航位置信息作为步骤4训练后的网络的输入,利用步骤4训练后的神经网络模型预测出惯导系统的误差值,利用该误差值修正惯导的导航输出,得到修正后的导航信息。
2.根据权利要求1所述的一种GNSS信号受阻时Elman神经网络辅助紧组合导航方法,其特征在于:
Elman神经网络包括输入层、隐藏层、连接层与输出层,Elman神经网络的数学模型为:
xh(k)=f(W1P(k)+W3x(k))
xc(k)=αxh(k-1)
y(k)=g(W2x(k))
式中向量P(k)表示Elman神经网络在k时间的输入向量,隐藏层的神经元在k时间下输出向量用xh(k)表示,xc(k)表示连接层在k时间的输出向量,y(k)表示整个网络输出层在k时间下的输出向量,W1,W2,W3分别是输入层到隐藏层,隐藏层到输出层,连接层到隐藏层的之间的连接权值,f(·)与g(·)分別是隐藏层和输出层的传递函数,α为连接反馈增益因子。
3.根据权利要求1所述的一种GNSS信号受阻时Elman神经网络辅助紧组合导航方法,其特征在于:步骤1所述Elman神经网络隐藏层传递函数为S型正切函数。
4.根据权利要求1所述的一种GNSS信号受阻时Elman神经网络辅助紧组合导航方法,其特征在于:步骤2具体为:
Elman神经网络计算过程分如下两步:工作信号的正向传播过程与误差反向传播,工作信号正向传播过程的计算过程和Elman神经网络数学模型一致,计算出网络输出的信号y(k);
误差反向传播具体为:假设k时间下网络实际输出为y(k),同时网络的期望输出响应为yd(k),则定义网络的误差表达式为:
分别求出误差函数对每个连接权值偏导数,然后将误差函数Ek对隐藏层到输出层的链接权值W2求出偏导可以得到如下式:
式中i表示从第i个隐藏层神经元,为W2权值矩阵的i行,j表示第j个输出层神经元,为W2权值矩阵的j列;
将Ek对输入层到隐藏层的连接权值W1求偏导数可得到:
将Ek对连接层到隐藏层的连接权值W3求偏导数可以得到:
其中,l为连接层的第l个神经元;
可以得到各个权值的更新值:
其中:
5.根据权利要求1所述的一种GNSS信号受阻时Elman神经网络辅助紧组合导航方法,其特征在于:步骤3具体为:
选取系统状态变量为15维分别为:
其中δpos为ECEF坐标系三个轴向上位置误差,δV为东北天坐标系下三个轴向上分别速度误差,为惯导系统下三个轴向上分别姿态误差,ε为三个姿态角误差,▽为3个方向加速度零偏,bclk为钟差,dclk为钟漂;
利用惯导系统推算得到的伪距与伪距率信息与GNSS每颗卫星的伪距与伪距的量测信息之差Z作为外部观测量,系统的量测方程如下:
H为观测矩阵,V为观测噪声,伪距为ρ,伪距率为
利用扩展卡尔曼滤波对组合导航进行滤波计算,具体过程如下:
状态的一步预测:
Xk,k-1=φk,k-1Xk-1
状态估计:
Xk=Xk,k-1+Kk[Zk-hk(Xk,k-1)]
一步预测误差方差阵:
滤波增益矩阵:
估计误差方差阵:
Pk=(I-KkHK)Pk,k-1
式中φ为误差的状态转移矩阵,K为卡尔曼增益矩阵,P为误差协方差阵,R为噪声协方差阵;
经过上述卡尔曼滤波计算,得到经过修正以后的3个方向上的位置信息X,把修正前后的位置之差带入设计好的Elman神经网络中,作为神经网络训练时的输出量。
6.根据权利要求1所述的一种GNSS信号受阻时Elman神经网络辅助紧组合导航方法,其特征在于:步骤4具体为:网络训练时,网络的输入、输出神经元数选取ECEF坐标系下三个方向上的位置参数个数,即m=3;隐藏层中神经元个数取I=3;网络的输入值是组合导航系统的纯惯性导航输出的位置信息网络目标输出值是紧组合系统滤波后的补偿惯性导航位置ΔE,根据输入输出的样本训练网络,带入步骤2中构建完成的Elman神经网络中的y(k)与yd(k)中进行训练,训练完成后则可以获得神经网络修正后的输出值关系如下:
将ΔE中的数据保存到Elman神经网络模型中,在修正时,调取相应的采样时刻的误差数据ΔE,完成神经网络对惯导的误差进行修正:
要进行预测时,需要的补偿的是惯导误差后的ECEF坐标系下3个方向位置为所以
根据训练完成的网络对组合导航中状态预报估值进行实时修正,修正过程中,利用代替组合系统EKF滤波器的状态变量
CN201910915008.3A 2019-09-26 2019-09-26 一种GNSS信号受阻时Elman神经网络辅助紧组合导航方法 Pending CN110487271A (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201910915008.3A CN110487271A (zh) 2019-09-26 2019-09-26 一种GNSS信号受阻时Elman神经网络辅助紧组合导航方法
US17/013,750 US11821729B2 (en) 2019-09-26 2020-09-07 Elman neural network assisting tight-integrated navigation method without GNSS signals

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910915008.3A CN110487271A (zh) 2019-09-26 2019-09-26 一种GNSS信号受阻时Elman神经网络辅助紧组合导航方法

Publications (1)

Publication Number Publication Date
CN110487271A true CN110487271A (zh) 2019-11-22

Family

ID=68544355

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910915008.3A Pending CN110487271A (zh) 2019-09-26 2019-09-26 一种GNSS信号受阻时Elman神经网络辅助紧组合导航方法

Country Status (2)

Country Link
US (1) US11821729B2 (zh)
CN (1) CN110487271A (zh)

Cited By (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111207734A (zh) * 2020-01-16 2020-05-29 西安因诺航空科技有限公司 一种基于ekf的无人机组合导航方法
CN111413719A (zh) * 2020-03-21 2020-07-14 哈尔滨工程大学 一种基于神经网络的北斗实时精密时钟预测方法
CN111796310A (zh) * 2020-07-02 2020-10-20 武汉北斗星度科技有限公司 一种基于北斗gnss的高精度定位方法、装置及系统
CN111854741A (zh) * 2020-06-16 2020-10-30 中国人民解放军战略支援部队信息工程大学 一种gnss/ins紧组合滤波器及导航方法
CN111913175A (zh) * 2020-07-02 2020-11-10 哈尔滨工程大学 一种传感器短暂失效下带补偿机制的水面目标跟踪方法
CN112505737A (zh) * 2020-11-16 2021-03-16 东南大学 一种基于Elman神经网络在线学习辅助的GNSS/INS组合导航方法
CN112902989A (zh) * 2021-05-07 2021-06-04 腾讯科技(深圳)有限公司 数据误差标定方法、装置、电子设备和存储介质
CN113467250A (zh) * 2021-07-27 2021-10-01 浙江中裕通信技术有限公司 基于北斗导航和数据驱动的船舶航向及其区域估计方法
CN113984043A (zh) * 2021-09-14 2022-01-28 哈尔滨工程大学 一种矿用惯导系统的动态误差修正方法
CN114136317A (zh) * 2022-02-07 2022-03-04 中国人民解放军军事科学院国防科技创新研究院 一种基于纯惯性测量的水下长航程导航定位方法及装置
CN114216459A (zh) * 2021-12-08 2022-03-22 昆山九毫米电子科技有限公司 Elm辅助的gnss/ins组合导航无人靶车定位方法
CN114742265A (zh) * 2022-03-09 2022-07-12 大连海事大学 一种vhf信号传播路径误差预测方法及系统
CN116224407A (zh) * 2023-05-06 2023-06-06 山东科技大学 一种gnss和ins组合导航定位方法及系统
CN116269450A (zh) * 2023-03-21 2023-06-23 苏州海臻医疗器械有限公司 一种基于肌电信号的患者肢体康复状态评估系统及方法
CN116499469A (zh) * 2023-06-28 2023-07-28 北京航空航天大学 利用神经网络模型在线学习和补偿的gnss/ins组合导航方法
US12019170B1 (en) 2023-05-06 2024-06-25 Shandong University Of Science And Technology GNSS and INS integrated navigation positioning method and system thereof

Families Citing this family (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113124884B (zh) * 2021-04-16 2023-04-18 智道网联科技(北京)有限公司 基于lstm神经网络模型的车辆定位方法及装置
CN113949999B (zh) * 2021-09-09 2024-01-30 之江实验室 一种室内定位导航设备和方法
CN114018250B (zh) * 2021-10-18 2024-05-03 杭州鸿泉物联网技术股份有限公司 惯性导航方法、电子设备、存储介质和计算机程序产品
CN114690221A (zh) * 2021-12-22 2022-07-01 北京航天时代激光导航技术有限责任公司 一种基于小波阈值法的Elman神经网络与卡尔曼融合滤波算法
CN114626474A (zh) * 2022-03-21 2022-06-14 厦门大学 一种基于概率神经网络的车辆电源状态检测方法及系统
CN115112121B (zh) * 2022-03-28 2023-03-03 浙江德清知路导航科技有限公司 基于数据与模型结合的多源融合定位方法、系统及终端
CN114745674B (zh) * 2022-04-27 2024-06-07 上海鼎为物联技术有限公司 一种基于改进bp神经网络的测距模型定位算法
CN114966762B (zh) * 2022-05-18 2024-05-28 中国人民解放军空军工程大学 一种gnss/ins紧组合导航系统的故障检测方法
CN114689047B (zh) * 2022-06-01 2022-09-13 鹏城实验室 基于深度学习的组合导航方法、装置、系统及存储介质
CN115358319B (zh) * 2022-08-23 2023-06-16 天津大学 基于双阈值检测的自适应容错滤波方法及系统
CN115474269B (zh) * 2022-08-25 2024-05-17 武汉大学 可见光阵列基站与普通基站混合定位装置、系统及方法
CN115201799A (zh) * 2022-09-09 2022-10-18 昆明理工大学 一种用于声呐的时变卡尔曼滤波跟踪方法
CN115790642A (zh) * 2022-10-13 2023-03-14 北京自动化控制设备研究所 一种mems惯导系统参数误差置信度评测方法
WO2024091865A1 (en) * 2022-10-24 2024-05-02 Ohio State Innovation Foundation Method for backward failure propagation in conceptual system design
CN115932913B (zh) * 2022-11-24 2024-03-08 国网思极位置服务有限公司 一种卫星定位伪距修正方法及装置
CN115932838B (zh) * 2022-12-12 2023-11-21 中山大学 一种基于神经网络的地波雷达与走航观测的数据校正方法
CN116242368B (zh) * 2023-05-11 2023-07-25 北京航空航天大学 一种基于偏振光场信息预测的偏振/惯性容错导航方法
CN116381753B (zh) * 2023-06-01 2023-08-15 北京航空航天大学 Gnss/ins组合导航系统在gnss中断时的神经网络辅助导航方法
CN117706583A (zh) * 2023-12-29 2024-03-15 无锡物联网创新中心有限公司 一种高精度定位方法及系统

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101566483A (zh) * 2009-05-22 2009-10-28 哈尔滨工程大学 光纤陀螺捷联惯性测量系统振动误差补偿方法
CN104898148A (zh) * 2015-06-02 2015-09-09 北京航空航天大学 一种基于数据压缩和神经网络的低成本ins/gps无缝导航方法
CN105446821A (zh) * 2015-11-11 2016-03-30 哈尔滨工程大学 一种基于改进神经网络的智能水下机器人推进器故障诊断方法
CN106980133A (zh) * 2017-01-18 2017-07-25 中国南方电网有限责任公司超高压输电公司广州局 利用神经网络算法补偿和修正的gps ins组合导航方法及系统
CN107390246A (zh) * 2017-07-06 2017-11-24 电子科技大学 一种基于遗传神经网络的gps/ins组合导航方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10466266B2 (en) * 2014-08-14 2019-11-05 University Of North Dakota Flight parameter prediction using neural networks

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101566483A (zh) * 2009-05-22 2009-10-28 哈尔滨工程大学 光纤陀螺捷联惯性测量系统振动误差补偿方法
CN104898148A (zh) * 2015-06-02 2015-09-09 北京航空航天大学 一种基于数据压缩和神经网络的低成本ins/gps无缝导航方法
CN105446821A (zh) * 2015-11-11 2016-03-30 哈尔滨工程大学 一种基于改进神经网络的智能水下机器人推进器故障诊断方法
CN106980133A (zh) * 2017-01-18 2017-07-25 中国南方电网有限责任公司超高压输电公司广州局 利用神经网络算法补偿和修正的gps ins组合导航方法及系统
CN107390246A (zh) * 2017-07-06 2017-11-24 电子科技大学 一种基于遗传神经网络的gps/ins组合导航方法

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
WENDEL J等: "Tightly coupled GPS/INS integration for missile applications", 《ELSEVIER》 *
徐田来等: "基于Elman神经网络的INS/GPS组合导航方法", 《AASRI-ITED2011》 *
赵正扬等: "车载低成本GNSS/SINS紧组合导航系统设计", 《测控技术》 *
赵雪峰: "卫星信号短暂缺失时的组合导航技术研究与实现", 《中国优秀硕士学位论文全文数据库 (信息科技辑)》 *

Cited By (29)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111207734A (zh) * 2020-01-16 2020-05-29 西安因诺航空科技有限公司 一种基于ekf的无人机组合导航方法
CN111207734B (zh) * 2020-01-16 2022-01-07 西安因诺航空科技有限公司 一种基于ekf的无人机组合导航方法
CN111413719A (zh) * 2020-03-21 2020-07-14 哈尔滨工程大学 一种基于神经网络的北斗实时精密时钟预测方法
CN111413719B (zh) * 2020-03-21 2022-07-15 哈尔滨工程大学 一种基于神经网络的北斗实时精密时钟预测方法
CN111854741A (zh) * 2020-06-16 2020-10-30 中国人民解放军战略支援部队信息工程大学 一种gnss/ins紧组合滤波器及导航方法
CN111854741B (zh) * 2020-06-16 2022-08-09 中国人民解放军战略支援部队信息工程大学 一种gnss/ins紧组合滤波器及导航方法
CN111796310A (zh) * 2020-07-02 2020-10-20 武汉北斗星度科技有限公司 一种基于北斗gnss的高精度定位方法、装置及系统
CN111913175A (zh) * 2020-07-02 2020-11-10 哈尔滨工程大学 一种传感器短暂失效下带补偿机制的水面目标跟踪方法
CN111796310B (zh) * 2020-07-02 2024-02-02 武汉北斗星度科技有限公司 一种基于北斗gnss的高精度定位方法、装置及系统
CN112505737B (zh) * 2020-11-16 2024-03-01 东南大学 一种gnss/ins组合导航方法
CN112505737A (zh) * 2020-11-16 2021-03-16 东南大学 一种基于Elman神经网络在线学习辅助的GNSS/INS组合导航方法
CN112902989B (zh) * 2021-05-07 2021-07-16 腾讯科技(深圳)有限公司 数据误差标定方法、装置、电子设备和存储介质
CN112902989A (zh) * 2021-05-07 2021-06-04 腾讯科技(深圳)有限公司 数据误差标定方法、装置、电子设备和存储介质
CN113467250A (zh) * 2021-07-27 2021-10-01 浙江中裕通信技术有限公司 基于北斗导航和数据驱动的船舶航向及其区域估计方法
CN113467250B (zh) * 2021-07-27 2022-01-07 浙江中裕通信技术有限公司 基于北斗导航和数据驱动的船舶航向及其区域估计方法
CN113984043B (zh) * 2021-09-14 2024-05-10 哈尔滨工程大学 一种矿用惯导系统的动态误差修正方法
CN113984043A (zh) * 2021-09-14 2022-01-28 哈尔滨工程大学 一种矿用惯导系统的动态误差修正方法
CN114216459A (zh) * 2021-12-08 2022-03-22 昆山九毫米电子科技有限公司 Elm辅助的gnss/ins组合导航无人靶车定位方法
CN114216459B (zh) * 2021-12-08 2024-03-15 昆山九毫米电子科技有限公司 Elm辅助的gnss/ins组合导航无人靶车定位方法
CN114136317B (zh) * 2022-02-07 2022-04-19 中国人民解放军军事科学院国防科技创新研究院 一种基于纯惯性测量的水下长航程导航定位方法及装置
CN114136317A (zh) * 2022-02-07 2022-03-04 中国人民解放军军事科学院国防科技创新研究院 一种基于纯惯性测量的水下长航程导航定位方法及装置
CN114742265B (zh) * 2022-03-09 2023-07-18 大连海事大学 一种vhf信号传播路径误差预测方法及系统
CN114742265A (zh) * 2022-03-09 2022-07-12 大连海事大学 一种vhf信号传播路径误差预测方法及系统
CN116269450B (zh) * 2023-03-21 2023-12-19 苏州海臻医疗器械有限公司 一种基于肌电信号的患者肢体康复状态评估系统及方法
CN116269450A (zh) * 2023-03-21 2023-06-23 苏州海臻医疗器械有限公司 一种基于肌电信号的患者肢体康复状态评估系统及方法
CN116224407A (zh) * 2023-05-06 2023-06-06 山东科技大学 一种gnss和ins组合导航定位方法及系统
US12019170B1 (en) 2023-05-06 2024-06-25 Shandong University Of Science And Technology GNSS and INS integrated navigation positioning method and system thereof
CN116499469A (zh) * 2023-06-28 2023-07-28 北京航空航天大学 利用神经网络模型在线学习和补偿的gnss/ins组合导航方法
CN116499469B (zh) * 2023-06-28 2023-09-08 北京航空航天大学 利用神经网络模型在线学习和补偿的gnss/ins组合导航方法

Also Published As

Publication number Publication date
US20210095965A1 (en) 2021-04-01
US11821729B2 (en) 2023-11-21

Similar Documents

Publication Publication Date Title
CN110487271A (zh) 一种GNSS信号受阻时Elman神经网络辅助紧组合导航方法
Shen et al. Observability analysis and adaptive information fusion for integrated navigation of unmanned ground vehicles
CN109373999B (zh) 基于故障容错卡尔曼滤波的组合导航方法
CN108827310B (zh) 一种船用星敏感器辅助陀螺仪在线标定方法
CN104406605B (zh) 机载多导航源综合导航仿真系统
CN104698485B (zh) 基于bd、gps及mems的组合导航系统及导航方法
CN109471146B (zh) 一种基于ls-svm的自适应容错gps/ins组合导航方法
CN105716610B (zh) 一种地磁场模型辅助的载体姿态和航向计算方法和系统
CN106885570A (zh) 一种基于鲁棒sckf滤波的紧组合导航方法
CN106681336B (zh) 基于容错处理的无人飞行器高度测量控制系统及控制方法
Sushchenko et al. Processing of redundant information in airborne electronic systems by means of neural networks
CN111024124B (zh) 一种多传感器信息融合的组合导航故障诊断方法
CN112146655B (zh) 一种BeiDou/SINS紧组合导航系统弹性模型设计方法
Sasiadek et al. Low cost automation using INS/GPS data fusion for accurate positioning
CN107643088A (zh) 无人机导航方法、装置、无人机及存储介质
Srinivas et al. Overview of architecture for GPS-INS integration
CN105547300A (zh) 用于auv的全源导航系统及方法
CN108508463B (zh) 基于Fourier-Hermite正交多项式扩展椭球集员滤波方法
CN110044385A (zh) 一种大失准角情况下的快速传递对准方法
CN105865441A (zh) 一种针对多源干扰系统的复合分层自适应滤波器
Zhang et al. A low-cost GPS/INS integration based on UKF and BP neural network
Jørgensen et al. Underwater position and attitude estimation using acoustic, inertial, and depth measurements
Haidong Neural network aided Kalman filtering for integrated GPS/INS navigation system
CN112697154A (zh) 一种基于矢量分配的自适应多源融合导航方法
CN116224407B (zh) 一种gnss和ins组合导航定位方法及系统

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication

Application publication date: 20191122

RJ01 Rejection of invention patent application after publication