CN117031521A - Elastic fusion positioning method and system in indoor and outdoor seamless environment - Google Patents
Elastic fusion positioning method and system in indoor and outdoor seamless environment Download PDFInfo
- Publication number
- CN117031521A CN117031521A CN202311286965.7A CN202311286965A CN117031521A CN 117031521 A CN117031521 A CN 117031521A CN 202311286965 A CN202311286965 A CN 202311286965A CN 117031521 A CN117031521 A CN 117031521A
- Authority
- CN
- China
- Prior art keywords
- filter
- sub
- information
- observation vector
- indoor
- 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.)
- Granted
Links
- 230000004927 fusion Effects 0.000 title claims abstract description 40
- 238000000034 method Methods 0.000 title claims abstract description 33
- 239000013598 vector Substances 0.000 claims abstract description 107
- 238000005259 measurement Methods 0.000 claims abstract description 79
- 239000011159 matrix material Substances 0.000 claims abstract description 60
- 238000001514 detection method Methods 0.000 claims description 9
- 230000008569 process Effects 0.000 claims description 8
- 230000007704 transition Effects 0.000 abstract description 7
- 238000012937 correction Methods 0.000 description 6
- 238000012545 processing Methods 0.000 description 5
- 230000002159 abnormal effect Effects 0.000 description 3
- 238000004422 calculation algorithm Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000001914 filtration Methods 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000012360 testing method Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 239000005433 ionosphere Substances 0.000 description 2
- 230000005856 abnormality Effects 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000903 blocking effect Effects 0.000 description 1
- 238000010835 comparative analysis Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 238000002955 isolation Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000005295 random walk Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 239000005436 troposphere Substances 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
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/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/46—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being of a radio-wave signal type
-
- 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
-
- 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
- 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/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/35—Constructional details or hardware or software details of the signal processing chain
- G01S19/37—Hardware or software details of the signal processing chain
-
- 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/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02D—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE
- Y02D30/00—Reducing energy consumption in communication networks
- Y02D30/70—Reducing energy consumption in communication networks in wireless communication networks
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Automation & Control Theory (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
Description
技术领域Technical field
本发明涉及定位技术领域,具体的说,是涉及一种室内外无缝环境下的弹性融合定位方法及系统。The present invention relates to the field of positioning technology. Specifically, it relates to an elastic fusion positioning method and system in an indoor and outdoor seamless environment.
背景技术Background technique
本部分的陈述仅仅是提供了与本发明相关的背景技术信息,不必然构成在先技术。The statements in this section merely provide background technical information related to the present invention and do not necessarily constitute prior art.
随着城镇化和地下空间开发水平的不断提高,使得位置服务需要满足室内外不同场景下高精度和鲁棒定位的需求。对于导航系统来说,采用单一传感器往往无法满足室内外无缝定位的性能要求。With the continuous improvement of urbanization and underground space development, location services need to meet the needs of high-precision and robust positioning in different indoor and outdoor scenarios. For navigation systems, the use of a single sensor often cannot meet the performance requirements for seamless indoor and outdoor positioning.
全球导航卫星系统(Global Navigation Satellite System,GNSS)通过接收机对多颗卫星同时测距,实现对载体位置和速度的高精度计算;受限于落地功率电平,其信号易受室内及城市复杂环境遮挡,导致无法正常工作。The Global Navigation Satellite System (GNSS) uses receivers to simultaneously measure the distances of multiple satellites to achieve high-precision calculation of the carrier position and speed; limited by the ground power level, its signals are susceptible to indoor and urban complexities. Environmental occlusion prevents normal operation.
超宽带技术通过记录脉冲信号从移动站到基准站的双程传播时间来计算两者间的距离,要求至少存在4个可视基站才能有效定位;此方法易受室内外复杂观测环境影响,导致移动站可视范围内基站数量少于4个,从而影响定位成功率,且超宽带技术覆盖范围有限,无法实现广域定位。Ultra-wideband technology calculates the distance between the two by recording the two-way propagation time of the pulse signal from the mobile station to the base station. It requires the existence of at least 4 visible base stations for effective positioning; this method is susceptible to the influence of complex indoor and outdoor observation environments, resulting in The number of base stations within the visual range of the mobile station is less than 4, which affects the positioning success rate. Moreover, ultra-wideband technology has limited coverage and cannot achieve wide-area positioning.
通过将上述设备与捷联惯性导航系统(Strap-down Inertial NavigationSystem,SINS)位置域进行松组合,可以在GNSS或超宽带无法正常工作时,依靠纯SINS递推得到导航结果;缺点是当可观卫星数或基站数量少于4个时,由于GNSS或超宽带无法单独定位而无法进行组合,从而浪费了可能的观测信息,SINS位置误差会逐渐发散。By loosely combining the above equipment with the strap-down inertial navigation system (SINS) position domain, when GNSS or ultra-wideband cannot work properly, navigation results can be obtained by relying on pure SINS recursion; the disadvantage is that when satellites are visible When the number of base stations is less than 4, because GNSS or ultra-wideband cannot be positioned individually and cannot be combined, possible observation information is wasted, and the SINS position error will gradually diverge.
在量测域对GNSS、超宽带和SINS进行紧组合,可以有效利用仅存的观测信息,但在极端条件下,如仅有一座基站可视,此时产生的距离观测值不足以为SINS提供约束,导致定位误差偏大。5G基站通过信道参数估计算法获得信号到达时间(Time Of Arrival,TOA)和到达角(Angle Of Arrival,AOA)信息,缓解了观测值不足的问题,理论上单基站即可进行定位,通过与SINS组合可进一步降低恶劣观测环境对5G定位的影响;但,量测精度仍受环境影响,现有方法缺乏对观测值可用性进行评估,无法有效判断非视距(Non Line Of Sight,NLOS)误差。Tightly combining GNSS, ultra-wideband and SINS in the measurement domain can effectively utilize the remaining observation information. However, under extreme conditions, such as only one base station being visible, the distance observations generated at this time are not enough to provide constraints for SINS. , resulting in a large positioning error. The 5G base station obtains the signal Time of Arrival (TOA) and Angle of Arrival (AOA) information through the channel parameter estimation algorithm, which alleviates the problem of insufficient observation values. In theory, a single base station can perform positioning, and through SINS The combination can further reduce the impact of harsh observation environments on 5G positioning; however, measurement accuracy is still affected by the environment. Existing methods lack evaluation of the availability of observation values and cannot effectively judge Non Line of Sight (NLOS) errors.
发明内容Contents of the invention
本发明为了解决上述问题,本发明提供一种室内外无缝环境下的弹性融合定位方法及系统,有效隔离了传感器故障和非视距误差,在室内外过渡区域,卫星部分失锁的条件下,提高了定位精度相比。In order to solve the above problems, the present invention provides an elastic fusion positioning method and system in indoor and outdoor seamless environments, which effectively isolates sensor faults and non-line-of-sight errors. In the indoor and outdoor transition areas, the satellite is partially out of lock. , improved positioning accuracy compared to.
为了实现上述目的,本发明采用如下技术方案:In order to achieve the above objects, the present invention adopts the following technical solutions:
本发明的第一个方面提供一种室内外无缝环境下的弹性融合定位方法,其包括:The first aspect of the present invention provides an elastic fusion positioning method in indoor and outdoor seamless environments, which includes:
获取GNSS观测向量、基站观测向量和SINS推算的观测向量;Obtain the GNSS observation vector, base station observation vector and SINS calculated observation vector;
基于GNSS观测向量和基站观测向量,更新量测噪声协方差矩阵;Based on the GNSS observation vector and the base station observation vector, update the measurement noise covariance matrix;
将GNSS观测向量同SINS推算的观测向量一起输入第一子滤波器中作差,并结合量测噪声协方差矩阵和主滤波器分配的信息,进行量测信息更新;同时,将基站观测向量同SINS推算的观测向量输入第二子滤波器中作差,并结合量测噪声协方差矩阵和主滤波器分配的信息,进行量测信息更新;The GNSS observation vector and the SINS-derived observation vector are input into the first sub-filter for difference, and the measurement information is updated based on the measurement noise covariance matrix and the information allocated by the main filter; at the same time, the base station observation vector is combined with the The observation vector calculated by SINS is input into the second sub-filter for difference, and combined with the information of the measurement noise covariance matrix and main filter allocation, the measurement information is updated;
将第一子滤波器和第二子滤波器的更新的量测信息,在主滤波器中进行信息融合,得到最终定位结果,并按照信息分配准则将融合信息分配至第一子滤波器和第二子滤波器。The updated measurement information of the first sub-filter and the second sub-filter is fused in the main filter to obtain the final positioning result, and the fused information is distributed to the first sub-filter and the second sub-filter according to the information allocation criteria. Two sub-filters.
进一步地,所述GNSS观测向量包括伪距和载波相位。Further, the GNSS observation vector includes pseudorange and carrier phase.
进一步地,所述基站观测向量包括终端相对于基站的方位角、高度角和信号传播时间。Further, the base station observation vector includes the azimuth angle, altitude angle and signal propagation time of the terminal relative to the base station.
进一步地,所述更新量测噪声协方差矩阵的步骤为:Further, the step of updating the measurement noise covariance matrix is:
获取观测新息向量,结合判断阈值,计算方差膨胀因子;Obtain the observation innovation vector, combine it with the judgment threshold, and calculate the variance expansion factor;
将方差膨胀因子进行向量对角化后,更新量测噪声协方差矩阵。After vector diagonalizing the variance expansion factor, the measurement noise covariance matrix is updated.
进一步地,所述融合信息中的状态误差协方差矩阵为两个子滤波器得到的状态误差协方差矩阵的和的倒数;Further, the state error covariance matrix in the fusion information is the reciprocal of the sum of the state error covariance matrices obtained by the two sub-filters;
或者,所述融合信息中的噪声协方差矩阵为两个子滤波器得到的过程噪声协方差矩阵的和的倒数。Alternatively, the noise covariance matrix in the fusion information is the reciprocal of the sum of the process noise covariance matrices obtained by the two sub-filters.
进一步地,所述融合信息中的全局最优估计值与两个子滤波器得到的状态误差协方差矩阵、两个子滤波器得到的局部最优解和融合信息中的状态误差协方差矩阵相关。Further, the global optimal estimate in the fusion information is related to the state error covariance matrix obtained by the two sub-filters, the local optimal solution obtained by the two sub-filters and the state error covariance matrix in the fusion information.
进一步地,所述信息分配准则中的信息分配系数,根据GNSS的卫星分布的空间几何强度因子和载噪比进行调整。Further, the information distribution coefficient in the information distribution criterion is adjusted according to the spatial geometric intensity factor and carrier-to-noise ratio of the satellite distribution of GNSS.
本发明的第二个方面提供一种室内外无缝环境下的弹性融合定位系统,其包括:The second aspect of the present invention provides an elastic fusion positioning system in indoor and outdoor seamless environments, which includes:
数据获取模块,其被配置为:获取GNSS观测向量、基站观测向量和SINS推算的观测向量;A data acquisition module configured to: acquire GNSS observation vectors, base station observation vectors, and SINS-derived observation vectors;
故障检测模块,其被配置为:基于GNSS观测向量和基站观测向量,更新量测噪声协方差矩阵;A fault detection module configured to: update the measurement noise covariance matrix based on the GNSS observation vector and the base station observation vector;
量测信息更新模块,其被配置为:将GNSS观测向量同SINS推算的观测向量一起输入第一子滤波器中作差,并结合量测噪声协方差矩阵和主滤波器分配的信息,进行量测信息更新;同时,将基站观测向量同SINS推算的观测向量输入第二子滤波器中作差,并结合量测噪声协方差矩阵和主滤波器分配的信息,进行量测信息更新;The measurement information update module is configured to: input the GNSS observation vector and the SINS estimated observation vector into the first sub-filter for difference, and combine the measurement noise covariance matrix and the information allocated by the main filter to perform measurement The measurement information is updated; at the same time, the base station observation vector and the SINS-derived observation vector are input into the second sub-filter for difference, and the measurement information is updated based on the measurement noise covariance matrix and the information allocated by the main filter;
定位模块,其被配置为:将第一子滤波器和第二子滤波器的更新的量测信息,在主滤波器中进行信息融合,得到最终定位结果,并按照信息分配准则将融合信息分配至第一子滤波器和第二子滤波器。A positioning module configured to: fuse the updated measurement information of the first sub-filter and the second sub-filter in the main filter to obtain the final positioning result, and distribute the fused information according to the information distribution criteria. to the first sub-filter and the second sub-filter.
进一步地,所述GNSS观测向量包括伪距和载波相位。Further, the GNSS observation vector includes pseudorange and carrier phase.
进一步地,所述基站观测向量包括终端相对于基站的方位角、高度角和信号传播时间。Further, the base station observation vector includes the azimuth angle, altitude angle and signal propagation time of the terminal relative to the base station.
与现有技术相比,本发明的有益效果为:Compared with the prior art, the beneficial effects of the present invention are:
本发明提供了一种室内外无缝环境下的弹性融合定位方法,其在子滤波器中实现观测值层面的紧组合,同时设计故障检测与处理模块抑制异常观测值的影响,最后在主滤波器依据观测值质量进行动态的信息融合和分配,可以有效隔离传感器故障和非视距误差,在室内外过渡区域,卫星部分失锁的条件下,定位精度相比GNSS-SINS紧组合提高68%,有效作用范围相比基于GNSS、超宽带和SINS的组合导航算法更大,在室内外无缝环境下可以连续稳定工作,定位精度更高。The present invention provides an elastic fusion positioning method in indoor and outdoor seamless environments, which realizes tight combination of observation value levels in sub-filters, while designing fault detection and processing modules to suppress the influence of abnormal observation values, and finally in the main filter The sensor dynamically fuses and allocates information based on the quality of observation values, which can effectively isolate sensor faults and non-line-of-sight errors. In indoor and outdoor transition areas and under the condition that the satellite is partially out of lock, the positioning accuracy is improved by 68% compared to the GNSS-SINS tight combination. , the effective range is larger than the combined navigation algorithm based on GNSS, ultra-wideband and SINS, it can work continuously and stably in indoor and outdoor seamless environments, and the positioning accuracy is higher.
附图说明Description of the drawings
构成本发明的一部分说明书附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的限定。The accompanying drawings, which constitute part of the present invention, are used to provide a further understanding of the present invention. The illustrative embodiments of the present invention and their descriptions are used to explain the present invention and do not constitute a limitation of the present invention.
图1为本发明的实施例一的一种室内外无缝环境下的弹性融合定位方法的流程图。Figure 1 is a flow chart of a flexible fusion positioning method in an indoor and outdoor seamless environment according to Embodiment 1 of the present invention.
具体实施方式Detailed ways
下面结合附图与实施例对本发明作进一步说明。The present invention will be further described below in conjunction with the accompanying drawings and examples.
应该指出,以下详细说明都是示例性的,旨在对本发明提供进一步的说明。除非另有指明,本文使用的所有技术和科学术语具有与本发明所属技术领域的普通技术人员通常理解的相同含义。It should be noted that the following detailed description is exemplary and is intended to provide further explanation of the present invention. Unless defined otherwise, all technical and scientific terms used herein have the same meaning as commonly understood by one of ordinary skill in the art to which this invention belongs.
在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合下面结合附图与实施例对本发明作进一步说明。If there is no conflict, the embodiments and features in the embodiments of the present invention can be combined with each other. The present invention will be further described below with reference to the drawings and embodiments.
实施例一Embodiment 1
本实施例一的目的是提供一种室内外无缝环境下的弹性融合定位方法。The purpose of the first embodiment is to provide a flexible fusion positioning method in indoor and outdoor seamless environments.
为了解决室内外无缝环境下的信号遮挡问题,本实施例提供了一种室内外无缝环境下的弹性融合定位方法,融合了GNSS、5G基站和SINS三种传感器。In order to solve the problem of signal blocking in indoor and outdoor seamless environments, this embodiment provides a flexible fusion positioning method in indoor and outdoor seamless environments, which integrates three sensors: GNSS, 5G base station and SINS.
本实施例提供的一种室内外无缝环境下的弹性融合定位方法,针对室内外无缝环境下,卫星频繁失锁以及存在非视距误差的问题,在子滤波器(GNSS-SINS滤波器和5G-SINS滤波器)中实现观测值层面的紧组合,同时设计故障检测与处理模块抑制异常观测值的影响,最后在主滤波器中将各子滤波器信息进行融合,并依据观测值质量进行动态信息分配。This embodiment provides a flexible fusion positioning method in a seamless indoor and outdoor environment. In order to solve the problem of frequent loss of satellite lock and non-line-of-sight errors in a seamless indoor and outdoor environment, the sub-filter (GNSS-SINS filter and 5G-SINS filter) to achieve tight combination at the observation level, while designing fault detection and processing modules to suppress the influence of abnormal observation values. Finally, the information of each sub-filter is fused in the main filter, and based on the quality of the observation values Perform dynamic information distribution.
本实施例提供的一种室内外无缝环境下的弹性融合定位方法,在室内外无缝环境中,将GNSS、5G基站和SINS相结合,设计故障检测与处理、以及弹性联邦滤波,实现对陆地运载体的组合导航,属于陆地组合导航范畴。This embodiment provides a flexible fusion positioning method in indoor and outdoor seamless environments. In indoor and outdoor seamless environments, GNSS, 5G base stations and SINS are combined to design fault detection and processing, as well as elastic federated filtering, to achieve Integrated navigation of land vehicles belongs to the category of land integrated navigation.
本实施例提供一种室内外无缝环境下的弹性融合定位方法,如图1所示,包括如下步骤:This embodiment provides a flexible fusion positioning method in indoor and outdoor seamless environments, as shown in Figure 1, including the following steps:
步骤1、获取GNSS观测值和5G基站观测值。Step 1. Obtain GNSS observation values and 5G base station observation values.
其中,GNSS观测值包括伪距和载波相位。具体地,GNSS观测值可由RTK(Real-timekinematic,实时动态)模式提供,通过GNSS参考站获得消除电离层和对流层等误差的伪距和载波相位观测值。Among them, GNSS observation values include pseudorange and carrier phase. Specifically, GNSS observations can be provided by RTK (Real-timekinematic, real-time dynamic) mode, and pseudorange and carrier phase observations that eliminate errors in the ionosphere and troposphere are obtained through the GNSS reference station.
其中,5G基站观测值包括:终端(陆地运载体上搭载的5G信号发射天线)相对于5G基站的方位角、高度角、信号传播时间、信号传播距离。5G基站接收共频带定位参考信号(Positioning Reference Signal,PRS),可得到终端相对于5G基站的方位角、高度角和信号传播时间,取信号的传播速度为光速,可计算得到信号传播距离。Among them, the 5G base station observation values include: the azimuth angle, altitude angle, signal propagation time, and signal propagation distance of the terminal (5G signal transmitting antenna mounted on the land carrier) relative to the 5G base station. The 5G base station receives the co-band Positioning Reference Signal (PRS) and can obtain the azimuth angle, altitude angle and signal propagation time of the terminal relative to the 5G base station. Taking the propagation speed of the signal as the speed of light, the signal propagation distance can be calculated.
步骤2、对于GNSS观测值和5G基站观测值,分别进行故障检测与处理,更新量测噪声协方差矩阵。Step 2. For GNSS observation values and 5G base station observation values, perform fault detection and processing respectively, and update the measurement noise covariance matrix.
室内外无缝环境下的GNSS观测值和5G基站观测值容易受到NLOS误差影响,进而影响定位精度。GNSS observations and 5G base station observations in indoor and outdoor seamless environments are easily affected by NLOS errors, which in turn affects positioning accuracy.
将观测新息向量δY i,k的模作为检验值,并利用分布构造故障检验阈值来识别NLOS误差。其中,δY i,k即为第i个子滤波器在k时刻的观测新息向量,i为1或2,当i为1时子滤波器为GNSS-SINS滤波器,当i为2时子滤波器为5G-SINS滤波器;Y i,k为在k时刻输入第i个子滤波器的观测向量(即GNSS观测向量或5G基站观测向量);H i,k为第i个子滤波器在k时刻的量测关系矩阵;/>为在k时刻第i个子滤波器的预测的状态向量。Let the module of the observed innovation vector δY i,k as a test value and use Distribution constructs fault detection thresholds to identify NLOS errors. Among them, δY i,k is the observation innovation vector of the i- th sub-filter at time k , i is 1 or 2, when i is 1, the sub-filter is a GNSS-SINS filter, and when i is 2, the sub-filter is a GNSS-SINS filter. The filter is the 5G-SINS filter; Y i,k is the observation vector (i.e. GNSS observation vector or 5G base station observation vector) input to the i- th sub-filter at time k ; H i,k is the i-th sub-filter at time k The measurement relationship matrix;/> is the predicted state vector of the i-th sub-filter at time k .
当量测信息正常时,观测新息向量δY i,k为高斯白噪声,服从均值为0的正态分布;当发生故障时,即量测信息存在粗差,此时δY i,k的均值不再为0,可以通过假设检验来判断故障。When the measurement information is normal, the observation innovation vector δY i,k is Gaussian white noise and obeys the normal distribution with a mean value of 0; when a fault occurs, that is, there is a gross error in the measurement information, then the mean value of δY i,k is no longer 0, the fault can be determined through hypothesis testing.
构造假设检验统计量T i,k为:Construct the hypothesis test statistic T i,k as:
(1) (1)
式中,为观测新息向量的协方差矩阵;T i,k服从自由度为n(n为观测向量的维度)的/>分布,即/>;/>为观测新息向量的协方差矩阵,R i,k为量测噪声协方差矩阵。In the formula, is the covariance matrix of the observed innovation vector; T i,k obeys/> with degrees of freedom n ( n is the dimension of the observation vector) Distribution, that is/> ;/> is the covariance matrix of the observation innovation vector, and R i,k is the measurement noise covariance matrix.
取显著性水平为α,则发生故障的判断阈值为:Taking the significance level as α , the threshold for judgment of failure is:
(2) (2)
当T i,k≤T D时,判定当前无异常,反之判定当前历元观测向量(GNSS观测向量或5G基站观测向量)包含误差。When Ti ,k ≤ T D , it is determined that there is no abnormality currently, otherwise it is determined that the current epoch observation vector (GNSS observation vector or 5G base station observation vector) contains an error.
通过构造方差膨胀因子α i,k来削弱观测向量误差,即,获取观测新息向量,结合判断阈值,计算方差膨胀因子:The observation vector error is weakened by constructing the variance expansion factor α i,k , that is, the observation innovation vector is obtained, combined with the judgment threshold, the variance expansion factor is calculated:
(3) (3)
将上式中α i,k向量对角化得到diag(α i,k),则修改量测噪声协方差矩阵为:Diagonalize the α i,k vector in the above formula to obtain diag ( α i,k ), then modify the measurement noise covariance matrix as:
(4) (4)
将作为新的量测噪声协方差矩阵代入式(20)中,即可根据观测向量质量好坏,自适应的调整观测向量在量测更新中所占的权重,从而使滤波结果更加平稳,精度更高。Will As the new measurement noise covariance matrix is substituted into Equation (20), the weight of the observation vector in the measurement update can be adaptively adjusted according to the quality of the observation vector, thereby making the filtering results more stable and more accurate. high.
步骤3、更新SINS推算的观测向量。Step 3. Update the observation vector calculated by SINS.
根据当前历元SINS量测更新位置(由SINS机械编排得到)和GNSS星历,经过杆臂改正后,反推得到卫星至接收机天线的伪距和载波相位。According to the current epoch SINS measurement update position (obtained by SINS mechanical programming) and GNSS ephemeris, after correction by the lever arm, the pseudorange and carrier phase from the satellite to the receiver antenna are obtained by back-reduction.
根据当前历元SINS量测更新位置和已知5G基站坐标,经杆臂改正后,反推得到5G基站至终端的方位角、高度角和信号传播时间。According to the current epoch SINS measurement update position and the known 5G base station coordinates, after correction by the lever arm, the azimuth angle, altitude angle and signal propagation time from the 5G base station to the terminal are obtained by back-reduction.
步骤4、将步骤1获取的GNSS观测向量同步骤3中SINS推算的观测向量一起输入GNSS-SINS滤波器(第一子滤波器),将步骤1获取的5G基站观测向量同步骤3中SINS推算的观测向量一起输入5G-SINS滤波器(第二子滤波器)。Step 4. Input the GNSS observation vector obtained in step 1 and the observation vector calculated by SINS in step 3 into the GNSS-SINS filter (first sub-filter). Combine the 5G base station observation vector obtained in step 1 with the SINS calculation in step 3. The observation vectors are input together into the 5G-SINS filter (second sub-filter).
(1)构建导航状态方程。(1) Construct the navigation state equation.
导航状态方程的建立与惯性传感器误差类型、组合方式以及坐标系的选择有关。对于多源传感器,还应考虑对不同状态向量的公共部分进行融合。The establishment of the navigation state equation is related to the inertial sensor error type, combination method and the choice of coordinate system. For multi-source sensors, fusion of the common parts of different state vectors should also be considered.
首先,在地心地固系(Earth Centered,Earth Fixed,ECEF)下构建15维状态向量:First, construct a 15-dimensional state vector under the Earth Centered, Earth Fixed, ECEF system:
(5) (5)
式中,X t为t时刻的状态向量;为ECEF下沿X、Y和Z方向上的姿态角误差;/>为ECEF下沿X、Y和Z方向上的速度误差;/>为ECEF下X、Y和Z方向上的位置误差;b a和b g分别为载体坐标系下沿X、Y和Z方向的加速度计零偏误差和陀螺仪零偏误差。In the formula, X t is the state vector at time t ; is the attitude angle error along the X, Y and Z directions under ECEF;/> is the velocity error along the X, Y and Z directions under ECEF;/> are the position errors in the X, Y and Z directions under ECEF; b a and b g are the accelerometer bias errors and gyroscope bias errors along the X, Y and Z directions in the carrier coordinate system, respectively.
其次,导航的状态方程为:Secondly, the navigation state equation is:
(6) (6)
式中,F t为状态转移矩阵;为过程噪声向量,包含加速度计的随机白噪声w ra、陀螺仪的随机白噪声w rg、以及零偏随机游走过程噪声w bad和w bgd。In the formula, F t is the state transition matrix; is the process noise vector, including the random white noise w ra of the accelerometer, the random white noise w rg of the gyroscope, and the bias random walk process noise w bad and w bgd .
状态转移矩阵F t可表示为:The state transition matrix F t can be expressed as:
(7) (7)
其中,τ s为更新时间间隔;为地球自转角速度的斜对称矩阵;/>,/>为反对称矩阵符号;/>,/>为陆地运载体受到的引力加速度,/>为地心半径,L b为大地纬;/>为3维单位矩阵,/>为三维0矩阵,/>为载体坐标系到地心地固坐标系的姿态转移矩阵,/>为载体的比力。Among them, τ s is the update time interval; is the skew symmetric matrix of the earth's rotation angular velocity;/> ,/> is the antisymmetric matrix symbol;/> ,/> is the gravitational acceleration experienced by land vehicles,/> is the geocentric radius, L b is the geodetic latitude;/> is the 3-dimensional identity matrix,/> is a three-dimensional 0 matrix,/> is the attitude transfer matrix from the carrier coordinate system to the geocentric fixed coordinate system,/> is the relative strength of the carrier.
(2)构建GNSS/SINS紧组合量测方程。(2) Construct a GNSS/SINS tight combination measurement equation.
基于步骤1获取GNSS的观测向量(包括伪距和载波相位),并与通过SINS推算得到的观测向量(包括推算的伪距和载波相位)作差,得到第一观测向量;基于第一观测向量,并结合主滤波器分配的信息和步骤2得到的量测噪声协方差矩阵,进行量测信息更新。Based on step 1, obtain the GNSS observation vector (including pseudorange and carrier phase), and make a difference with the observation vector (including the estimated pseudorange and carrier phase) calculated by SINS to obtain the first observation vector; based on the first observation vector , and combine the information assigned by the main filter and the measurement noise covariance matrix obtained in step 2 to update the measurement information.
首先,GNSS/SINS紧组合的量测方程可表述为:First, the measurement equation of the GNSS/SINS tight combination can be expressed as:
(8) (8)
其中,第一观测向量Y t可表示为:Among them, the first observation vector Y t can be expressed as:
(9) (9)
式中,下标IF表示无电离层;m GNSS表示GNSS的观测向量;和/>分别为GNSS的观测向量中的载波相位和伪距,即无电离层组合载波相位和伪距测量值;/>表示SINS推算得到的观测向量;/>为SINS推算的卫星到接收机的几何距离;/>为载波相位与接收机时钟相关的误差修正之和;/>为伪距与接收机时钟相关的误差修正之和;M w为湿映射函数;/>为天顶湿延迟;/>为载波波长;/>为载波相位模糊度;/>为无电离层组合载波相位的其他误差修正项之和;/>为伪距的其他误差修正项之和。In the formula, the subscript IF means no ionosphere; m GNSS means the observation vector of GNSS; and/> are the carrier phase and pseudorange in the GNSS observation vector respectively, that is, the ionosphere-free combined carrier phase and pseudorange measurement values;/> Represents the observation vector calculated by SINS;/> The geometric distance from the satellite to the receiver calculated for SINS;/> is the sum of error corrections related to the carrier phase and the receiver clock;/> is the sum of error corrections related to pseudorange and receiver clock; M w is the wet mapping function;/> For the zenith wet delay;/> is the carrier wavelength;/> is the carrier phase ambiguity;/> is the sum of other error correction terms of the ionospheric-free combined carrier phase;/> is the sum of other error correction terms of the pseudorange.
其次,量测关系矩阵H t表示如下:Secondly, the measurement relationship matrix H t is expressed as follows:
(10) (10)
(11) (11)
(12) (12)
(13) (13)
(14) (14)
式中,为无电离层组合视距雅克比矩阵;/>是从导航坐标系到ECEF的位置扰动误差的变换矩阵;/>可表示为:In the formula, is the ionospheric-free combined sight range Jacobian matrix;/> is the transformation matrix of the position disturbance error from the navigation coordinate system to ECEF;/> It can be expressed as:
(15) (15)
为量测噪声,表示为: For measurement noise, it is expressed as:
(16) (16)
式中,和/>分别为GNSS定位和测速误差。In the formula, and/> are GNSS positioning and speed measurement errors respectively.
(3)构建5G/SINS紧组合量测方程。(3) Construct a 5G/SINS tight combination measurement equation.
基于步骤1获取5G基站的观测向量(包括方位角、高度角和信号传播时间),并与通过SINS推算得到的观测向量(包括推算得到的方位角、高度角和信号传播时间)作差,得到第二观测向量;基于第二观测向量,并结合主滤波器分配的信息和步骤2得到的量测噪声协方差矩阵,进行量测信息更新。Based on step 1, obtain the observation vector of the 5G base station (including the azimuth angle, altitude angle and signal propagation time), and make the difference with the observation vector calculated by SINS (including the calculated azimuth angle, altitude angle and signal propagation time), and get The second observation vector; based on the second observation vector and combined with the information allocated by the main filter and the measurement noise covariance matrix obtained in step 2, the measurement information is updated.
5G/SINS紧组合的量测方程可表述为:The measurement equation of the 5G/SINS tight combination can be expressed as:
(17) (17)
式中,为第二观测向量;/>、/>、/>分别为t时刻第i个基站观测的TOA、方位角(Azimuth,Azi)、高度角(Elevation,Ele);/>、/>、/>分别为t时刻SINS推算的第i个基站的TOA、Azi、Ele;/>为量测关系矩阵,表达为:In the formula, is the second observation vector;/> ,/> ,/> are respectively the TOA, azimuth angle (Azimuth, Azi), and elevation angle (Elevation, Ele) observed by the i -th base station at time t ;/> ,/> ,/> are the TOA, Azi, and Ele of the i - th base station calculated by SINS at time t ;/> is the measurement relationship matrix, expressed as:
(18) (18)
其中,in,
(19) (19)
其中,为量测噪声向量,包含TOA的量测噪声v TOA与AOA的量测噪声v Azi和v Ele,AOA包含方位角(Azimuth,Azi)和高度角(Elevation,Ele),/>为1行3列的0矩阵。in, It is the measurement noise vector, including the measurement noise v of TOA, the measurement noise v Azi and v Ele of TOA and AOA, and AOA includes azimuth angle (Azimuth, Azi) and elevation angle (Elevation, Ele), /> It is a 0 matrix with 1 row and 3 columns.
(4)GNSS/SINS子滤波器和5G/SINS子滤波器更新。(4) GNSS/SINS sub-filter and 5G/SINS sub-filter updates.
将式(6)所示的状态方程和式(8)、式(17)所示的量测方程离散化,各子滤波器时间更新过程为:Discretizing the state equation shown in Equation (6) and the measurement equations shown in Equation (8) and (17), the time update process of each sub-filter is:
(20) (20)
各子滤波器独立进行量测更新过程为:The measurement and update process of each sub-filter independently is:
(21) (twenty one)
式中,下标i和k分别表示相应的子滤波器以及离散化的时间;P i,k为第i个子滤波器在k时刻的状态误差协方差矩阵;Q i,k为第i个子滤波器在k时刻的过程噪声协方差矩阵;R i,k为第i个子滤波器在k时刻的量测噪声协方差矩阵;K i,k为第i个子滤波器在k时刻的卡尔曼增益矩阵;H i,k+1为第i个子滤波器在k+1时刻的量测关系矩阵;Y i,k+1为第i个子滤波器在k+1时刻的观测向量(第一观测向量或第二观测向量);F i,k+1为第i个子滤波器在k+1时刻的状态转移矩阵;为第i个子滤波器预测的在k时刻的状态向量(即局部最优解)。In the formula, the subscripts i and k represent the corresponding sub-filters and discretization time respectively; P i,k is the state error covariance matrix of the i-th sub-filter at time k ; Q i,k is the i-th sub-filter The process noise covariance matrix of the filter at time k ; R i,k is the measurement noise covariance matrix of the i-th sub-filter at time k ; K i,k is the Kalman gain matrix of the i -th sub-filter at time k ; H i,k+1 is the measurement relationship matrix of the i-th sub-filter at time k +1; Y i,k+1 is the observation vector of the i -th sub-filter at time k +1 (the first observation vector or second observation vector); F i,k+1 is the state transition matrix of the i -th sub-filter at time k +1; It is the state vector at time k predicted by the i- th sub-filter (ie, the local optimal solution).
步骤5、主滤波器信息融合与信息分配。将第一子滤波器和第二子滤波器的更新的量测信息(P i,k、Q i,k和),在主滤波器中进行信息融合,得到最终定位结果,并按照信息分配准则将融合信息(/>、P g,k以及Q g,k)分配至第一子滤波器和第二子滤波器。Step 5. Main filter information fusion and information distribution. The updated measurement information ( P i,k , Q i,k and ), perform information fusion in the main filter to obtain the final positioning result, and combine the fused information (/> , P g,k and Q g,k ) are assigned to the first sub-filter and the second sub-filter.
融合各子滤波器局部最优解,得到主滤波器信息融合方程为:After fusing the local optimal solutions of each sub-filter, the main filter information fusion equation is obtained:
(22) (twenty two)
主滤波器中只进行时间更新,并按照一定的信息分配准则,将式(21)中全局最优估计值、状态误差协方差矩阵P g,k以及噪声协方差矩阵Q g,k反馈到各子滤波器中,反馈到各子滤波器时的信息分配准则可表述为:Only time updates are performed in the main filter, and according to certain information distribution criteria, the global optimal estimate in equation (21) , the state error covariance matrix P g,k and the noise covariance matrix Q g,k are fed back to each sub-filter. The information distribution criterion when fed back to each sub-filter can be expressed as:
(23) (twenty three)
式中,β表示信息分配系数,其取值关系到联邦滤波器整体的性能,且满足如下的信息守恒原则:In the formula, β represents the information distribution coefficient, its value is related to the overall performance of the federated filter, and satisfies the following information conservation principle:
(24) (twenty four)
根据GNSS的PDOP值和载噪比动态调整β的大小,以提高子滤波器的故障隔离能力,融合后的全局滤波精度也能得到提高,β可表示为:The size of β is dynamically adjusted according to the PDOP value and carrier-to-noise ratio of GNSS to improve the fault isolation capability of the sub-filter. The global filtering accuracy after fusion can also be improved. β can be expressed as:
(25) (25)
其中,PDOP值为卫星分布的空间几何强度因子,一般卫星分布越好时,PDOP值越小,一般小于3为比较理想状态;β PDOP是与PDOP值有关的构造函数,表达为:Among them, the PDOP value is the spatial geometric intensity factor of satellite distribution. Generally, when the satellite distribution is better, the PDOP value is smaller, and generally less than 3 is an ideal state; β PDOP is a constructor related to the PDOP value, expressed as:
(26) (26)
式中,X 1和X 2为PDOP阈值,分别取1.5和4;β PDOP为单调递减函数,当PDOP值小于阈值X 1时,可认为此时GNSS观测条件良好,可完全采纳GNSS量测信息;反之当PDOP值大于阈值X 2时,可认为GNSS量测信息不再具有利用价值,将完全抛弃;β CN是与载噪比有关的构造函数,表达为: In the formula , X 1 and _ ; On the contrary , when the PDOP value is greater than the threshold
(27) (27)
式中,Y 1和Y 2为载噪比阈值,分别取33dBHz和50dBHz;β CN为单调递增函数,表明载噪比CN越大,GNSS量测信息的可信度越高。In the formula, Y 1 and Y 2 are the carrier-to-noise ratio thresholds, which are 33dBHz and 50dBHz respectively; β CN is a monotonically increasing function, indicating that the larger the carrier-to-noise ratio CN , the higher the credibility of the GNSS measurement information.
步骤6、输出最终定位结果。Step 6. Output the final positioning result.
输出包括融合后的状态向量(即最终定位结果,全局最优估计值)和状态误差协方差矩阵/>。与此同时,全局最优估计值/>返回SINS作为下一历元机械编排方程的先验信息。The output includes the fused state vector (i.e., final positioning result, global optimal estimate) and state error covariance matrix/> . At the same time, the global optimal estimate/> Return SINS as a priori information for the mechanical orchestration equations of the next epoch.
本实施例提供的一种室内外无缝环境下的弹性融合定位方法,在子滤波器中实现观测值层面的紧组合,同时设计故障检测与处理模块抑制异常观测值的影响,最后在主滤波器依据观测值质量进行动态的信息融合和分配。通过仿真和实测数据对比分析,结果表明:本实施例可以有效隔离传感器故障和非视距误差,在室内外过渡区域,卫星部分失锁的条件下,定位精度相比GNSS-SINS紧组合提高68%,有效作用范围相比基于GNSS、超宽带和SINS的组合导航算法更大,在室内外无缝环境下可以连续稳定工作,定位精度更高。This embodiment provides an elastic fusion positioning method in indoor and outdoor seamless environments. It realizes tight combination of observation values in the sub-filter. At the same time, a fault detection and processing module is designed to suppress the influence of abnormal observation values. Finally, in the main filter The processor dynamically fuses and allocates information based on the quality of the observations. Through comparative analysis of simulation and measured data, the results show that this embodiment can effectively isolate sensor faults and non-line-of-sight errors. In the indoor and outdoor transition areas and under the condition that the satellite is partially out of lock, the positioning accuracy is improved by 68% compared with the GNSS-SINS tight combination. %, the effective range is larger than the integrated navigation algorithm based on GNSS, ultra-wideband and SINS, it can work continuously and stably in indoor and outdoor seamless environments, and the positioning accuracy is higher.
实施例二Embodiment 2
本实施例二的目的是提供一种室内外无缝环境下的弹性融合定位系统,The purpose of the second embodiment is to provide a flexible fusion positioning system in indoor and outdoor seamless environments.
数据获取模块,其被配置为:获取GNSS观测向量、基站观测向量和SINS推算的观测向量;A data acquisition module configured to: acquire GNSS observation vectors, base station observation vectors, and SINS-derived observation vectors;
故障检测模块,其被配置为:基于GNSS观测向量和基站观测向量,更新量测噪声协方差矩阵;A fault detection module configured to: update the measurement noise covariance matrix based on the GNSS observation vector and the base station observation vector;
量测信息更新模块,其被配置为:将GNSS观测向量同SINS推算的观测向量一起输入第一子滤波器中作差,并结合量测噪声协方差矩阵和主滤波器分配的信息,进行量测信息更新;同时,将基站观测向量同SINS推算的观测向量输入第二子滤波器中作差,并结合量测噪声协方差矩阵和主滤波器分配的信息,进行量测信息更新;The measurement information update module is configured to: input the GNSS observation vector and the SINS estimated observation vector into the first sub-filter for difference, and combine the measurement noise covariance matrix and the information allocated by the main filter to perform measurement The measurement information is updated; at the same time, the base station observation vector and the SINS-derived observation vector are input into the second sub-filter for difference, and the measurement information is updated based on the measurement noise covariance matrix and the information allocated by the main filter;
定位模块,其被配置为:将第一子滤波器和第二子滤波器的更新的量测信息,在主滤波器中进行信息融合,得到最终定位结果,并按照信息分配准则将融合信息分配至第一子滤波器和第二子滤波器。A positioning module configured to: fuse the updated measurement information of the first sub-filter and the second sub-filter in the main filter to obtain the final positioning result, and distribute the fused information according to the information distribution criteria. to the first sub-filter and the second sub-filter.
此处需要说明的是,本实施例中的各个模块与实施例一中的各个步骤一一对应,其具体实施过程相同,此处不再累述。It should be noted here that each module in this embodiment corresponds to each step in Embodiment 1, and the specific implementation process is the same, which will not be described again here.
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。The above descriptions are only preferred embodiments of the present invention and are not intended to limit the present invention. For those skilled in the art, the present invention may have various modifications and changes. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present invention shall be included in the protection scope of the present invention.
上述虽然结合附图对本发明的具体实施方式进行了描述,但并非对本发明保护范围的限制,所属领域技术人员应该明白,在本发明的技术方案的基础上,本领域技术人员不需要付出创造性劳动即可做出的各种修改或变形仍在本发明的保护范围以内。Although the specific embodiments of the present invention have been described above in conjunction with the accompanying drawings, they do not limit the scope of the present invention. Those skilled in the art should understand that based on the technical solutions of the present invention, those skilled in the art do not need to perform creative work. Various modifications or variations that can be made are still within the protection scope of the present invention.
Claims (10)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202311286965.7A CN117031521B (en) | 2023-10-08 | 2023-10-08 | Elastic fusion positioning method and system in indoor and outdoor seamless environment |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202311286965.7A CN117031521B (en) | 2023-10-08 | 2023-10-08 | Elastic fusion positioning method and system in indoor and outdoor seamless environment |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN117031521A true CN117031521A (en) | 2023-11-10 |
| CN117031521B CN117031521B (en) | 2024-01-30 |
Family
ID=88632191
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202311286965.7A Active CN117031521B (en) | 2023-10-08 | 2023-10-08 | Elastic fusion positioning method and system in indoor and outdoor seamless environment |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN117031521B (en) |
Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US7719461B1 (en) * | 2008-08-05 | 2010-05-18 | Lockheed Martin Corporation | Track fusion by optimal reduced state estimation in multi-sensor environment with limited-bandwidth communication path |
| CN106501832A (en) * | 2016-12-16 | 2017-03-15 | 南京理工大学 | A kind of fault-tolerant vector tracking GNSS/SINS deep integrated navigation methods |
| US20180188382A1 (en) * | 2017-01-04 | 2018-07-05 | Qualcomm Incorporated | Selection of gnss data for positioning fusion in urban environments |
| CN110375730A (en) * | 2019-06-12 | 2019-10-25 | 深圳大学 | The indoor positioning navigation system merged based on IMU and UWB |
| CN110873888A (en) * | 2018-09-04 | 2020-03-10 | 腾讯大地通途(北京)科技有限公司 | Positioning method, positioning device, positioning apparatus, and computer storage medium |
| CN111189441A (en) * | 2020-01-10 | 2020-05-22 | 山东大学 | A multi-source adaptive fault-tolerant federated filtering integrated navigation system and navigation method |
| CN112697154A (en) * | 2021-01-31 | 2021-04-23 | 南京理工大学 | Self-adaptive multi-source fusion navigation method based on vector distribution |
| CN113219506A (en) * | 2021-05-07 | 2021-08-06 | 江苏俱为科技有限公司 | Positioning method for multimode fusion seamless switching |
| CN115950432A (en) * | 2023-01-16 | 2023-04-11 | 同济大学 | Seamless positioning method and equipment for indoor and outdoor mobile robot and storage medium |
-
2023
- 2023-10-08 CN CN202311286965.7A patent/CN117031521B/en active Active
Patent Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US7719461B1 (en) * | 2008-08-05 | 2010-05-18 | Lockheed Martin Corporation | Track fusion by optimal reduced state estimation in multi-sensor environment with limited-bandwidth communication path |
| CN106501832A (en) * | 2016-12-16 | 2017-03-15 | 南京理工大学 | A kind of fault-tolerant vector tracking GNSS/SINS deep integrated navigation methods |
| US20180188382A1 (en) * | 2017-01-04 | 2018-07-05 | Qualcomm Incorporated | Selection of gnss data for positioning fusion in urban environments |
| CN110873888A (en) * | 2018-09-04 | 2020-03-10 | 腾讯大地通途(北京)科技有限公司 | Positioning method, positioning device, positioning apparatus, and computer storage medium |
| CN110375730A (en) * | 2019-06-12 | 2019-10-25 | 深圳大学 | The indoor positioning navigation system merged based on IMU and UWB |
| CN111189441A (en) * | 2020-01-10 | 2020-05-22 | 山东大学 | A multi-source adaptive fault-tolerant federated filtering integrated navigation system and navigation method |
| CN112697154A (en) * | 2021-01-31 | 2021-04-23 | 南京理工大学 | Self-adaptive multi-source fusion navigation method based on vector distribution |
| CN113219506A (en) * | 2021-05-07 | 2021-08-06 | 江苏俱为科技有限公司 | Positioning method for multimode fusion seamless switching |
| CN115950432A (en) * | 2023-01-16 | 2023-04-11 | 同济大学 | Seamless positioning method and equipment for indoor and outdoor mobile robot and storage medium |
Non-Patent Citations (2)
| Title |
|---|
| 孟骞等: "城市峡谷环境多源导航信息弹性融合定位方法", 导航与控制, vol. 22, no. 2, pages 16 - 22 * |
| 王春霞;赵伟;刘瑞华;刘建业;: "动态捷联惯导/多卫星组合导航自适应联邦滤波算法研究", 信息与控制, no. 04, pages 453 - 458 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN117031521B (en) | 2024-01-30 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US11550067B2 (en) | System and method for fusing dead reckoning and GNSS data streams | |
| US12216211B2 (en) | System and method for correcting satellite observations | |
| JP5673071B2 (en) | Position estimation apparatus and program | |
| CN106255065B (en) | Indoor and outdoor seamless positioning system and method for smart phone | |
| CN101382431B (en) | Positioning system and method thereof | |
| Georgy et al. | Vehicle navigator using a mixture particle filter for inertial sensors/odometer/map data/GPS integration | |
| US8082099B2 (en) | Aircraft navigation using the global positioning system and an attitude and heading reference system | |
| US11187534B2 (en) | System and method for GNSS reflective surface mapping and position fix estimation | |
| CN112697154B (en) | Self-adaptive multi-source fusion navigation method based on vector distribution | |
| CN115683092A (en) | DME/DME/SINS tightly-combined navigation system relocation method | |
| US6704650B1 (en) | Technique for accurate distance and velocity calculations using the global positioning system (GPS) | |
| Ćwian et al. | GNSS-augmented lidar slam for accurate vehicle localization in large scale urban environments | |
| CN115683094A (en) | A vehicle-mounted dual-antenna tight-coupling positioning method and system in a complex environment | |
| Xu et al. | An innovation-based cycle-slip, multipath estimation, detection and mitigation method for tightly coupled GNSS/INS/Vision navigation in urban areas | |
| Elsheikh et al. | Multisensor precise positioning for automated and connected vehicles | |
| Zhang et al. | Using UWB aided GNSS/INS integrated navigation to bridge GNSS outages based on optimal anchor distribution strategy | |
| CN117148406B (en) | An indoor and outdoor seamless elastic integration positioning method, system, medium and equipment | |
| CN117031521B (en) | Elastic fusion positioning method and system in indoor and outdoor seamless environment | |
| CN109116396A (en) | A kind of multiple antennas GNSS Differential positioning method | |
| Vana | Continuous urban navigation with next-generation, mass market navigation sensors and adaptive filtering | |
| TW536637B (en) | Improved positioning and data integrating method and system thereof | |
| Guo et al. | Research on the application of fusion positioning technology in airport vehicle operation monitoring | |
| Liu et al. | ESKF-based Vehicle Positioning Through Cellular Signals, GNSS, IMU, and Odometer | |
| Borges et al. | Improving Positioning Accuracy for Connected Vehicles: Integration of Low-Cost INS with GNSS | |
| Cao et al. | High-Precision Low-Cost Positioning Technology for Shared E-Bikes in Complex Urban Environments Based on Beidou RTK/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 | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |