CN105928518B - 采用伪距和位置信息的室内行人uwb/ins紧组合导航系统及方法 - Google Patents

采用伪距和位置信息的室内行人uwb/ins紧组合导航系统及方法 Download PDF

Info

Publication number
CN105928518B
CN105928518B CN201610231406.XA CN201610231406A CN105928518B CN 105928518 B CN105928518 B CN 105928518B CN 201610231406 A CN201610231406 A CN 201610231406A CN 105928518 B CN105928518 B CN 105928518B
Authority
CN
China
Prior art keywords
uwb
ins
navigation
east
north
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
CN201610231406.XA
Other languages
English (en)
Other versions
CN105928518A (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.)
University of Jinan
Original Assignee
University of Jinan
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 University of Jinan filed Critical University of Jinan
Priority to CN201610231406.XA priority Critical patent/CN105928518B/zh
Publication of CN105928518A publication Critical patent/CN105928518A/zh
Application granted granted Critical
Publication of CN105928518B publication Critical patent/CN105928518B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • 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/20—Instruments for performing navigational calculations
    • G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
    • 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)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

本发明公开了一种采用伪距和位置信息的室内行人UWB/INS紧组合导航系统及方法，包括：惯性导航器件INS、UWB定位标签、UWB参考节点、数据处理系统；所述惯性导航器件INS和UWB定位标签分别设置在行人的鞋子和身体上，所述UWB参考节点设置在任意位置，所述惯性导航器件INS和UWB定位标签分别与数据处理系统连接。本发明有益效果：通过将参考节点的位置信息引入状态变量中，并通过滤波器完成对参考节点位置信息的预估，减少了组合导航系统需要预先获取参考节点位置信息以及组合导航系统的定位精度依赖于预先获取到的参考节点位置信息精度的缺点。

Description

采用伪距和位置信息的室内行人UWB/INS紧组合导航系统及 方法
技术领域
本发明涉及复杂环境下组合定位技术领域，尤其涉及一种采用伪距信息和位置信息的室内行人UWB/INS紧组合导航系统及方法。
背景技术
近年来，行人导航(Pedestrian Navigation,PN)作为导航技术应用的新兴领域，正越来越受到各国学者的重视，并逐渐成为该领域的研究热点。然而在隧道、大型仓库、地下停车场等室内环境下，外界无线电信号微弱、电磁干扰强烈等因素都会对目标行人导航信息获取的准确性、实时性及鲁棒性有很大影响。如何将室内环境下获取的有限信息进行有效的融合以消除室内复杂环境影响，保证行人导航精度的持续稳定，具有重要的科学理论意义和实际应用价值。
在现有的定位方式中，全球卫星导航系统(Global Navigation SatelliteSystem,GNSS)是最为常用的一种方式。虽然GNSS能够通过精度持续稳定的位置信息，但是其易受电磁干扰、遮挡等外界环境影响的缺点限制了其应用范围，特别是在室内、地下巷道等一些密闭的、环境复杂的场景，GNSS信号被严重遮挡，无法进行有效的工作。近年来，UWB(Ultra Wideband)以其在复杂环境下定位精度高的特点在短距离局部定位领域表现出很大的潜力。学者们提出将基于UWB的目标跟踪应用于GNSS失效环境下的行人导航。这种方式虽然能够实现室内定位，但是由于室内环境复杂多变，UWB信号十分容易受到干扰而导致定位精度下降甚至失锁；与此同时，由于UWB采用的通信技术通常为短距离无线通信技术，因此若想完成大范围的室内目标跟踪定位，需要大量的网络节点共同完成，这必将引入网络组织结构优化设计、多节点多簇网络协同通信等一系列问题。因此现阶段基于UWB的目标跟踪在室内导航领域仍旧面临很多挑战。
在导航模型方面，目前在室内行人组合导航领域应用较多的为松组合导航模型。该模型具有容易实现的优点，但是需要指出的是，该模型的实现需要参与组合导航的多种技术能够独立的完成导航定位。例如，需要UWB设备能够提供行人的导航信息，这就要求目标行人所处的环境必须能够获取至少3个参考节点信息，这大大的降低了组合导航模型的应用范围，与此同时，参与导航的子技术独立完成定位，也引入了新的误差，不利于组合导航技术精度的提高。为了克服这一问题，学者们提出将紧组合模型应用于室内行人导航领域，紧组合模型直接将参与组合导航的子技术的原始传感器数据应用于最后的导航信息的解算，减少了子技术自行解算引入新误差的风险，提高了组合导航的精度，但是需要指出的是，紧组合导航模型需要提前获取参与组合的参考节点的精确位置信息，这限制了导航模型的灵活性。
发明内容
本发明的目的就是为了解决上述难题，提供了一种采用伪距和位置信息的室内行人UWB/INS紧组合导航系统及方法，该系统及方法无需提前获取参考节点的位置信息，而是将参考节点的位置信息引入状态变量中，并通过滤波器完成对参考节点位置信息的预估。
为实现上述目的，本发明的具体方案如下：
一种采用伪距和位置信息的室内行人UWB/INS紧组合导航系统，包括：
惯性导航器件INS：用于测量行人的位置、速度和姿态导航信息；
UWB定位标签：用于测量UWB定位标签与UWB参考节点之间的距离信息，即伪距信息；
UWB参考节点：预先放置在设定的位置，便于测量与定位标签之间的距离；
数据处理系统：用于对采集到的传感器数据进行数据融合；
所述惯性导航器件INS和UWB定位标签分别设置在行人的鞋子和身体上，所述UWB参考节点设置在任意位置，所述惯性导航器件INS和UWB定位标签分别与数据处理系统连接。
进一步地，所述数据处理系统包括迭代扩展卡尔曼滤波器，通过所述迭代扩展卡尔曼滤波器对惯性导航器件INS在本地相对坐标系中获取的目标行人的导航信息以及UWB定位标签在本地相对坐标系中获取的伪距信息进行数据融合。
一种采用伪距和位置信息的室内行人UWB/INS紧组合导航方法，包括：
(1)以惯性导航器件INS的误差向量和各UWB参考节点的东向和北向位置作为状态量，以惯性导航器件INS测量得到的目标行人的东向和北向位置信息的平方和与UWB定位标签测量得到的伪距的平方之差作为系统观测量，构建UWB/INS组合导航模型；
(2)利用所述UWB/INS组合导航模型，通过迭代扩展卡尔曼滤波器将惯性导航器件INS在本地相对坐标系中获取的目标行人的导航信息以及UWB定位标签在本地相对坐标系中获取的伪距信息进行数据融合；
最终得到当前时刻目标行人最优的导航信息以及参考节点位置的最优估计。
进一步地，作为状态量的惯性导航器件INS的误差向量以及各UWB参考节点的东向和北向位置的初值根据实际需要自行设定。
进一步地，所述迭代扩展卡尔曼滤波器的状态方程为：
其中，为15维INS误差向量；
为2M维参考节点坐标向量；M为参考节点数目；
为惯性导航器件INS测量得到的导航坐标系下目标行人的东向、北向和天向三个方向的加速度误差；
φk、φk+1分别为k时刻和k+1时刻惯性导航器件INS测量得到的导航坐标系下目标行人的横摇、纵摇和航向角误差；分别为k时刻和k+1时刻INS测量得到的导航坐标系下目标行人的东向、北向和天向三个方向的速度误差；分别为k时刻和k+1时刻导航坐标系下目标行人的东向、北向和天向三个方向的加速度误差；分别为k时刻和k+1时刻导航坐标系下目标行人的东向、北向和天向三个方向的角速度误差；分别为k时刻和k+1时刻导航坐标系下目标行人的东向、北向和天向三个方向的位置误差；
ωk为状态噪声；T为采样周期；I为单位矩阵；为从载体系到导航系的状态转移矩阵。
进一步地，所述迭代扩展卡尔曼滤波器的观测方程为：
其中，为k时刻INS解算的东向和北向位置；为k时刻INS解算的东向和北向位置误差；为k时刻UWB测量得到的未知节点到第i个参考节点之间的伪距；为第i个参考节点的坐标。
本发明的有益效果：
1、组合导航方法采用改进的INS/UWB紧组合模型，该模型以INS解算得到目标行人的东向和北向位置信息的平方和与UWB定位标签测量得到的伪距的平方之差作为系统观测量；在此基础上，通过迭代扩展卡尔曼滤波将INS和UWB获取的导航信息进行数据融合，最终得到当前时刻最优的导航信息和对参考节点位置信息的预估。
2、现有的紧组合定位方法需要预先获取参考节点的位置信息，在此基础上再做定位，那这就会出现一个问题，就是参考节点的位置信息的精度会对组合导航系统的精度有一定的影响。本发明方法将参考节点的位置信息加入到状态变量中，人工设定初值即可，不需要提前获取参考节点的位置信息就能够直接进行预估。
3、本发明通过将参考节点的位置信息引入状态变量中，并通过滤波器完成对参考节点位置信息的预估，减少了组合导航系统需要预先获取参考节点位置信息以及组合导航系统的定位精度依赖于预先获取到的参考节点位置信息精度的缺点。
4、可用于室内环境下的智能鞋子的中高精度定位。
附图说明
图1为采用伪距和位置信息的室内行人UWB/INS紧组合导航系统示意图；
图2为采用伪距和位置信息的室内行人UWB/INS紧组合导航方法的示意图。
具体实施方式：
下面结合附图对本发明进行详细说明：
一种采用伪距信息和位置信息的室内行人UWB/INS紧组合导航，如图1所示，包括：惯性导航器件INS、UWB定位标签、UWB参考节点和数据处理系统；
惯性导航器件INS和UWB定位标签分别设置在行人的鞋子和身体上，UWB参考节点设置在任意位置，惯性导航器件INS和UWB定位标签分别与数据处理系统连接。
其中，惯性导航器件INS：用于测量行人的位置、速度和姿态等导航信息；
UWB定位标签：用于测量UWB定位标签与参考节点之间的距离信息，即伪距信息；
UWB参考节点：预先放置在已知的位置，便于测量与定位标签之间的距离；
数据处理系统：用于对采集到的传感器数据进行数据融合。
数据处理系统包括迭代扩展卡尔曼滤波器，通过所述迭代扩展卡尔曼滤波器对惯性导航器件INS在本地相对坐标系中获取的目标行人的导航信息以及UWB定位标签在本地相对坐标系中获取的伪距信息进行数据融合。
一种面向室内行人的UWB/INS紧组合导航方法，如图2所示，包括：
(1)以惯性导航器件INS的误差向量和各UWB参考节点的东向和北向位置作为状态量，以惯性导航器件INS测量得到的目标行人的东向和北向位置信息的平方和与UWB定位标签测量得到的伪距的平方之差作为系统观测量，构建INS/UWB组合SLAM模型；
作为状态量的惯性导航器件INS的误差向量以及各UWB参考节点的东向和北向位置的初值根据实际需要自行设定，因此不需要预先获知各UWB参考节点的位置信息，避免了组合导航系统的定位精度依赖于预先获取到的参考节点位置信息精度的问题。
(2)通过迭代扩展卡尔曼滤波器将惯性导航器件INS和UWB定位标签在本地相对坐标系中获取的目标行人的导航信息进行数据融合；迭代扩展卡尔曼滤波器的输出即得到当前时刻目标行人最优的导航信息以及参考节点位置的最优估计。
根据INS/UWB组合SLAM模型，得到的迭代扩展卡尔曼滤波器的状态方程为：
其中，为15维INS误差向量；
为2M维参考节点坐标向量；M为参考节点数目；
为惯性导航器件INS测量得到的导航坐标系下的东向、北向和天向三个方向的加速度误差；
φk、φk+1分别为k时刻和k+1时刻惯性导航器件INS测量得到的导航坐标系下的横摇、纵摇和航向角误差；分别为k时刻和k+1时刻INS测量得到的导航坐标系下的东向、北向和天向三个方向的速度误差；分别为k时刻和k+1时刻导航坐标系下的东向、北向和天向三个方向的加速度误差；分别为k时刻和k+1时刻导航坐标系下的东向、北向和天向三个方向的角速度误差；分别为k时刻和k+1时刻导航坐标系下的东向、北向和天向三个方向的位置误差；
ωk为状态噪声；T为采样周期；I为单位矩阵；为从载体系到导航系的状态转移矩阵。
根据INS/UWB组合SLAM模型，得到的迭代扩展卡尔曼滤波器的观测方程为：
其中，为k时刻INS解算的东向和北向位置；为k时刻INS解算的东向和北向位置误差；为k时刻UWB测量得到的未知节点到第i个参考节点之间的伪距；为第i个参考节点的坐标。
上述虽然结合附图对本发明的具体实施方式进行了描述，但并非对本发明保护范围的限制，所属领域技术人员应该明白，在本发明的技术方案的基础上，本领域技术人员不需要付出创造性劳动即可做出的各种修改或变形仍在本发明的保护范围以内。

