CN111272174B - 一种组合导航方法和系统 - Google Patents

一种组合导航方法和系统 Download PDF

Info

Publication number
CN111272174B
CN111272174B CN202010125661.2A CN202010125661A CN111272174B CN 111272174 B CN111272174 B CN 111272174B CN 202010125661 A CN202010125661 A CN 202010125661A CN 111272174 B CN111272174 B CN 111272174B
Authority
CN
China
Prior art keywords
navigation
covariance matrix
process noise
noise covariance
combined navigation
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
Application number
CN202010125661.2A
Other languages
English (en)
Other versions
CN111272174A (zh
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.)
Institute of Computing Technology of CAS
Original Assignee
Institute of Computing Technology of CAS
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 Institute of Computing Technology of CAS filed Critical Institute of Computing Technology of CAS
Priority to CN202010125661.2A priority Critical patent/CN111272174B/zh
Publication of CN111272174A publication Critical patent/CN111272174A/zh
Application granted granted Critical
Publication of CN111272174B publication Critical patent/CN111272174B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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/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
    • 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/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational 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

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)
  • Navigation (AREA)

Abstract

本发明公开了一种组合导航方法和系统,所述方法包括下述步骤:采集并存储组合导航系统最近的特定时长内的组合导航定位数据;计算当前组合导航定位误差,判断误差是否大于阈值;若定位误差大于阈值,构建初始惯导过程噪声协方差矩阵,对过程噪声协方差矩阵进行基于强化学习的自适应估计,得到过程噪声协方差矩阵最优估计;优化预测值与量测值的相对权重,输出调整后组合导航结果。本发明能够为单个具体惯导设备提供个性化的组合导航方案,避免对先验知识的依赖;所采用的模型学习能力强,调优速度快,解决了梯度回传困难的挑战;提高组合导航系统的定位准确度,在不同环境下具有强鲁棒性。

Description

一种组合导航方法和系统
技术领域
本发明属于导航控制技术领域,具体涉及一种组合导航方法和系统。
背景技术
近年来,高可靠性的自主导航系统越来越受到人们的关注。在行业需求方面,自主导航系统可用于移动测量,提供精密的定位定姿技术,为测绘行业带来革命性的变化;在大众需求方面,以智能手机,无人机,自动驾驶汽车,移动机器人为代表的智能化载体,在进行自主运动时,高度依赖精密位置信息,自主导航系统是其环境感知与决策控制的基础和核心。就自动驾驶而言,自主导航系统的市场潜力巨大。与巨大的市场潜力相对的是目前自动驾驶技术的不成熟,与其相关的精准定位技术仍有欠缺。目前定位-导航-授时(Position,Navigation,Timing,PNT)技术的重要发展方向,即为多传感器集成,多源异质信息融合。基于实时动态差分技术(Real-time Kinematic,RTK)和惯性导航系统(Inertial NavigationSystem,INS)的组合导航是目前主流的室外高精度算法。为了提高在复杂场景下,RTK不可用时的定位精度,近年来学者们提出了各种自适应算法,主要分为伪量测自适应估计,量测噪声协方差矩阵自适应估计和过程噪声协方差矩阵估计三个方面。伪量测自适应估计是指在卡尔曼滤波的过程中,通过训练好的模型对当前的量测值进行估计,用伪量测值进行卡尔曼滤波的量测更新,以减小组合导航过程中量测不可用时的定位误差。量测噪声协方差矩阵(R阵)是衡量当前量测的可靠度的方式。通过对其进行自适应学习,可以有效的衡量当前量测值和预测值在最终导航结果中的正确占比,从而得到较好的定位结果。本专利主要针对对过程噪声协方差矩阵(Q阵)进行自适应学习的情况,目的在于通过传感器数据自主自适应地得到最能表征当前惯性传感器状态的过程噪声协方差矩阵,从而摆脱过程噪声协方差矩阵对先验知识的依赖,减小温度,气压的变化对定位结果的影响。
过程噪声协方差矩阵由惯性测量单元(Inertial Measurement Unit,IMU)的性能决定。一般情况下,传感器器件在出厂时,商家都会给各个噪声参数一个初始值的范围,但该人工标定的值往往不能衡量当前器件的真实水平。由于自身特性,过程噪声协方差矩阵在一次导航过程中不会有太大的变化。但是由于会受到温度,气压等因素的影响,过程噪声协方差矩阵的估计也无法做到一劳永逸,需要对其进行自适应估计。但现有的组合导航方法中对过程噪声协方差矩阵的估计算法存在灵活性低,鲁棒性差,梯度反向传播困难的问题。
发明内容
针对现有技术中命名数据网络泛滥式缓存数据的问题,以及上述现有方案存在的不足,本发明提出了一种组合导航方法和系统。
为达到以上目的,一方面,本发明提出了一种组合导航方法,包括以下步骤:
步骤S1、采集并存储组合导航系统最近的特定时长内的组合导航定位数据;
步骤S2、计算当前组合导航定位误差,判断误差是否大于阈值;
步骤S3、若定位误差大于阈值,构建初始惯导过程噪声协方差矩阵,对过程噪声协方差矩阵进行基于强化学习的自适应估计,得到过程噪声协方差矩阵最优估计;
步骤S4:优化预测值与量测值的相对权重,输出调整后组合导航结果。
优选地,所述步骤S1的组合导航系统为基于卡尔曼滤波构建,作为强化学习模型的环境。
优选地,所述步骤S1的最近组合导航定位数据作为强化学习模型的训练数据,训练数据的时间长度由定位精度、训练所需时间和数据存储性能确定。
优选地,所述步骤S3的过程噪声协方差矩阵由过程噪声及其变化量确定,作为强化学习模型的状态,其定义为:
Figure BDA0002394318530000021
其中,过程噪声为:
Figure BDA0002394318530000022
wδr为位置游走系数,wδv
Figure BDA0002394318530000031
wq
Figure BDA0002394318530000032
wδkii分别速度、角度、角速率、加速度和比例误差随机游走;αk为过程噪声Wk变化量,作为强化学习模型的动作。
优选地,对所述步骤S3基于强化学习的自适应估计方法是在深度确定性策略梯度DDPG基础上,以所述步骤S1的组合导航数据为输入,以过程噪声协方差矩阵最优估计为输出,包括如下步骤:
步骤S31、构造动作评估网络和值评估网络;
步骤S32、初始化两个网络的权重;
步骤S33、初始化经验池大小和每轮训练数据个数。
步骤S34、对于每一轮的每组训练数据分别计算值评价网络和动作评价网络的梯度,并更新网络权值;
步骤S35、得到过程噪声协方差矩阵最优估计。
优选地,所述步骤S31的动作网络输入维度与所述状态的维度相等,输出维度与所述动作的维度相等;所述值评估网络输入由状态和动作共同构成,其维度为状态和动作维度之和,输出维度为1;
优选地,所述步骤S34包括如下步骤:
步骤S341、动作评估网络根据当前状态计算得到一个动作估计;
步骤S342、组合导航模型计算得到下一个状态;
步骤S343、计算过程噪声协方差矩阵,对定位误差取反得到奖励;
步骤S344、保存转换关系到经验池中;
步骤S345、当经验池样本数大于等于经验池容量时,通过随机采样确定训练集,分别计算值评估网络和动作评估网络梯度,并对动作目标网络和值目标网络参数进行更新。
另一方面,本发明还提供一种组合导航系统,至少包括组合导航模块和自适应估计模块,其中,
所述组合导航模块,被配置为基于卡尔曼滤波构建,能够提供实时导航结果,采集并存储组合导航系统最近的固定时长IMU和GNSS数据,计算定位误差并将数据发送至自适应估计模块,根据自适应估计输出调整后组合导航结果;
所述自适应估计模块,被配置为接收组合导航模块的数据,对过程噪声协方差矩阵进行基于强化学习的自适应估计,获得过程噪声协方差矩阵最优估计。
再一方面,本发明提供一种电子设备,包括中央处理器以及存储计算机可执行指令的存储器,所述计算机可执行指令在被执行时使所述处理器执行所述方法。
第四方面,本发明提供一种非易失性存储介质,其中存储有计算机程序,所述计算机程序在执行时实现所述方法。
本发明相对于现有技术取得了如下的技术效果:
本发明的方法和系统能够为单个具体惯导设备提供个性化的组合导航方案,避免对先验知识的依赖;所采用的模型学习能力强,调优速度快,解决了梯度回传困难的挑战;提高组合导航系统的定位准确度,在不同环境下具有强鲁棒性。
附图说明
以下,结合附图来详细说明本发明的实施例,其中:
图1示出本发明实施例的一种组合导航方法流程图;
图2示出本发明实施例的一种基于强化学习的组合导航系统示意图;
图3示出本发明实施例的DDPG算法应用在过程噪声协方差矩阵自适应估计的示意图;
图4示出本发明实施例的DDPG内部动作和值网络架构图;
图5示出本发明实施例的2019年7月17号数据轨迹图;
图6示出本发明实施例的学习到的Q阵在2019年7月17号数据上的导航误差累积概率图;
图7示出本发明实施例的2019年7月17号真值与组合导航结果对比图;
图8示出本发明实施例的不同算法在2019年7月17号GNSS/INS系统下GNSS缺失10s时的导航准确度对比图;
图9示出本发明实施例的不同算法在2019年7月10号GNSS/INS/ODO系统下GNSS缺失300s时的导航准确度对比图;
图10示出本发明实施例的不同算法在2019年7月10号GNSS/INS/NHC系统下GNSS缺失300s时的导航准确度对比图。
具体实施方式
下面结合附图和具体实施方式对本发明做进一步说明。
为了使本发明的目的、技术方案、设计方法及优点更加清楚明了,以下结合附图通过具体实施例对本发明进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。下面结合附图和具体实施方式对本发明作进一步描述。
首先给出本发明用到的缩略语和解释:
PNT:Position,Navigation,Timing,定位、导航、授时;
INS:Inertial Navigation System,惯性导航系统;
RTK:Real-time kinematic,实时动态载波相位差分技术;
IMU:Inertial Measurement Unit,惯性测量单元;
GPS:Global Positioning System,全球定位系统;
GNSS,Global Satellite Navigation System,全球卫星定位导航系统;
DDPG,Deep Deterministic Policy Gradient,深度确定性策略梯度,是针对连续行为的策略学习方法,该算法是Actor-Critic和DQN(Deep QNetwork,深度Q网络)的结合体,克服了Actor-Critic收敛慢的问题;
RL,Reinforcement Learning,强化学习,是利用环境反馈的奖励信息,通过试错法获得最优估计的算法框架,具有较强的自主探索能力。
实施例
本发明的技术方案涉及到如下几个方面:1)过程噪声协方差矩阵的取值对先验知识的依赖。在传统卡尔曼滤波组合导航算法中,过程噪声协方差矩阵Q和量测噪声协方差矩阵R的取值对卡尔曼滤波的性能有很大的影响。若使用有较大误差的Q阵和R阵,则必然会降低组合导航的准确度,甚至有时会导致滤波发散。在实际应用中,R矩阵的参数取值往往取决于当前收到GNSS量测的质量,而Q矩阵则依赖于特定IMU器件性能的先验知识。2)Q矩阵没有真值可做校准,且参与的计算极为复杂。过程噪声协方差矩阵依赖于传感器的固有性能,无法通过实验装置测得其真实值,只能通过当前时刻的定位误差来间接反映出当前所使用的Q矩阵的优劣。然而,Q矩阵在组合导航系统中参与的计算过于复杂。若要通过定位误差对Q矩阵的取值进行调整,需要克服梯度回传困难的挑战。3)Q矩阵的半正定性要求。Q矩阵实际上是传感器的噪声向量的协方差矩阵,组合导航系统要求该矩阵要时刻保持半正定性。因此,在对Q阵进行自适应估计的过程中,必须保证对过程噪声协方差矩阵预测的每一个状态都是半正定的。4)Q矩阵会随着环境的变化而变化。通常情况下,传感器生产厂商会提供某一类型号的IMU期间在标准工作环境(温度,湿度,气压等)下的默认Q参数。然而,同一类型号的不同器件本身的噪声性能并不能一概而论,而且器件的Q阵参数会随着工作环境而缓慢变化。为了提高组合导航系统的性能,并减小Q阵估计对先验知识的依赖,发明人对单个传感器的过程噪声协方差矩阵自适应估计进行了长期深入的研究。
根据本发明的一个实施例,提出一种组合导航方法(以下简称RL-AKF),如图1所示,该方法包括:首先,采集并存储组合导航系统最近的特定时长内的组合导航定位数据;其次,构建惯导过程噪声协方差矩阵差;计算当前组合导航定位误差,判断误差是否大于阈值;若定位误差大于阈值,对过程噪声协方差矩阵进行基于强化学习的自适应估计,得到过程噪声协方差矩阵最优估计,重新确定预测值与量测值权重,输出调整后组合导航结果;若定位误差小于等于阈值,直接输出组合导航结果。
进一步地,RL-AKF主要由基于卡尔曼滤波的嵌入式平台组合导航和基于增强学习的自适应过程噪声协方差矩阵估计模块两部分组成,该系统的架构如图2所示。卡尔曼滤波组合导航模块运行在嵌入式平台上,通过IMU和GNSS数据组合导航获取初步的实时导航结果,同时,采集并存储最接近当前时刻的N秒的IMU和GNSS数据。在有RTK固定解信号时,对当前的定位误差进行评判。若定位误差大于阈值,则将最近N秒的传感器数据发送到基于强化学习的过程噪声协方差矩阵自适应估计模块。该模块的目标是学习得到一个最优的过程噪声协方差矩阵,能使采集到的数据的定位误差最小。
强化学习的各元素定义和说明如下所示:
状态s:定义为当前的过程噪声向量W的取值,本实施例中待估计的目标矩阵Q是过程噪声向量W的协方差;
动作α:定义为噪声向量W的变化。由于共有6个不同的噪声来源构成了噪声向量W,所以α的维度也是6。显然的是,该问题中的动作是定义在连续的实数域空间上的,无法进行穷举;
奖励r:定义为定位误差的相反数,奖励值越高,说明当前的导航定位效果越好;
环境E:定义为GNSS/INS组合导航模型,一旦环境系统受到一个新的动作,它会更新当前的状态,并计算此时的定位误差获得奖励值,然后将状态,动作,奖励等一系列信息送到代理A。
代理A:该部分是强化学习中的自适应估计模块,本发明实施例使用DDPG算法来克服动作空间的连续性问题。
该部分的具体算法流程为:
Figure BDA0002394318530000071
传感器制造商通常会为一种型号的传感器提供一组默认值,本发明实施例给出过程噪声协方差矩阵的各分量含义及其对应型号的初始值:
Figure BDA0002394318530000072
Figure BDA0002394318530000073
上式中Wk表示过程噪声向量,包括了6种噪声组成,共有21维,Q是过程噪声向量的协方差矩阵,其各个组成部分的含义及其初始值如下表所示。
Figure BDA0002394318530000081
为了保证Q阵的半正定性,本发明将动作定义在过程噪声向量上而非直接改变Q矩阵对角线上的值。同时,为了保证噪声值是有意义的,应对每一个状态下的噪声向量进行非负限制。为了满足以上条件,本发明将Q矩阵的计算方法重新定义为:
Figure BDA0002394318530000082
当环境在当前状态值下,接收到新的动作时,Q阵的计算方法:
Figure BDA0002394318530000083
进一步地,过程噪声协方差矩阵的取值会极大的影响INS导航结果在组合导航系统中的性能,因此,组合导航系统会对当前的过程噪声协方差矩阵一个有效的反馈。本发明实施例将强化学习中的环境定义为基于卡尔曼滤波的组合导航系统。该系统会对当前的协方差矩阵的优劣进行评估,从而得到奖励值。当环境接收到状态更改的操作后,需要定义一个有效的奖励机制来评估当前的动作。对本问题而言,该系统将奖励建模为INS和GNSS组合导航系统在N秒内的定位误差的相反数。本实施例从N秒的数据中选出m个长度为l_m的数据段。为了模拟GNSS信号的缺失,在这些时间段内,不会进行GNSS的量测更新。计算每个数据段结束时的定位误差,统计其均方根,即可得到当前过程噪声协方差矩阵下的最终导航精度,其相反数也即为当前动作的奖励值。通过使奖励最大化,可以最终得到能够使定位误差最小的过程噪声协方差矩阵。
进一步地,该问题的动作空间定义在实数域空间
Figure BDA0002394318530000084
上。以下描述一种能够从连续空间中选择最优估计的网络架构DDPG。DDPG算法是一种基于确定性策略梯度的Model-Free算法,可以在连续的动作空间上执行。DDPG算法在自适应过程噪声协方差矩阵估计中的应用框架如图3所示。在每一轮中,DDPG都会执行一定的时间步长。在每个时间步,动作αi由ACTOR模块的动作评估网络进行选择。GNSS/INS集成导航模型执行此操作,计算奖励并将转换数据存储在经验池中。当其中存储的样本条数满足要求时,DDPG算法将随机抽取批量大小的训练样本,分别计算值评价网络和动作评价网络的梯度,然后更新网络权值进行下一轮计算。
DDPG算法的网络框架主要分为Actor和Critic两个部分,每个部分各有一个评估网络和目标网络。各个网络的功能定位如下:
Actor评估网络:负责策略网络参数的迭代更新,根据当前的过程噪声协方差矩阵值,选择当前调整方案,即当前动作,用于和环境交互生成下一时刻的过程噪声协方差矩阵和奖励值;
Actor目标网络:负责根据从经验池中采样的下一过程噪声协方差矩阵选择下一个最优动作,网络参数从Actor评估网络参数中定期复制;
Cri t ic评估网络:负责价值计算网络参数的迭代更新,负责从当前的过程噪声协方差矩阵,动作中计算当前的奖励值,,目标Q值yi=R+γQ′(S′,A′,w′);
Critic目标网络:负责计算Q值中的Q′(S′,A′,w′)部分,网络参数从Critic评估网络中定期复制。
以上算法是图2中“过程噪声协方差矩阵自适应学习”模块的具体实施方案。经过DDPG算法的模拟和学习,可以在当前的定位环境下获得最能表征当前IMU性能的过程噪声协方差矩阵值,从而反馈到嵌入式组合导航平台,进行高精度组合导航。
Figure BDA0002394318530000091
Figure BDA0002394318530000101
DDPG算法中所采用的网络架构为MLP(Multi-Layer Perception,多层感知机),但ACTOR部分和CRITIC部分的具体实现方法略有不同。由于该问题中的状态和动作的维度固定,所以两个网络结构也不会有变化,具体的网络结构图如图4所示。动作评估网络和动作目标网络是一个三层全连通网络。输入层的维数为21,隐含层的维数为30,接以ReLU激活函数。输出层的大小等于与动作的维度相同。最终,将tanh激活函数应用于输出层神经元,即可得到预测的动作,其网络结构如图4(a)所示。价值评估网络与价值目标网络的网络结构如图4(b)所示。输入维度是s_dim+a_dim=27。状态输入和动作输入分别获得30维隐藏层h1和h2。对两个激活层的值相加后的结果应用ReLU激活函数,得到隐含层的输出结果。最后,通过全连通层获得当前的值估计。
下面对本发明实施例的实验验证效果进行说明。
本发明实施例的RL-AKF算法在不同的训练序列长度上得到了不同的训练结果和定位性能。不同训练序列下所得到的优化Q矩阵罗列如下表所示,其中Q[1:3]恒为0。
Figure BDA0002394318530000111
不同的参数在测试集上的定位准确度可参见下表,其中,p、v、c分别表示位置,速度和航向角,*_67%和*_90%分别表示对误差序列进行排序后,67%处(即一倍中误差)和90%处的误差值。*_rms表示误差序列均方根,即root mean square。可以看出,定位误差会随着训练序列长度的变化而变化。一般来说,训练序列的长度越长,定位误差越小,同时,训练用时也会增长。以M39为例,当训练序列的长度从100s增加到200s时,定位误差降低了12.84%,而训练时长仅增加了0.36%。当训练序列长度增加到300s时,训练时长增加了29.32%,但定位误差仅减小了0.92%。SPAN-CPT设备上的实验结果也能得到类似的结论。训练序列的长度也会直接影响到嵌入式平台的存储容量需求。以SPAN-CPT设备为例,IMU的数据采集频率为100HZ,每条数据包含时间,三轴加速度和三轴陀螺仪。假设数据以32位的格式存储,则IMU数据每秒需要2.8KB的存储空间。GNSS信号采集频率为1Hz,每秒包含7个数据,分为时间,位置和速度。因此,GNSS数据每秒需要0.028KB的存储空间。若训练序列长度为N,则嵌入式平台需要2.828*N KB的额外存储空间。综合考虑定位准确度,训练时间和存储需求,本发明选定训练序列为200作为最终的测试方案。
Figure BDA0002394318530000121
当导航环境不发生明显变化时,同一个设备的过程噪声协方差矩阵也不会有明显的改变。为了测试在7月10号训练数据上学到的结果是否可以在一段时间内保持鲁棒性,本发明在2019年7月17号使用M39设备收集了另一组数据。该段数据从GPS时间294514s开始,采集至303058s,路线图如图5所示。可以看出,该路段中包含较多的直线和高速行驶路段,与训练数据集有很大的不同。图6绘制了从7月10号训练路段学习到的过程噪声协方差矩阵在7月17号整个路段上的导航误差累积概率分布图。从图中可以看出,经过10s的GNSS缺失后,90%的测试点定位误差都保持在亚米级,速度误差仅为0.11m/s。图7对比了组合导航系统的结果和真值的导航轨迹。图中星号表示组合导航系统对当前位置的预测,圆圈表示真值所在的位置。在三角区域代表的时刻,本系统将不执行GNSS量测更新用以模拟当前时间段GNSS信号的终端。为了显示定位细节,本发明截取了测试数据中299770至302500的时间段,这期间包括三种特殊情况:1)拔下GNSS天线100s,真实模拟GNSS信号的缺失;2)车辆以1m/s的速度缓慢转弯;3)GNSS位置漂移。试验结果表明,该组合导航系统在各种环境下都能实现有效定位。图8对比了不同算法在7月17号测试数据上的导航误差,对比数据如下表。
Figure BDA0002394318530000131
实验结果表明,本发明提出的RL-AKF算法整体表现良好,在67%处的定位误差仅为0.60米,Nelder-Mead算法的学习能力最弱,NN-feedback的定位误差与默认的过程噪声协方差矩阵相当。大量的实验表明,本发明所提出的RL-AKF算法在一段数据集上学习到的过程噪声协方差矩阵能够很好的反映当前设备的固有噪声水平,从而可以在一段时间内依然保持鲁棒性,避免了频繁的前后端数据传输需求。
在实际的定位场景中,GNSS中断时刻难以预测,中断的持续时间更是受到多方面因素的影响。为了评估本发明提出的RL-AKF算法在不同的GNSS终端时间周期下的定位精度,本发明分别比较了不同的算法在GNSS缺失10s,20s,…,60s时的定位误差。位置误差统计结果如下表所示,从表中可以看出,RL-AKF算法的定位误差与GNSS信号缺失时间之间存在二次项关系。采用Nelder-Mead算法学习到的过程噪声协方差矩阵在GNSS缺失较长时间时,会快速发散。Cov-Scale算法可以在一定程度上拟合传感器设备的固有噪声参数,降低定位误差。但从整体上来看,RL-AKF算法在全方位上优于其他算法。
Figure BDA0002394318530000141
根据所携带设备和定位场景的不同,组合导航系统中所用到的量测也随时可能变化。因此,作者希望从GNSS/INS系统中学习得到的过程噪声协方差矩阵也能对各种组合导航量测更新方案保持鲁棒性。里程计通过提供可靠,低噪声的速度量测,在组合导航领域得到的越来越多的重视。在GNSS信号缺失期间,可以为卡尔曼滤波系统提供可靠度高的速度量测更新。我们对比了从7月10号训练数据得到的过程噪声协方差矩阵在测试数据上使用GNSS/INS/ODO组合导航系统时的定位性能,误差对比结果如图9所示,下表给出了对比数据。由于里程计可以将二次发散的定位误差减小到线性发散,作者将GNSS信号缺失时间扩大至300s。从实验结果可以看出,RL-AKF相较于其他算法,能够获得更为准确的位置和航向估计。
Figure BDA0002394318530000142
NHC(Non-Holonomic Constraints,非完整性约束)是另一种被广泛应用于基于卡尔曼滤波的车辆导航系统中的量测更新方法。该方法假设车辆在载体坐标系中的右向速度和天向速度总保持为0。发明人在该部分比较了使用不同算法估计得到的过程噪声协方差矩阵在GNSS/INS/NHC组合导航系统下的定位误差,统计结果如图10所示,下表给出了对比数据。从实验结果可以看出,NHC提供的速度约束在一定程度上弱于ODO系统,但在GNSS缺失300s时,定位误差在67%处也仅有12.7米。整体来说,RL-AKF算法可以在GNSS/INS/NHC组合导航系统中保持鲁棒性。
Figure BDA0002394318530000151
最后所应说明的是,以上实施例仅用以说明本发明的技术方案而非限制。尽管参照实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,对本发明的技术方案进行修改或者等同替换,都不脱离本发明技术方案的精神和范围,其均应涵盖在本发明的权利要求范围当中。

