CN109916401B - 采用ls-svm辅助ekf滤波方法的分布式无缝紧组合导航方法及系统 - Google Patents
采用ls-svm辅助ekf滤波方法的分布式无缝紧组合导航方法及系统 Download PDFInfo
- Publication number
- CN109916401B CN109916401B CN201910309551.9A CN201910309551A CN109916401B CN 109916401 B CN109916401 B CN 109916401B CN 201910309551 A CN201910309551 A CN 201910309551A CN 109916401 B CN109916401 B CN 109916401B
- Authority
- CN
- China
- Prior art keywords
- svm
- ins
- local
- assisted
- filter
- 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
Images
Landscapes
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种采用LS‑SVM辅助EKF滤波方法的分布式无缝紧组合导航方法及系统,包括:将INS和UWB分别测量的参考节点与目标节点之间的距离的平方做差,作为局部滤波器的观测量;通过局部滤波器得到目标节点的局部预估,主滤波将局部预估结果进行数据融合,最终得到目标节点的最优状态预估。本发明有益效果:通过LS‑SVM的辅助,使局部滤波器的观测量在UWB失锁过程中也能得到相应的预估,实现了分布式滤波算法的无缝预估。
Description
技术领域
本发明涉及复杂环境下组合定位技术领域,尤其涉及一种采用LS-SVM(最小二乘向量机)辅助EKF(扩展卡尔曼滤波器)滤波方法的分布式无缝紧组合导航方法及系统。
背景技术
近年来,行人导航(Pedestrian Navigation,PN)作为导航技术应用的新兴领域,正越来越受到各国学者的重视,并逐渐成为该领域的研究热点。然而在隧道、大型仓库、地下停车场等室内环境下,外界无线电信号微弱、电磁干扰强烈等因素都会对目标行人导航信息获取的准确性、实时性及鲁棒性有很大影响。如何将室内环境下获取的有限信息进行有效的融合以消除室内复杂环境影响,保证行人导航精度的持续稳定,具有重要的科学理论意义和实际应用价值。
在现有的定位方式中,全球卫星导航系统(Global Navigation SatelliteSystem,GNSS)是最为常用的一种方式。虽然GNSS能够通过精度持续稳定的位置信息,但是其易受电磁干扰、遮挡等外界环境影响的缺点限制了其应用范围,特别是在室内、地下巷道等一些密闭的、环境复杂的场景,GNSS信号被严重遮挡,无法进行有效的工作。
现有技术提出将基于UWB的目标跟踪应用于GNSS失效环境下的行人导航。这种方式虽然能够实现室内定位,但是由于室内环境复杂多变,UWB信号十分容易受到干扰而导致定位精度下降甚至失锁;与此同时,由于UWB采用的通信技术通常为短距离无线通信技术,因此若想完成大范围的室内目标跟踪定位,需要大量的网络节点共同完成,这必将引入网络组织结构优化设计、多节点多簇网络协同通信等一系列问题。因此现阶段基于UWB的目标跟踪在室内导航领域仍旧面临很多挑战。
发明人发现,在导航模型方面,目前在室内行人组合导航领域应用较多的为松组合导航模型。该模型具有容易实现的优点,但是需要指出的是,该模型的实现需要参与组合导航的多种技术能够独立的完成导航定位。例如,需要UWB设备能够提供行人的导航信息,这就要求目标行人所处的环境必须能够获取至少3个参考节点信息,这大大的降低了组合导航模型的应用范围,与此同时,参与导航的子技术独立完成定位,也引入了新的误差,不利于组合导航技术精度的提高。
现有技术提出将紧组合模型应用于室内行人导航领域,紧组合模型直接将参与组合导航的子技术的原始传感器数据应用于最后的导航信息的解算,减少了子技术自行解算引入新误差的风险,提高了组合导航的精度,但是需要指出的是,现有紧组合导航模型均使用集中式模式,这一方式系统容错能力差,并不利于日益精确复杂的组合导航模型。除此之外,目前的研究也很少考虑到分布式局部滤波器的观测量失锁的情况。
发明内容
为了解决上述问题,本发明提出了一种采用LS-SVM辅助EKF滤波方法的分布式无缝紧组合导航方法及系统,使局部滤波器的观测量在UWB失锁过程中也能得到相应的预估,实现了分布式滤波算法的无缝预估。
为了实现上述目的,本发明采用如下技术方案:
在一些实施方式中,采用如下技术方案:
采用LS-SVM辅助EKF滤波方法的分布式无缝紧组合导航方法,其特征在于,包括:
将INS和UWB分别测量的参考节点与目标节点之间的距离的平方做差,作为局部滤波器的观测量;
通过局部滤波器得到目标节点的局部预估,主滤波将局部预估结果进行数据融合,最终得到目标节点的最优状态预估。
进一步地,目标节点运行过程中,如果某一单个参考节点的观测信息出现失锁,利用LS-SVM算法构建INS解算的位置与INS解算的位置误差之间的映射关系,利用该映射关系对出现失锁的参考节点对应的局部滤波器的观测量进行预估,以补偿观测量的失锁。
进一步地,在UWB数据可用情况下,LS-SVM处于培训状态,INS位置误差作为LS-SVM的输入,主滤波器得到的当前时刻最优的INS位置误差预估作为LS-SVM的目标,以此构建两者之间的映射关系。
进一步地,在UWB数据不可用情况下,LS-SVM处于预估状态,以构建的两者之间的映射关系为基础,LS-SVM的输入与输出分别为INS位置误差和当前时刻最优的INS位置误差预估,通过LS-SVM预估的INS位置误差,作为失锁的参考节点对应的局部滤波器的观测量。
进一步地,第i个局部滤波器的状态方程具体为:
其中,分别为第i个局部滤波器在k时刻和k-1时刻预估的INS在东向和北向的位置误差;分别为第i个局部滤波器在k时刻和k-1时刻预估的INS在东向和北向的速度误差;T为采样时间;为k-1时刻的系统噪声,其协方差阵为Q(i)。
进一步地,第i个局部滤波器的观测方程为:
其中,为k时刻INS解算的东向和北向位置;为k时刻惯性导航器件测量得到的未知节点到第i个参考节点之间的距离;为k时刻UWB测量得到的未知节点到第i个参考节点之间的距离;为第i个参考节点的坐标,为观测噪声,其协方差阵为R(i)。
进一步地,主滤波将局部预估结果进行数据融合具体为:
进一步地,
在另一些实施方式中,采用如下技术方案:
一种采用LS-SVM辅助EKF滤波方法的分布式无缝紧组合导航系统,包括:INS、UWB和数据处理单元,所述数据处理单元包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现上述的采用LS-SVM辅助EKF滤波方法的分布式无缝紧组合导航方法。
在另一些实施方式中,采用如下技术方案:
一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行上述的采用LS-SVM辅助EKF滤波方法的分布式无缝紧组合导航方法。
与现有技术相比,本发明的有益效果是:
1、通过LS-SVM的辅助,使局部滤波器的观测量在UWB失锁过程中也能得到相应的预估,实现了分布式滤波算法的无缝预估。
2、可用于室内环境下的移动行人的中高精度定位。
附图说明
构成本申请的一部分的说明书附图用来提供对本申请的进一步理解,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。
图1为实施例一中INS/UWB组合导航系统示意图;
图2为实施例二中采用LS-SVM辅助EKF滤波方法的分布式无缝紧组合导航方法示意图。
具体实施方式
应该指出,以下详细说明都是例示性的,旨在对本申请提供进一步的说明。除非另有指明,本发明使用的所有技术和科学术语具有与本申请所属技术领域的普通技术人员通常理解的相同含义。
需要注意的是,这里所使用的术语仅是为了描述具体实施方式,而非意图限制根据本申请的示例性实施方式。如在这里所使用的,除非上下文另外明确指出,否则单数形式也意图包括复数形式,此外,还应当理解的是,当在本说明书中使用术语“包含”和/或“包括”时,其指明存在特征、步骤、操作、器件、组件和/或它们的组合。
术语解释:
UWB:超宽带,是一种不用载波,而采用时间间隔极短(小于1ns)的脉冲进行通信的方式,可利用其亚纳秒级超窄脉冲来做近距离精确室内定位。
INS:惯性导航系统,利用安装在运载体上的陀螺仪和加速度计来测定运载体位置,通过陀螺仪和加速度计的测量数据,可以确定运载体在惯性参考坐标系中的运动,同时也能够计算出运载体在惯性参考坐标系中的位置。
LS-SVM:最小二乘向量机。
EKF滤波器:扩展卡尔曼滤波器。
实施例一
在一个或多个实施方式中公开了一种采用LS-SVM辅助EKF滤波方法的分布式无缝紧组合导航系统,如图1所示,包括:INS、数据处理单元、UWB均固定在移动行人上,并且与数据处理单元连接。UWB用于检测移动行人与参考节点之间的距离;INS用于检测移动行人与参考节点之间的距离;数据处理单元用于对采集到的传感器数据进行数据融合。
其中,数据处理单元内设有EKF滤波器,其包括了若干局部滤波器和一个主滤波器,将超宽带(UWB)与惯性导航(INS)分别测量得到的参考节点与目标节点之间的距离平方的差作为局部滤波器的观测量,通过局部滤波器得到目标节点的局部预估,主滤波将局部预估进行数据融合,最终得到目标节点的最优的状态预估。目标节点运行过程中,一旦某一单个参考节点的观测信息出现失锁,首先利用LS-SVM算法构建INS解算的位置(导航系下的位置)与INS解算的位置误差之间的映射关系,并利用该映射关系对出现失锁的局部滤波器的观测量进行预估,以克服观测量的失锁,具体预估过程为:首先在培训阶段培训INS解算的位置和INS解算的位置误差之间的关系,然后在预测阶段,输入INS的位置,通过培训阶段构建的关系,预估INS的位置误差,然后由观测方程给出失锁的观测向量。
实施例二
在一个或多个实施方式中公开的一种采用LS-SVM辅助EKF滤波方法的分布式无缝紧组合导航方法,如图2所示,包括:
(1)算法采用联邦滤波结构,将超宽带(UWB)与惯性导航系统(INS)分别测量得到的参考节点与目标节点之间的距离平方的差作为局部滤波器的观测量,通过局部滤波器得到目标节点的局部预估,主滤波将局部预估进行数据融合,最终得到目标节点的最优的状态预估;
目标节点运行过程中,一旦某一单个参考节点的观测信息出现失锁,首先利用LS-SVM算法构建INS位置与其误差之间的映射关系,并利用该映射关系对出现失锁的局部滤波器的观测量进行预估,以克服观测量的失锁。
LS-SVM观测向量失锁补偿策略为:
在UWB数据可用情况下,LS-SVM处于培训状态,这种模式下,LS-SVM的输入与目标分别为INS位置误差和主滤波器得到的当前时刻最优的INS位置误差预估,以此构建两者之间的映射关系;
在UWB数据不可用情况下,LS-SVM处于预估状态,这种模式下,以上一阶段构建两者之间的映射关系为基础,LS-SVM的输入与输出分别为INS位置误差和当前时刻最优的INS位置误差预估,通过LS-SVM预估的INS位置误差,构建失锁的局部滤波器观测量。
(2)在组合导航数据处理部分使用的联邦EKF滤波算法,具体包括:
第i个局部滤波器的状态方程为:
其中,分别为第i个局部滤波器在k时刻和k-1时刻预估的INS在东向和北向的位置误差;分别为第i个局部滤波器在k时刻和k-1时刻预估的INS在东向和北向的速度误差;T为采样时间;为k-1时刻的系统噪声,其协方差阵为Q(i)。
第i个局部滤波器的观测方程为:
其中,为k时刻INS解算的东向和北向位置;为k时刻惯性导航器件测量得到的未知节点到第i个参考节点之间的距离;为k时刻UWB测量得到的未知节点到第i个参考节点之间的距离;为第i个参考节点的坐标,为观测噪声,其协方差阵为R(i)。
EKF的迭代方程为:
主滤波器的迭代方程,即主滤波将局部预估进行数据融合的过程为:
上述虽然结合附图对本发明的具体实施方式进行了描述,但并非对本发明保护范围的限制,所属领域技术人员应该明白,在本发明的技术方案的基础上,本领域技术人员不需要付出创造性劳动即可做出的各种修改或变形仍在本发明的保护范围以内。
Claims (6)
1.采用LS-SVM辅助EKF滤波方法的分布式无缝紧组合导航方法,其特征在于,包括:
将INS和UWB分别测量的参考节点与目标节点之间的距离的平方做差,作为局部滤波器的观测量;
通过局部滤波器得到目标节点的局部预估,主滤波将局部预估结果进行数据融合,最终得到目标节点的最优状态预估;
目标节点运行过程中,如果某一单个参考节点的观测信息出现失锁,利用LS-SVM算法构建INS解算的位置与INS解算的位置误差之间的映射关系,利用该映射关系对出现失锁的参考节点对应的局部滤波器的观测量进行预估,以补偿观测量的失锁;
第i个局部滤波器的状态方程具体为:
其中,分别为第i个局部滤波器在k时刻和k-1时刻预估的INS在东向和北向的位置误差;分别为第i个局部滤波器在k时刻和k-1时刻预估的INS在东向和北向的速度误差;T为采样时间;为k-1时刻的系统噪声,其协方差阵为Q(i);
在UWB数据可用情况下,LS-SVM处于培训状态,INS位置误差作为LS-SVM的输入,主滤波器得到的当前时刻最优的INS位置误差预估作为LS-SVM的目标,以此构建两者之间的映射关系;
在UWB数据不可用情况下,LS-SVM处于预估状态,以构建的两者之间的映射关系为基础,LS-SVM的输入与输出分别为INS位置误差和当前时刻最优的INS位置误差预估,通过LS-SVM预估的INS位置误差,作为失锁的参考节点对应的局部滤波器的观测量。
5.一种采用LS-SVM辅助EKF滤波方法的分布式无缝紧组合导航系统,其特征在于,包括:INS、UWB和数据处理单元,所述数据处理单元包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现权利要求1-4任一项所述的采用LS-SVM辅助EKF滤波方法的分布式无缝紧组合导航方法。
6.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行权利要求1-4任一项所述的采用LS-SVM辅助EKF滤波方法的分布式无缝紧组合导航方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910309551.9A CN109916401B (zh) | 2019-04-17 | 2019-04-17 | 采用ls-svm辅助ekf滤波方法的分布式无缝紧组合导航方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910309551.9A CN109916401B (zh) | 2019-04-17 | 2019-04-17 | 采用ls-svm辅助ekf滤波方法的分布式无缝紧组合导航方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109916401A CN109916401A (zh) | 2019-06-21 |
CN109916401B true CN109916401B (zh) | 2021-03-12 |
Family
ID=66977451
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910309551.9A Active CN109916401B (zh) | 2019-04-17 | 2019-04-17 | 采用ls-svm辅助ekf滤波方法的分布式无缝紧组合导航方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109916401B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112325880B (zh) * | 2021-01-04 | 2021-03-26 | 中国人民解放军国防科技大学 | 分布式平台相对定位方法、装置、计算机设备和存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102359787A (zh) * | 2011-07-15 | 2012-02-22 | 东南大学 | 一种wsn/mins高精度实时组合导航信息融合方法 |
CN102589550A (zh) * | 2012-01-12 | 2012-07-18 | 山东轻工业学院 | 一种应用联邦h∞滤波器实现组合导航精确定位的方法及系统 |
CN102636166A (zh) * | 2012-05-02 | 2012-08-15 | 东南大学 | 基于航向角的wsn/ins组合导航系统及方法 |
CN105928518A (zh) * | 2016-04-14 | 2016-09-07 | 济南大学 | 采用伪距和位置信息的室内行人uwb/ins紧组合导航系统及方法 |
CN106680765A (zh) * | 2017-03-03 | 2017-05-17 | 济南大学 | 基于分布式组合滤波ins/uwb行人导航系统及方法 |
-
2019
- 2019-04-17 CN CN201910309551.9A patent/CN109916401B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102359787A (zh) * | 2011-07-15 | 2012-02-22 | 东南大学 | 一种wsn/mins高精度实时组合导航信息融合方法 |
CN102589550A (zh) * | 2012-01-12 | 2012-07-18 | 山东轻工业学院 | 一种应用联邦h∞滤波器实现组合导航精确定位的方法及系统 |
CN102636166A (zh) * | 2012-05-02 | 2012-08-15 | 东南大学 | 基于航向角的wsn/ins组合导航系统及方法 |
CN105928518A (zh) * | 2016-04-14 | 2016-09-07 | 济南大学 | 采用伪距和位置信息的室内行人uwb/ins紧组合导航系统及方法 |
CN106680765A (zh) * | 2017-03-03 | 2017-05-17 | 济南大学 | 基于分布式组合滤波ins/uwb行人导航系统及方法 |
Non-Patent Citations (4)
Title |
---|
Distributed unbiased tightly-coupled INS/UWB human;XU Yuan 等;《Journal of Chinese Inertial Technology》;20170228;第81-85页 * |
RBF神经网络辅助的UWB/INS组合导航算法;徐爱功等;《导航定位学报》;20180904(第03期);第41-46页 * |
Tightly-coupled model for INS / WSN integrated navigation;Xu Yuan 等;《Journal of Southeast University》;20111231;第384-387页 * |
面向INS/WSN组合定位的分布式H_∞融合滤波器设计(英文);李庆华等;《Journal of Southeast University(English Edition)》;20120615(第02期);第164-168页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109916401A (zh) | 2019-06-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106680765B (zh) | 基于分布式组合滤波ins/uwb行人导航系统及方法 | |
CN109141413B (zh) | 具有数据缺失uwb行人定位的efir滤波算法及系统 | |
Shen et al. | Dual-optimization for a MEMS-INS/GPS system during GPS outages based on the cubature Kalman filter and neural networks | |
CN112268559B (zh) | 复杂环境下融合slam技术的移动测量方法 | |
Pei et al. | Optimal heading estimation based multidimensional particle filter for pedestrian indoor positioning | |
CN103471595B (zh) | 一种面向ins/wsn室内移动机器人紧组合导航的迭代扩展rts均值滤波方法 | |
CN105509739A (zh) | 采用固定区间crts平滑的ins/uwb紧组合导航系统及方法 | |
CN105716604A (zh) | 基于地磁序列的移动机器人室内定位方法及系统 | |
CN108759825B (zh) | 面向有数据缺失INS/UWB行人导航的自适应预估Kalman滤波算法及系统 | |
CN109141412B (zh) | 面向有数据缺失ins/uwb组合行人导航的ufir滤波算法及系统 | |
CN104180805A (zh) | 基于智能手机的室内行人定位与跟踪方法 | |
Deng et al. | Large-scale navigation method for autonomous mobile robot based on fusion of GPS and lidar SLAM | |
CN109655060B (zh) | 基于kf/fir和ls-svm融合的ins/uwb组合导航算法及系统 | |
Mu et al. | A GNSS/INS-integrated system for an arbitrarily mounted land vehicle navigation device | |
Jiang et al. | Smartphone PDR/GNSS integration via factor graph optimization for pedestrian navigation | |
CN205384029U (zh) | 采用固定区间crts平滑的ins/uwb紧组合导航系统 | |
CN109269498B (zh) | 面向具有数据缺失uwb行人导航的自适应预估ekf滤波算法及系统 | |
CN111964667B (zh) | 一种基于粒子滤波算法的地磁_ins组合导航方法 | |
CN112767545A (zh) | 一种点云地图构建方法、装置、设备及计算机存储介质 | |
CN114440880B (zh) | 基于自适应迭代ekf的施工现场控制点定位方法及系统 | |
CN104296741B (zh) | 采用距离平方和距离平方变化率的wsn/ahrs紧组合方法 | |
CN109916401B (zh) | 采用ls-svm辅助ekf滤波方法的分布式无缝紧组合导航方法及系统 | |
CN111578939B (zh) | 考虑采样周期随机变化的机器人紧组合导航方法及系统 | |
CN114777771A (zh) | 一种室外无人车组合导航定位方法 | |
CN113189541B (zh) | 一种定位方法、装置及设备 |
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 |