Claims (3)

1.一种采用伪距和位置信息的室内行人UWB/INS紧组合导航方法，其特征是，包括：
(1)以惯性导航器件INS的误差向量和各UWB参考节点的东向和北向位置作为状态量，以惯性导航器件INS测量得到的目标行人的东向和北向位置信息的平方和与UWB定位标签测量得到的伪距的平方之差作为系统观测量，构建UWB/INS组合导航模型；
(2)利用所述UWB/INS组合导航模型，通过迭代扩展卡尔曼滤波器将惯性导航器件INS在本地相对坐标系中获取的目标行人的导航信息以及UWB定位标签在本地相对坐标系中获取的伪距信息进行数据融合；
最终得到当前时刻目标行人最优的导航信息以及参考节点位置的最优估计；
所述迭代扩展卡尔曼滤波器的状态方程为：
其中，为15维INS误差向量；
为2M维参考节点坐标向量；M为参考节点数目；
为惯性导航器件INS测量得到的导航坐标系下目标行人的东向、北向和天向三个方向的加速度误差；
φk、φk+1分别为k时刻和k+1时刻惯性导航器件INS测量得到的导航坐标系下目标行人的横摇、纵摇和航向角误差；分别为k时刻和k+1时刻INS测量得到的导航坐标系下目标行人的东向、北向和天向三个方向的速度误差；分别为k时刻和k+1时刻导航坐标系下目标行人的东向、北向和天向三个方向的加速度误差；分别为k时刻和k+1时刻导航坐标系下目标行人的东向、北向和天向三个方向的角速度误差；分别为k时刻和k+1时刻导航坐标系下目标行人的东向、北向和天向三个方向的位置误差；
ωk为状态噪声；T为采样周期；I为单位矩阵；为从载体系到导航系的状态转移矩阵。
2.如权利要求1所述的一种采用伪距和位置信息的室内行人UWB/INS紧组合导航方法，其特征是，作为状态量的惯性导航器件INS的误差向量以及各UWB参考节点的东向和北向位置的初值根据实际需要自行设定。
3.如权利要求1所述的一种采用伪距和位置信息的室内行人UWB/INS紧组合导航方法，其特征是，所述迭代扩展卡尔曼滤波器的观测方程为：
其中，为k时刻INS解算的东向和北向位置；为k时刻INS解算的东向和北向位置误差；为k时刻UWB测量得到的未知节点到第i个参考节点之间的伪距；为第i个参考节点的坐标。
CN201610231406.XA 2016-04-14 2016-04-14 采用伪距和位置信息的室内行人uwb/ins紧组合导航系统及方法 Active CN105928518B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610231406.XA CN105928518B (zh) 2016-04-14 2016-04-14 采用伪距和位置信息的室内行人uwb/ins紧组合导航系统及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610231406.XA CN105928518B (zh) 2016-04-14 2016-04-14 采用伪距和位置信息的室内行人uwb/ins紧组合导航系统及方法