Claims (10)

1.一种组合导航方法,其特征在于,包括下述步骤:
步骤S1、采集并存储组合导航系统最近的特定时长内的组合导航定位数据;
步骤S2、计算当前组合导航定位误差,判断误差是否大于阈值;
步骤S3、若定位误差大于阈值,构建初始惯导过程噪声协方差矩阵,对过程噪声协方差矩阵进行基于强化学习的自适应估计,得到过程噪声协方差矩阵最优估计;
步骤S4:优化预测值与量测值的相对权重,输出调整后组合导航结果。
2.根据权利要求1所述的一种组合导航方法,其特征在于,所述步骤S1的组合导航系统为基于卡尔曼滤波构建,作为强化学习模型的环境。
3.根据权利要求1或2所述的一种组合导航方法,其特征在于,所述步骤S1的最近组合导航定位数据作为强化学习模型的训练数据,训练数据的时间长度由定位精度、训练所需时间和数据存储性能确定。
4.根据权利要求1所述的一种组合导航方法,其特征在于,所述步骤S3的过程噪声协方差矩阵由过程噪声及其变化量确定,作为强化学习模型的状态,其定义为:
Figure FDA0003258373040000011
其中,过程噪声
Figure FDA0003258373040000012
wδr为位置游走系数,wδv
Figure FDA0003258373040000013
wq
Figure FDA0003258373040000014
wδkii分别速度、角度、角速率、加速度和比例误差随机游走;αk为过程噪声Wk变化量,作为强化学习模型的动作。
5.根据权利要求1所述的一种组合导航方法,其特征在于,对所述步骤S3基于强化学习的自适应估计方法是在深度确定性策略梯度DDPG基础上,以所述步骤S1的组合导航定位数据为输入,以过程噪声协方差矩阵最优估计为输出,包括如下步骤:
步骤S31、构造动作评估网络和值评估网络;
步骤S32、初始化两个网络的权重;
步骤S33、初始化经验池大小和每轮训练数据个数;
步骤S34、对于每一轮的每组训练数据分别计算值评价网络和动作评价网络的梯度,并更新网络权值;
步骤S35、得到过程噪声协方差矩阵最优估计。
6.根据权利要求5所述的一种组合导航方法,其特征在于,所述步骤S31的动作评估网络输入维度与状态的维度相等,输出维度与动作的维度相等;所述值评估网络输入由状态和动作共同构成,其维度为状态和动作维度之和,输出维度为1。
7.根据权利要求6所述的一种组合导航方法,其特征在于,所述步骤S34包括如下步骤:
步骤S341、动作评估网络根据当前状态计算得到一个动作估计;
步骤S342、组合导航模型计算得到下一个状态;
步骤S343、计算过程噪声协方差矩阵,对定位误差取反得到奖励;
步骤S344、保存转换关系到经验池中;
步骤S345、当经验池样本数大于等于经验池容量时,通过随机采样确定训练集,分别计算值评估网络和动作评估网络梯度,并对动作目标网络和值目标网络参数进行更新。
8.一种组合导航系统,其特征在于,至少包括组合导航模块和自适应估计模块,其中,
所述组合导航模块,被配置为基于卡尔曼滤波构建,能够提供实时导航结果,采集并存储组合导航系统最近的固定时长IMU和GNSS数据,计算定位误差,若定位误差大于阈值,构建初始惯导过程噪声协方差矩阵,并将数据发送至自适应估计模块,根据自适应估计输出调整后组合导航结果;
所述自适应估计模块,被配置为接收组合导航模块的数据,对过程噪声协方差矩阵进行基于强化学习的自适应估计,获得过程噪声协方差矩阵最优估计。
9.一种电子设备,包括中央处理器以及存储计算机可执行指令的存储器,其特征在于,所述计算机可执行指令在被执行时使所述处理器执行根据权利要求1-7中任一项所述的方法。
10.一种非易失性存储介质,其中存储有计算机程序,其特征在于,所述计算机程序在执行时实现权利要求1-7中任一项的方法。
CN202010125661.2A 2020-02-27 2020-02-27 一种组合导航方法和系统 Active CN111272174B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010125661.2A CN111272174B (zh) 2020-02-27 2020-02-27 一种组合导航方法和系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010125661.2A CN111272174B (zh) 2020-02-27 2020-02-27 一种组合导航方法和系统

Publications (2)

Publication Number Publication Date
CN111272174A CN111272174A (zh) 2020-06-12
CN111272174B true CN111272174B (zh) 2021-11-23

Family

ID=71004123

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010125661.2A Active CN111272174B (zh) 2020-02-27 2020-02-27 一种组合导航方法和系统

Country Status (1)

Country Link
CN (1) CN111272174B (zh)

Families Citing this family (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20210152549A (ko) 2019-05-01 2021-12-15 스위프트 내비게이션, 인크. 고-무결성 위성 포지셔닝을 위한 시스템 및 방법
WO2021202004A2 (en) 2020-02-14 2021-10-07 Swift Navigation, Inc. System and method for reconverging gnss position estimates
CN112082547B (zh) * 2020-09-08 2022-05-10 北京邮电大学 组合导航系统优化方法、装置、电子设备及存储介质
CN112362052B (zh) * 2020-10-27 2022-09-16 中国科学院计算技术研究所 一种融合定位方法及系统
CN112577521B (zh) * 2020-11-26 2023-11-17 北京邮电大学 一种组合导航误差校准方法及电子设备
US11550067B2 (en) 2020-12-17 2023-01-10 Swift Navigation, Inc. System and method for fusing dead reckoning and GNSS data streams
US11733397B2 (en) 2021-07-24 2023-08-22 Swift Navigation, Inc. System and method for computing positioning protection levels
WO2023167916A1 (en) 2022-03-01 2023-09-07 Swift Navigation, Inc. System and method for detecting outliers in gnss observations
WO2023167899A1 (en) 2022-03-01 2023-09-07 Swift Navigation, Inc. System and method for fusing sensor and satellite measurements for positioning determination
WO2024050094A1 (en) 2022-09-01 2024-03-07 Swift Navigation, Inc. System and method for determining gnss corrections
WO2024058999A1 (en) 2022-09-12 2024-03-21 Swift Navigation, Inc. System and method for gnss correction transmission
CN116222584B (zh) * 2023-05-10 2023-07-25 北京白水科技有限公司 群组导航定位中的分组信息的确定方法、装置及设备
CN117406258B (zh) * 2023-12-15 2024-03-05 深圳市智慧城市通信有限公司 一种基于北斗定位的电动自行车车道级管理装置
CN118443011A (zh) * 2024-05-17 2024-08-06 东南大学 一种基于强化学习的gnss/ins组合导航系统及方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101846734A (zh) * 2009-03-26 2010-09-29 中国农业大学 农用机械导航定位方法、系统及农用机械工控机
CN105652306A (zh) * 2016-01-08 2016-06-08 重庆邮电大学 基于航迹推算的低成本北斗与mems紧耦合定位系统及方法
CN106500695A (zh) * 2017-01-05 2017-03-15 大连理工大学 一种基于自适应扩展卡尔曼滤波的人体姿态识别方法
CN107014376A (zh) * 2017-03-01 2017-08-04 华南农业大学 一种适用于农业机械精准作业的姿态倾角估计方法
CN110196443A (zh) * 2019-06-06 2019-09-03 中国人民解放军战略支援部队信息工程大学 一种飞行器的容错组合导航方法及系统
CN110322017A (zh) * 2019-08-13 2019-10-11 吉林大学 基于深度强化学习的自动驾驶智能车轨迹跟踪控制策略
CN110727968A (zh) * 2019-09-19 2020-01-24 北京控制工程研究所 一种基于强化学习的导航滤波器参数优化方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA2701529C (en) * 2007-10-04 2017-07-25 Trusted Positioning Inc. System and method for intelligent tuning of kalman filters for ins/gps navigation applications

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101846734A (zh) * 2009-03-26 2010-09-29 中国农业大学 农用机械导航定位方法、系统及农用机械工控机
CN105652306A (zh) * 2016-01-08 2016-06-08 重庆邮电大学 基于航迹推算的低成本北斗与mems紧耦合定位系统及方法
CN106500695A (zh) * 2017-01-05 2017-03-15 大连理工大学 一种基于自适应扩展卡尔曼滤波的人体姿态识别方法
CN107014376A (zh) * 2017-03-01 2017-08-04 华南农业大学 一种适用于农业机械精准作业的姿态倾角估计方法
CN110196443A (zh) * 2019-06-06 2019-09-03 中国人民解放军战略支援部队信息工程大学 一种飞行器的容错组合导航方法及系统
CN110322017A (zh) * 2019-08-13 2019-10-11 吉林大学 基于深度强化学习的自动驾驶智能车轨迹跟踪控制策略
CN110727968A (zh) * 2019-09-19 2020-01-24 北京控制工程研究所 一种基于强化学习的导航滤波器参数优化方法

Also Published As

Publication number Publication date
CN111272174A (zh) 2020-06-12

Similar Documents

Publication Publication Date Title
CN111272174B (zh) 一种组合导航方法和系统
CN111780755B (zh) 一种基于因子图和可观测度分析的多源融合导航方法
Chen et al. A hybrid prediction method for bridging GPS outages in high-precision POS application
CN112577521B (zh) 一种组合导航误差校准方法及电子设备
CN110118560B (zh) 一种基于lstm和多传感器融合的室内定位方法
CN101285686B (zh) 一种农业机械导航分级定位的方法和系统
CN107255795A (zh) 基于ekf/efir混合滤波的室内移动机器人定位方法和装置
CN103644903A (zh) 基于分布式边缘无味粒子滤波的同步定位与地图构建方法
CN111275969B (zh) 一种基于道路环境智能识别的车辆轨迹填充方法
CN108931799A (zh) 基于递归快速正交搜索的列车组合定位方法及系统
CN111190211B (zh) 一种gps失效位置预测定位方法
US11650324B2 (en) Navigation apparatus and method in which measurement quantization errors are modeled as states
CN110954132A (zh) Grnn辅助自适应卡尔曼滤波进行导航故障识别的方法
CN113175931A (zh) 基于约束卡尔曼滤波的集群组网协同导航方法及系统
Du et al. A hybrid fusion strategy for the land vehicle navigation using MEMS INS, odometer and GNSS
Haidong Neural network aided Kalman filtering for integrated GPS/INS navigation system
CN116224407B (zh) 一种gnss和ins组合导航定位方法及系统
CN105180955A (zh) 机动车实时精准定位方法及装置
CN115014321B (zh) 一种基于自适应鲁棒滤波的仿生偏振多源融合定向方法
CN113503891B (zh) 一种sinsdvl对准校正方法、系统、介质及设备
Lai et al. Adaptive fuzzy neural network-aided progressive Gaussian approximate filter for GPS/INS integration navigation
CN117490675B (zh) 一种阵列式mems陀螺高精度抗干扰控制方法
CN115485527B (zh) 将测量值量化误差建模为状态的导航设备和方法
CN117687062A (zh) 列车融合定位方法、装置、电子设备及存储介质
CN115574813A (zh) 一种基于蓝牙和imu的室内定位方法、系统、设备及介质

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
GR01 Patent grant
GR01 Patent grant