Publications (2)

Publication Number Publication Date
CN105928518A CN105928518A (zh) 2016-09-07
CN105928518B true CN105928518B (zh) 2018-10-19

Family

ID=56839026

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610231406.XA Active CN105928518B (zh) 2016-04-14 2016-04-14 采用伪距和位置信息的室内行人uwb/ins紧组合导航系统及方法

Country Status (1)

Country Link
CN (1) CN105928518B (zh)

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106680765B (zh) * 2017-03-03 2024-02-20 济南大学 基于分布式组合滤波ins/uwb行人导航系统及方法
CN106871893A (zh) * 2017-03-03 2017-06-20 济南大学 分布式ins/uwb紧组合导航系统及方法
CN107389060A (zh) * 2017-05-27 2017-11-24 哈尔滨工业大学 基于CKF的IMU/Wi‑Fi信号的超紧组合室内导航方法
CN107402375B (zh) * 2017-08-08 2020-05-05 济南大学 一种带观测时滞的室内行人定位efir数据融合系统及方法
CN109141412B (zh) * 2018-08-06 2020-09-22 济南大学 面向有数据缺失ins/uwb组合行人导航的ufir滤波算法及系统
CN108759825B (zh) * 2018-08-06 2020-05-05 济南大学 面向有数据缺失INS/UWB行人导航的自适应预估Kalman滤波算法及系统
CN109556602B (zh) * 2018-10-30 2021-02-05 何学苗 一种惯性导航方法、设备及计算机可读存储介质
CN109916401B (zh) * 2019-04-17 2021-03-12 济南大学 采用ls-svm辅助ekf滤波方法的分布式无缝紧组合导航方法及系统
CN110645979B (zh) * 2019-09-27 2021-09-21 北京交通大学 基于gnss/ins/uwb组合的室内外无缝定位方法
CN111256695B (zh) * 2020-01-14 2022-09-09 电子科技大学 基于粒子滤波算法的uwb/ins组合室内定位方法
CN112346006B (zh) * 2020-10-12 2024-08-30 深圳市航天华拓科技有限公司 定位方法、平台、终端、系统及存储介质
CN112525197B (zh) * 2020-11-23 2022-10-28 中国科学院空天信息创新研究院 基于图优化算法超宽带惯性导航融合位姿估计方法
CN113074739B (zh) * 2021-04-09 2022-09-02 重庆邮电大学 基于动态鲁棒容积卡尔曼的uwb/ins融合定位方法
CN113891245B (zh) * 2021-11-17 2024-04-26 西安邮电大学 一种火场消防员协同接力定位方法
CN116772903B (zh) * 2023-08-16 2023-10-20 河海大学 基于迭代ekf的sins/usbl安装角估计方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102494684A (zh) * 2011-11-11 2012-06-13 东南大学 一种基于wsn/mins组合导航的导航信息无偏紧组合方法
CN102636166A (zh) * 2012-05-02 2012-08-15 东南大学 基于航向角的wsn/ins组合导航系统及方法
CN103471595A (zh) * 2013-09-26 2013-12-25 东南大学 一种面向ins/wsn室内移动机器人紧组合导航的迭代扩展rts均值滤波方法
CN103968827A (zh) * 2014-04-09 2014-08-06 北京信息科技大学 一种可穿戴式人体步态检测的自主定位方法
EP2836791A2 (en) * 2012-03-30 2015-02-18 The University of Surrey Information determination in a portable electronic device carried by a user
CN104864865A (zh) * 2015-06-01 2015-08-26 济南大学 一种面向室内行人导航的ahrs/uwb无缝组合导航方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102494684A (zh) * 2011-11-11 2012-06-13 东南大学 一种基于wsn/mins组合导航的导航信息无偏紧组合方法
EP2836791A2 (en) * 2012-03-30 2015-02-18 The University of Surrey Information determination in a portable electronic device carried by a user
CN102636166A (zh) * 2012-05-02 2012-08-15 东南大学 基于航向角的wsn/ins组合导航系统及方法
CN103471595A (zh) * 2013-09-26 2013-12-25 东南大学 一种面向ins/wsn室内移动机器人紧组合导航的迭代扩展rts均值滤波方法
CN103968827A (zh) * 2014-04-09 2014-08-06 北京信息科技大学 一种可穿戴式人体步态检测的自主定位方法
CN104864865A (zh) * 2015-06-01 2015-08-26 济南大学 一种面向室内行人导航的ahrs/uwb无缝组合导航方法

Also Published As

Publication number Publication date
CN105928518A (zh) 2016-09-07

Similar Documents

Publication Publication Date Title
CN105928518B (zh) 采用伪距和位置信息的室内行人uwb/ins紧组合导航系统及方法
CN105509739B (zh) 采用固定区间crts平滑的ins/uwb紧组合导航系统及方法
CN106680765B (zh) 基于分布式组合滤波ins/uwb行人导航系统及方法
CN106871893A (zh) 分布式ins/uwb紧组合导航系统及方法
CN106052684B (zh) 采用多模式描述的移动机器人imu/uwb/码盘松组合导航系统及方法
CN109141413B (zh) 具有数据缺失uwb行人定位的efir滤波算法及系统
Zhao et al. Learning-based bias correction for time difference of arrival ultra-wideband localization of resource-constrained mobile robots
CN103471595B (zh) 一种面向ins/wsn室内移动机器人紧组合导航的迭代扩展rts均值滤波方法
CN107402375B (zh) 一种带观测时滞的室内行人定位efir数据融合系统及方法
CN104864865B (zh) 一种面向室内行人导航的ahrs/uwb无缝组合导航方法
CN108759825B (zh) 面向有数据缺失INS/UWB行人导航的自适应预估Kalman滤波算法及系统
CN109141412B (zh) 面向有数据缺失ins/uwb组合行人导航的ufir滤波算法及系统
CN205384029U (zh) 采用固定区间crts平滑的ins/uwb紧组合导航系统
Mu et al. A GNSS/INS-integrated system for an arbitrarily mounted land vehicle navigation device
CN109655060B (zh) 基于kf/fir和ls-svm融合的ins/uwb组合导航算法及系统
CN104374389B (zh) 一种面向室内移动机器人的imu/wsn组合导航方法
CN107703527B (zh) 一种基于北斗三频单历元宽巷/超宽巷的组合定位方法
CN104316058A (zh) 一种采用交互多模型的移动机器人wsn/ins组合导航方法
CN104296741B (zh) 采用距离平方和距离平方变化率的wsn/ahrs紧组合方法
CN109269498B (zh) 面向具有数据缺失uwb行人导航的自适应预估ekf滤波算法及系统
CN105115507B (zh) 一种基于双imu的双模式室内个人导航系统及方法
Bing et al. Two-stage UWB positioning algorithm of intelligent vehicle
CN111578939B (zh) 考虑采样周期随机变化的机器人紧组合导航方法及系统
CN104897157B (zh) 基于足部航姿参考和肩部电子罗盘的个人导航系统及方法
CN109916401B (zh) 采用ls-svm辅助ekf滤波方法的分布式无缝紧组合导航方法及系统

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