CN114526737A - 一种基于gnss/uwb/dba融合的室内外无缝切换定位方法 - Google Patents

一种基于gnss/uwb/dba融合的室内外无缝切换定位方法 Download PDF

Info

Publication number
CN114526737A
CN114526737A CN202210047452.XA CN202210047452A CN114526737A CN 114526737 A CN114526737 A CN 114526737A CN 202210047452 A CN202210047452 A CN 202210047452A CN 114526737 A CN114526737 A CN 114526737A
Authority
CN
China
Prior art keywords
uwb
dba
gnss
positioning
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
Application number
CN202210047452.XA
Other languages
English (en)
Other versions
CN114526737B (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.)
Taiyuan University of Technology
Original Assignee
Taiyuan University of Technology
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 Taiyuan University of Technology filed Critical Taiyuan University of Technology
Priority to CN202210047452.XA priority Critical patent/CN114526737B/zh
Publication of CN114526737A publication Critical patent/CN114526737A/zh
Application granted granted Critical
Publication of CN114526737B publication Critical patent/CN114526737B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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
    • G01C5/00—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels
    • G01C5/06—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels by using barometric means
    • 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
    • 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
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/0257—Hybrid positioning
    • 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

Abstract

本发明属于定位导航技术领域，具体是一种基于GNSS/UWB/DBA融合的室内外无缝切换定位方法。包括S1：室内环境通过UWB和DBA组合实现三维定位；S2：室内外无缝切换场景通过GNSS、UWB和DBA多源传感器组合实现三维定位；S3：室外环境采用GNSS和DBA组合实现三维定位。本发明室内采用UWB/DBA组合实现高精度三维定位，相比采用纯UWB实现室内三维定位可减少UWB基站的布设数量节省系统建设成本，又可大幅降低UWB基站布设的难度；室内外无缝切换采用GNSS/UWB/DBA多源传感器融合和室外采用GNSS/DBA组合定位，融合模型简单且精度较高，实现各系统优势互补，可显著提升用户终端在室内及室内外无缝切换定位、城市遮挡、灾害救援等复杂环境下精密定位导航能力。

Description

一种基于GNSS/UWB/DBA融合的室内外无缝切换定位方法
技术领域
本发明属于定位导航技术领域，具体是一种基于GNSS/UWB/DBA融合的室内外无缝切换定位方法。
背景技术
全球卫星导航系统（Global Navigation Satellite System, GNSS）作为重要的时空基础设施，为全球用户提供全球性、全天候、全方位、高精度的定位、导航和授时（Positioning Navigation Timing, PNT）服务，基本满足室外用户大多数场景下的位置服务需求，得到了广泛的应用。但在树下、城市峡谷、隧道、矿坑深部、室内等复杂环境中，GNSS存在严重的多路径效应、信号衰减以及可视卫星较少等问题，极大限制了GNSS的可用性和应用范围，无法满足多等级大众用户对室内外无缝定位“最后一公里”的应用需求。超宽带（Ultra-wide Band, UWB）较其他技术具有安全性高、功耗低、穿透性能强、抗干扰强、传输速率高、定位精度高（10～20 cm）等一系列优点，已经成为室内定位的首选技术。UWB采用到达时间（Time of Arrive, TOA）或到达时间差（Time Difference of Arrive, TDOA）技术获取用户三维位置分别至少需要布设3或4个以上基站，实现室内三维定位较平面定位同时需要增设布设大量基站，成本较高，而且需要基站在垂直方向上布设时错开一定的距离，布设难度高。低成本气压计差分气压测高（Differential Barometer Altimeter, DBA）技术获取的相对高程精度较高（室内可优于0.3m，室外优于1m），且不受环境限制、室内外均可使用，可有效分辨室内楼层和室外辅助约束GNSS提高定位精度。室内外过渡区域是无缝定位的纽带区域，也是室外定位信号和室内定位信号均受到严重遮挡或干扰的区域，由于多种复杂环境形成的导航盲区无法通过单一传感器解决，采用多源传感器融合定位已成为解决室内外无缝切换定位的主流技术路线。
发明内容
本发明为了提升用户终端在室内及室内外无缝切换定位、城市遮挡、灾害救援等复杂环境下精密定位导航能力，提供一种基于GNSS/UWB/DBA融合的室内外无缝切换定位方法。
本发明采取以下技术方案：一种基于GNSS/UWB/DBA融合的室内外无缝切换定位方法，包括S1：室内环境通过UWB和DBA组合实现三维定位；S2：室内外无缝切换场景通过GNSS、UWB和DBA多源传感器组合实现三维定位；S3：室外环境采用GNSS和DBA组合实现三维定位。
S1的具体实现方法为：将UWB主、从基站布设在同一高度的平面内，其三维位置事先测定，UWB主基站和移动标签上同时集成放置低成本气压计，以UWB主基站高程作为DBA模型高程基准，构建UWB/DBA组合三维定位模型，该模型融合了UWB和DBA两种信号源，以高精度测距和气压观测值为基础联合解算获得移动用户的三维坐标信息。
所述的UWB/DBA组合三维定位模型如式1所示，
Figure 100002_DEST_PATH_IMAGE001
（1）
式中，
Figure 889865DEST_PATH_IMAGE002
为UWB主基站BS1已知坐标，从基站平面坐标为
Figure 100002_DEST_PATH_IMAGE003
，标签位置为
Figure 780460DEST_PATH_IMAGE004
，
Figure 100002_DEST_PATH_IMAGE005
为TDOA测量值，
Figure 100002_DEST_PATH_IMAGE007
为BS1处气压模块读数，
Figure 971924DEST_PATH_IMAGE008
为Tag处气压模块读数，
Figure 100002_DEST_PATH_IMAGE009
为BS1和Tag之间平均摄氏温度，即
Figure 100002_DEST_PATH_IMAGE011
，
Figure 393809DEST_PATH_IMAGE012
为BS1处温度，
Figure 100002_DEST_PATH_IMAGE013
为Tag处温度。
S2的具体实现步骤为：S21：在用户从室内到室外无缝切换过渡阶段，判断可见的UWB基站小于3个和GNSS卫星不足4颗时作为阈值条件自动切换为室内外无缝切换场景解算模式；S22：获取GNSS基准站、移动站观测数据以及广播星历数据；获取UWB基站坐标及TDOA数据；获取DBA数据并处理转换为高程数据；S23：GNSS、UWB、DBA观测数据时间同步匹配；S24：构建GNSS/UWB/DBA组合三维定位模型；S25：联合解算获得移动用户的三维坐标信息,实现室内外的连续定位。
S24中，GNSS/UWB/DBA组合三维定位模型如式2所示，
Figure 629619DEST_PATH_IMAGE014
（2）
上式中，第1、2行中
Figure 100002_DEST_PATH_IMAGE015
表示GNSS观测值之间的双差算子，i和j表示参考站和流动站，k和s为参考星和非参考星，
Figure 951884DEST_PATH_IMAGE016
和
Figure 100002_DEST_PATH_IMAGE017
表示GNSS码伪距和载波相位双差观测值，
Figure 919840DEST_PATH_IMAGE018
表示双差站星距，
Figure DEST_PATH_IMAGE019
表示双差码伪距观测噪声，
Figure 100002_DEST_PATH_IMAGE021
表示双差模糊度，
Figure 891339DEST_PATH_IMAGE022
表示双差相位观测噪声；第3、4行中
Figure 100002_DEST_PATH_IMAGE023
为UWB TDOA观测值，
Figure 602943DEST_PATH_IMAGE024
为m个UWB基站三维坐标，
Figure 100002_DEST_PATH_IMAGE025
为用户三维坐标；第5行为利用DBA高程h构建的近似椭球约束方程，等效于增加一颗位于地心的虚拟卫星，a和b分别为地球参考椭球长、短半轴。
GNSS/UWB/DAB融合定位模型的随机模型为：
Figure 530447DEST_PATH_IMAGE026
（15）
式15中，
Figure 100002_DEST_PATH_IMAGE027
、
Figure 983819DEST_PATH_IMAGE028
、
Figure 100002_DEST_PATH_IMAGE029
分别为GNSS双差观测量、UWB的TDOA观测量、DBA高程的方差-协方差矩阵。
S25中，GNSS/UWB/DBA组合三维定位模型的解算包括以下步骤，
步骤1：将式2中GNSS双差观测方程线性化，在近似位置
Figure 100002_DEST_PATH_IMAGE031
处采用泰勒级数展开后并化简可得：
Figure 629564DEST_PATH_IMAGE032
（3）
式3中，
Figure DEST_PATH_IMAGE033
，
Figure 692329DEST_PATH_IMAGE034
，
Figure 677602DEST_PATH_IMAGE036
为方向余弦，m=s-1为双差方程数量，
Figure 100002_DEST_PATH_IMAGE037
，
Figure 49678DEST_PATH_IMAGE038
为伪距和载波相位观测值向量。
步骤2：将UWB Tag在近似位置
Figure 100002_DEST_PATH_IMAGE039
处采用泰勒级数展开后并化简可得：
Figure 120402DEST_PATH_IMAGE040
（4）
式4中，
Figure 100002_DEST_PATH_IMAGE041
为UWB观测值向量，
Figure 485393DEST_PATH_IMAGE042
为各BS到Tag的近似距离，
Figure 100002_DEST_PATH_IMAGE043
，
Figure 387490DEST_PATH_IMAGE044
，
Figure DEST_PATH_IMAGE045
分别为各BS到Tag的方向余弦，其中
Figure 868150DEST_PATH_IMAGE046
。
步骤3：采用微分处理法求解DBA高程地球椭球约束方程，即将椭球约束方程在用户的近似位置
Figure 973641DEST_PATH_IMAGE048
按照泰勒级数展开，仅保留一阶项，将式2第5行两边对
Figure 830738DEST_PATH_IMAGE050
求偏微分得：
Figure 100002_DEST_PATH_IMAGE051
（5）
整理得：
Figure 587341DEST_PATH_IMAGE052
（6）
同理对和
Figure 238903DEST_PATH_IMAGE054
求偏微分可得：
Figure 100002_DEST_PATH_IMAGE055
（7）
Figure 592874DEST_PATH_IMAGE056
（8）
由此可得
Figure 100002_DEST_PATH_IMAGE057
（9）
其中
Figure 988083DEST_PATH_IMAGE058
，
Figure 100002_DEST_PATH_IMAGE059
，
Figure 599193DEST_PATH_IMAGE060
，
Figure 100002_DEST_PATH_IMAGE061
为观测值，h为DA获取的高程值，
Figure 500284DEST_PATH_IMAGE062
为用户在近似位置
Figure 100002_DEST_PATH_IMAGE063
转换得到的大地高；
步骤4：联合式3、式4和式9组成GNSS/UWB/DBA融合定位平差模型为：
Figure 829634DEST_PATH_IMAGE064
，P1 （10）
式中，
Figure 100002_DEST_PATH_IMAGE065
，
Figure 28534DEST_PATH_IMAGE066
，
Figure 100002_DEST_PATH_IMAGE067
，
Figure 743418DEST_PATH_IMAGE068
分别表示观测向量、设计矩阵、待估参数和残差，P1为GNSS/UWB/DBA融合定位观测值的先验权阵，P1为式15中
Figure 100002_DEST_PATH_IMAGE069
的逆矩阵。
步骤5：采用单历元加权最小二乘平差方法进行参数估计：
Figure 64678DEST_PATH_IMAGE070
（11）
式中，
Figure 100002_DEST_PATH_IMAGE071
为参数
Figure 819008DEST_PATH_IMAGE072
的方差-协方差矩阵。
步骤6：采用最小二乘降相关算法（Least Square Ambiguity DecorrelationAdjustment, LAMBDA）进行双差模糊度固定，设置Ratio阈值为3，如果能够通过验证，将位置参数的浮点解转换为固定解，否则输出浮点解结果。
S3中，构建的GNSS/DBA组合三维定位模型为：
Figure DEST_PATH_IMAGE073
，P2
随机模型为：
Figure 369069DEST_PATH_IMAGE074
式中，同样
Figure DEST_PATH_IMAGE075
、
Figure 954771DEST_PATH_IMAGE076
分别为GNSS双差观测量、DBA高程的方差-协方差矩阵，观测值向量权阵P2即为S3中
Figure DEST_PATH_IMAGE077
的逆矩阵。
与现有技术相比，本发明提供一种基于GNSS/UWB/DBA三种手段进行融合的室内外无缝切换定位方法，室内采用UWB/DBA组合实现高精度三维定位，相比采用纯UWB实现室内三维定位可减少UWB基站的布设数量节省系统建设成本，又可大幅降低UWB基站布设的难度；室内外无缝切换采用GNSS/UWB/DBA多源传感器融合和室外采用GNSS/DBA组合定位，融合模型简单且精度较高，实现各系统优势互补，可显著提升用户终端在室内及室内外无缝切换定位、城市遮挡、灾害救援等复杂环境下精密定位导航能力。
附图说明
图1为本发明总体方案设计图；
图2为 GNSS/UWB/DBA组合室内外无缝定位算法流程图。
具体实施方式
发明内容的总体技术路线如图1所示，具体方案为：包括S1：室内环境通过UWB和DBA组合实现三维定位；S2：室内外无缝切换场景通过GNSS、UWB和DBA多源传感器组合实现三维定位；S3：室外环境采用GNSS和DBA组合实现三维定位。
S1：室内UWB/DBA组合三维定位：
室内三维位置通过UWB基站仅布设在平面获取平面位置和低成本气压计DBA技术获取精确相对高程来实现。对于采用TDOA测距的UWB系统，将UWB主、从基站布设在基本同一高度的平面内，其三维位置可通过全站仪事先测定，UWB主基站和移动标签上同时集成放置低成本气压计，UWB主基站高程作为DBA模型高程基准，构建的UWB/DBA组合三维定位模型融合了UWB和气压计两种信号源，以高精度测距和气压观测值为基础即可联合解算获得移动用户的三维坐标信息。
UWB/DBA组合三维定位观测方程如式（1）所示，其中第一式为UWB基于到达时间差（TDOA）二维定位观测方程（又称为双曲线定位）；第二式为通过大气静力平衡方程推导得到的简化DBA公式。
Figure 384615DEST_PATH_IMAGE078
（1）
上式中，
Figure DEST_PATH_IMAGE079
为UWB主基站BS1已知坐标，从基站平面坐标为
Figure 675176DEST_PATH_IMAGE080
，标签位置为
Figure DEST_PATH_IMAGE081
，
Figure 278195DEST_PATH_IMAGE082
为TDOA测量值，
Figure 921666DEST_PATH_IMAGE084
为BS1处气压模块读数，
Figure DEST_PATH_IMAGE085
为Tag处气压模块读数，
Figure 69882DEST_PATH_IMAGE086
为BS1和Tag之间平均摄氏温度，即
Figure DEST_PATH_IMAGE087
，
Figure 861121DEST_PATH_IMAGE012
为BS1处温度，
Figure 939935DEST_PATH_IMAGE013
为Tag处温度。
S2:GNSS/UWB/DBA组合室内外无缝定位：S21：在用户从室内到室外无缝切换过渡阶段，判断可见的UWB基站小于3个和GNSS卫星不足4颗时作为阈值条件自动切换为室内外无缝切换场景解算模式；S22：获取GNSS基准站、移动站观测数据以及广播星历数据；获取UWB基站坐标及TDOA数据；获取DBA数据并处理转换为高程数据；S23：GNSS、UWB、DBA观测数据时间同步匹配；S24：构建GNSS/UWB/DBA组合三维定位模型；S25：联合解算获得移动用户的三维坐标信息,实现室内外的连续定位。
在室内外无缝切换过渡场景下，GNSS采用差分模式，基准站上同时布设气压模块提供差分补偿修正，用户终端与部分UWB基站可视。此时单一传感器由于可用观测值数量不足无法很好定位，而采用GNSS/UWB/DBA融合可实现无缝切换，增加UWB和DBA观测数据相当于增加多个位于用户接收机附近和一个位于地心的卫星伪距观测值，可有效改善观测值空间几何结构、降低PDOP值，实现室内外的连续定位。
1）函数模型
具体的GNSS/UWB/DBA融合定位函数模型如下：
Figure 437912DEST_PATH_IMAGE088
（2）
上式中，第1、2行中
Figure 255565DEST_PATH_IMAGE015
表示GNSS观测值之间的双差算子，i和j表示参考值和流动站，k和s为参考星和非参考星，
Figure 471782DEST_PATH_IMAGE016
和
Figure 354288DEST_PATH_IMAGE017
表示GNSS码伪距和载波相位双差观测值，
Figure 769088DEST_PATH_IMAGE018
表示双差站星距，
Figure 711637DEST_PATH_IMAGE019
表示双差码伪距观测噪声，
Figure 962621DEST_PATH_IMAGE021
表示双差模糊度，
Figure 383238DEST_PATH_IMAGE022
表示双差相位观测噪声；第3、4行中
Figure 855807DEST_PATH_IMAGE023
为UWB TDOA观测值，
Figure 765994DEST_PATH_IMAGE024
为m个UWB基站三维坐标，
Figure 691225DEST_PATH_IMAGE025
为用户三维坐标；第5行为利用DBA高程h构建的近似椭球约束方程，等效于增加一颗位于地心的虚拟卫星，a和b分别为地球参考椭球长、短半轴。
在用户从室内到室外无缝切换过渡阶段，判断可见的UWB基站小于3个和GNSS卫星不足4颗时作为阈值条件自动切换解算模式，根据多传感器观测值组成观测方程和定权矩阵，随机模型首先根据传感器观测值先验方差进行构建。具体求解步骤如下：
步骤1：将式（2）中GNSS双差观测方程线性化，在近似位置
Figure DEST_PATH_IMAGE089
处采用泰勒级数展开后并化简可得：
Figure 224188DEST_PATH_IMAGE032
（3）
式3中，
Figure 551264DEST_PATH_IMAGE033
，
Figure 897932DEST_PATH_IMAGE034
，
Figure 310458DEST_PATH_IMAGE036
为方向余弦，m=s-1为双差方程数量，
Figure 72878DEST_PATH_IMAGE037
，
Figure 67510DEST_PATH_IMAGE038
为伪距和载波相位观测值向量。
步骤2：将UWB Tag在近似位置
Figure 522762DEST_PATH_IMAGE039
处采用泰勒级数展开后并化简可得：
Figure 422585DEST_PATH_IMAGE040
（4）
式4中，
Figure 51013DEST_PATH_IMAGE041
为UWB观测值向量，
Figure 87102DEST_PATH_IMAGE042
为各BS到Tag的近似距离，
Figure 24840DEST_PATH_IMAGE043
，
Figure 411959DEST_PATH_IMAGE044
，
Figure 516181DEST_PATH_IMAGE045
分别为各BS到Tag的方向余弦，其中
Figure 734672DEST_PATH_IMAGE046
。
步骤3：采用微分处理法求解DBA高程地球椭球约束方程，即将椭球约束方程在用户的近似位置
Figure 531727DEST_PATH_IMAGE048
按照泰勒级数展开，仅保留一阶项。将式（2）第5行两边对求偏微分得：
Figure 140563DEST_PATH_IMAGE051
（5）
整理得：
Figure 127105DEST_PATH_IMAGE052
（6）
同理对
Figure DEST_PATH_IMAGE091
和求偏微分可得：
Figure 200103DEST_PATH_IMAGE055
（7）
Figure 168059DEST_PATH_IMAGE092
（8）
由此可得
Figure DEST_PATH_IMAGE093
（9）
其中
Figure 578705DEST_PATH_IMAGE058
，
Figure 87047DEST_PATH_IMAGE094
，
Figure 217814DEST_PATH_IMAGE060
，
Figure 356671DEST_PATH_IMAGE061
为观测值，h为DBA获取的高程值，
Figure DEST_PATH_IMAGE095
为用户在近似位置
Figure 753149DEST_PATH_IMAGE063
转换得到的大地高。
步骤4：联合式（3）、（4）和（9）组成GNSS/UWB/DBA融合定位平差模型为：
Figure 2864DEST_PATH_IMAGE064
，P1 （10）
式中，
Figure 50455DEST_PATH_IMAGE065
，
Figure 360213DEST_PATH_IMAGE066
，
Figure 430938DEST_PATH_IMAGE067
，
Figure 795929DEST_PATH_IMAGE096
分别表示观测向量、设计矩阵、待估参数和残差，P1为GNSS/UWB/DBA融合定位观测值的先验权阵。
步骤5：采用单历元加权最小二乘平差方法进行参数估计：
Figure 635709DEST_PATH_IMAGE070
（11）
式中，
Figure DEST_PATH_IMAGE097
为参数
Figure 178686DEST_PATH_IMAGE098
的方差-协方差矩阵。
步骤6：采用最小二乘降相关（LAMBDA）算法进行双差模糊度固定，设置Ratio阈值为3，如果能够通过验证，将位置参数的浮点解转换为固定解，GNSS相对定位模型双差模糊度具有整数特性，通过固定双差模糊度可以显著提高定位精度。否则输出浮点解结果。
2）随机模型
GNSS非差观测值随机模型采用正弦三角函数高度角定权模型：
Figure DEST_PATH_IMAGE099
（12）
其中，Factor表示观测值类型的权分配因子，当观测值类型为载波相位时赋为1；当观测值类型为伪距时赋为100；a，b通常同时取0.003m。根据误差传播定律，GNSS双差相对定位方差-协方差矩阵可表示为：
Figure 284176DEST_PATH_IMAGE100
（13）
上式中，
Figure DEST_PATH_IMAGE101
为GNSS双差观测量协方差矩阵，
Figure 141273DEST_PATH_IMAGE102
为单差-双差线性变换系数矩阵，其中E为，m×m单位矩阵，I为m维的单位矢量，m=s-1为双差方程数目，
Figure DEST_PATH_IMAGE103
和
Figure 897877DEST_PATH_IMAGE104
分别表示GNSS系统码伪距和载波相位站间单差协方差矩阵。
对于采用TOA测量值定位的UWB系统而言，各个TOA测量值
Figure DEST_PATH_IMAGE105
互相独立，且均为零均值和方差为
Figure 858093DEST_PATH_IMAGE106
的随机变量。
Figure DEST_PATH_IMAGE107
可根据现场标定检测确定，一般优于0.1 ~0.2 m，则其观测方程的协方差矩阵为
Figure 965726DEST_PATH_IMAGE108
。对于采用TDOA测量值
Figure DEST_PATH_IMAGE109
进行定位的UWB系统，由于均存在
Figure 360935DEST_PATH_IMAGE110
，因此各
Figure DEST_PATH_IMAGE111
之间是相互关联的，此时UWB TDOA测量值的协方差矩阵可表示为:
Figure 722778DEST_PATH_IMAGE112
（14）
DBA系统获得的高程精度
Figure DEST_PATH_IMAGE113
可根据实际评估结果确定，根据以上结果，GNSS/UWB/DAB融合定位模型的随机模型可以表示为：
Figure 873136DEST_PATH_IMAGE114
（15）
式15中，
Figure 140170DEST_PATH_IMAGE027
、
Figure 73491DEST_PATH_IMAGE028
、
Figure 53954DEST_PATH_IMAGE029
分别为GNSS双差观测量、UWB的TDOA观测量、DBA高程的方差-协方差矩阵。式11中观测值向量权阵P1即为式15中
Figure 312897DEST_PATH_IMAGE069
的逆矩阵。
根据以上步骤，具体的GNSS/UWB/DBA融合数据处理流程如图2所示：
S3：GNSS/DBA组合室外定位:
进入室外环境下，由于距离较远，UWB不再可用，而DBA在室外高程精度可靠有效范围可达十几公里，基本与GNSS RTK/RTD作业范围相近。因此，室外环境下仅采用GNSS/DBA组合实现开阔或复杂城市环境下的定位精度提升，具体的观测方程与第2部分中式2中第一、二、五行一致，对应的函数模型求解过程与式3、式5~11一致，这里不在赘述，随机模型可表述为：
Figure DEST_PATH_IMAGE115
（16）
式16中，同样
Figure 863964DEST_PATH_IMAGE116
、
Figure DEST_PATH_IMAGE117
分别为GNSS双差观测量、DBA高程的方差-协方差矩阵。观测值向量权阵P2即为式16中
Figure 679604DEST_PATH_IMAGE118
的逆矩阵。

Claims (7)

1.一种基于GNSS/UWB/DBA融合的室内外无缝切换定位方法，其特征在于：包括S1：室内环境通过UWB和DBA组合实现三维定位；S2：室内外无缝切换场景通过GNSS、UWB和DBA多源传感器组合实现三维定位；S3：室外环境采用GNSS和DBA组合实现三维定位。
2.根据权利要求1所述的基于GNSS/UWB/DBA融合的室内外无缝切换定位方法，其特征在于：S1的具体实现方法为：将UWB主、从基站布设在同一高度的平面内，其三维位置事先测定，UWB主基站和移动标签上同时集成放置低成本气压计，以UWB主基站高程作为DBA模型高程基准，构建UWB/DBA组合三维定位模型，该模型融合了UWB和DBA两种信号源，以高精度测距和气压观测值为基础联合解算获得移动用户的三维坐标信息。
3.根据权利要求2所述的基于GNSS/UWB/DBA融合的室内外无缝切换定位方法，其特征在于：所述的UWB/DBA组合三维定位模型如式1所示，
Figure DEST_PATH_IMAGE001
（1）
式中，
Figure 786058DEST_PATH_IMAGE002
为UWB主基站BS1已知坐标，从基站平面坐标为
Figure DEST_PATH_IMAGE003
，标签位置为
Figure 950323DEST_PATH_IMAGE004
，
Figure DEST_PATH_IMAGE005
为TDOA测量值，
Figure DEST_PATH_IMAGE007
为BS1处气压模块读数，
Figure 503533DEST_PATH_IMAGE008
为Tag处气压模块读数，
Figure DEST_PATH_IMAGE009
为BS1和Tag之间平均摄氏温度，即
Figure 106553DEST_PATH_IMAGE010
，
Figure DEST_PATH_IMAGE011
为BS1处温度，
Figure 297494DEST_PATH_IMAGE012
为Tag处温度。
4.根据权利要求3所述的基于GNSS/UWB/DBA融合的室内外无缝切换定位方法，其特征在于：S2的具体实现方法为：
S21：在用户从室内到室外无缝切换过渡阶段，判断可见的UWB基站小于3个和GNSS卫星不足4颗时作为阈值条件自动切换为室内外无缝切换场景解算模式；
S22：获取GNSS基准站、移动站观测数据以及广播星历数据；获取UWB基站坐标及TDOA数据；获取DBA数据并处理转换为高程数据；
S23：GNSS、UWB、DBA观测数据时间同步匹配；
S24：构建GNSS/UWB/DBA组合三维定位模型；
S25：联合解算获得移动用户的三维坐标信息,实现室内外的连续定位。
5.根据权利要求4所述的基于GNSS/UWB/DBA融合的室内外无缝切换定位方法，其特征在于：S24中，GNSS/UWB/DBA组合三维定位模型如式2所示，
Figure DEST_PATH_IMAGE013
（2）
上式中，第1、2行中
Figure 898240DEST_PATH_IMAGE014
表示GNSS观测值之间的双差算子，i和j表示参考值和流动站，k和s为参考星和非参考星，
Figure DEST_PATH_IMAGE015
和
Figure 423899DEST_PATH_IMAGE016
表示码伪距和载波相位双差观测值，
Figure DEST_PATH_IMAGE017
表示双差站星距，
Figure 76947DEST_PATH_IMAGE018
表示双差码伪距观测噪声，
Figure 574925DEST_PATH_IMAGE020
表示双差模糊度，
Figure DEST_PATH_IMAGE021
表示双差相位观测噪声；第3、4行中
Figure 143309DEST_PATH_IMAGE022
为UWB TDOA观测值，
Figure DEST_PATH_IMAGE023
为m个UWB基站三维坐标，
Figure 359527DEST_PATH_IMAGE024
为用户三维坐标；第5行为利用DBA高程h构建的近似椭球约束方程，等效于增加一颗位于地心的虚拟卫星，a和b分别为地球参考椭球长、短半轴；
GNSS/UWB/DAB融合定位模型的随机模型为：
Figure DEST_PATH_IMAGE025
（15）
式15中，
Figure 55082DEST_PATH_IMAGE026
、
Figure DEST_PATH_IMAGE027
、
Figure 469883DEST_PATH_IMAGE028
分别为GNSS双差观测量、UWB的TDOA观测量、DBA高程的方差-协方差矩阵。
6.根据权利要求5所述的基于GNSS/UWB/DBA融合的室内外无缝切换定位方法，其特征在于：S25中，GNSS/UWB/DBA组合三维定位模型的解算包括以下步骤，
步骤1：将式2中GNSS双差观测方程线性化，在近似位置
Figure DEST_PATH_IMAGE029
处采用泰勒级数展开后并化简可得：
Figure 458436DEST_PATH_IMAGE030
（3）
式3中，
Figure DEST_PATH_IMAGE031
，
Figure 896371DEST_PATH_IMAGE032
，
Figure 644884DEST_PATH_IMAGE034
为方向余弦，m=s-1为双差方程数量，
Figure DEST_PATH_IMAGE035
，
Figure 851874DEST_PATH_IMAGE036
为伪距和载波相位观测值向量；
步骤2：将UWB Tag在近似位置
Figure DEST_PATH_IMAGE037
处采用泰勒级数展开后并化简可得：
Figure 778373DEST_PATH_IMAGE038
（4）
式4中，
Figure DEST_PATH_IMAGE039
为UWB观测值向量，
Figure 765921DEST_PATH_IMAGE040
为各BS到Tag的近似距离，
Figure DEST_PATH_IMAGE041
，
Figure 990229DEST_PATH_IMAGE042
，
Figure DEST_PATH_IMAGE043
分别为各BS到Tag的方向余弦，其中
Figure 631819DEST_PATH_IMAGE044
；
步骤3：采用微分处理法求解DBA高程地球椭球约束方程，即将椭球约束方程在用户的近似位置
Figure 916170DEST_PATH_IMAGE046
按照泰勒级数展开，仅保留一阶项，将式2第5行两边对求偏微分得：
Figure DEST_PATH_IMAGE047
（5）
整理得：
Figure 125434DEST_PATH_IMAGE048
（6）
同理对和求偏微分可得：
Figure DEST_PATH_IMAGE049
（7）
Figure 966482DEST_PATH_IMAGE050
（8）
由此可得
Figure DEST_PATH_IMAGE051
（9）
其中
Figure 210382DEST_PATH_IMAGE052
，
Figure DEST_PATH_IMAGE053
，
Figure 665634DEST_PATH_IMAGE054
，
Figure DEST_PATH_IMAGE055
为观测值，h为DA获取的高程值，
Figure 877041DEST_PATH_IMAGE056
为用户在近似位置
Figure DEST_PATH_IMAGE057
转换得到的大地高；
步骤4：联合式3、式4和式9组成GNSS/UWB/DBA融合定位平差模型为：
Figure 505469DEST_PATH_IMAGE058
，P1 （10）
式中，
Figure DEST_PATH_IMAGE059
，
Figure 541558DEST_PATH_IMAGE060
，
Figure DEST_PATH_IMAGE061
，
Figure 980761DEST_PATH_IMAGE062
分别表示观测向量、设计矩阵、待估参数和残差，P1为GNSS/UWB/DBA融合定位观测值的先验权阵，P1为式15中
Figure DEST_PATH_IMAGE063
的逆矩阵；
步骤5：采用单历元加权最小二乘平差方法进行参数估计：
Figure 164617DEST_PATH_IMAGE064
（11）
式中，
Figure DEST_PATH_IMAGE065
为参数
Figure 866511DEST_PATH_IMAGE066
的方差-协方差矩阵；
步骤6：采用最小二乘降相关算法进行双差模糊度固定，设置Ratio阈值为3，如果能够通过验证，将位置参数的浮点解转换为固定解，否则输出浮点解结果。
7.根据权利要求6所述的基于GNSS/UWB/DBA融合的室内外无缝切换定位方法，其特征在于：S3中，构建的GNSS/DBA组合三维定位模型为：
Figure DEST_PATH_IMAGE067
，P2
随机模型为：
Figure 22686DEST_PATH_IMAGE068
式中，同样
Figure DEST_PATH_IMAGE069
、
Figure 882058DEST_PATH_IMAGE070
分别为GNSS双差观测量、DBA高程的方差-协方差矩阵，观测值向量权阵P2即为中
Figure DEST_PATH_IMAGE071
的逆矩阵。
CN202210047452.XA 2022-01-17 2022-01-17 一种基于gnss/uwb/dba融合的室内外无缝切换定位方法 Active CN114526737B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210047452.XA CN114526737B (zh) 2022-01-17 2022-01-17 一种基于gnss/uwb/dba融合的室内外无缝切换定位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210047452.XA CN114526737B (zh) 2022-01-17 2022-01-17 一种基于gnss/uwb/dba融合的室内外无缝切换定位方法

Publications (2)

Publication Number Publication Date
CN114526737A true CN114526737A (zh) 2022-05-24
CN114526737B CN114526737B (zh) 2024-04-12

Family

ID=81621734

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210047452.XA Active CN114526737B (zh) 2022-01-17 2022-01-17 一种基于gnss/uwb/dba融合的室内外无缝切换定位方法

Country Status (1)

Country Link
CN (1) CN114526737B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116086448A (zh) * 2023-04-12 2023-05-09 成都信息工程大学 基于uwb、imu、gnss融合的无人设备多场景无缝定位方法

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101616720B1 (ko) * 2014-10-29 2016-05-02 동명대학교 산학협력단 실내외 연속 위치추정 시스템 및 그 방법
CN107861143A (zh) * 2017-10-31 2018-03-30 太原理工大学 一种bds/wlan组合定位算法
CN110645979A (zh) * 2019-09-27 2020-01-03 北京交通大学 基于gnss/ins/uwb组合的室内外无缝定位方法
JP2020159997A (ja) * 2019-03-28 2020-10-01 本田技研工業株式会社 位置同定装置および位置同定方法
CN111829525A (zh) * 2020-07-22 2020-10-27 深圳市微能信息科技有限公司 Uwb室内外一体智能导航定位方法和系统
CN113074732A (zh) * 2021-03-22 2021-07-06 东南大学 一种室内外无缝定位系统及其定位方法
WO2021176308A1 (en) * 2020-03-04 2021-09-10 Magellan Systems Japan, Inc. Indoor-outdoor dual-use high precision positioning system
CN113419264A (zh) * 2021-06-11 2021-09-21 杭州电子科技大学 一种高精度室内外定位系统及室内外定位与过渡方法
CN113568021A (zh) * 2021-08-10 2021-10-29 广东师大维智信息科技有限公司 一种室内外一体化精准定位的方法及系统
CN113899370A (zh) * 2021-09-26 2022-01-07 东南大学 一种基于gnss_uwb的多传感器组合室内外无缝定位方法

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101616720B1 (ko) * 2014-10-29 2016-05-02 동명대학교 산학협력단 실내외 연속 위치추정 시스템 및 그 방법
CN107861143A (zh) * 2017-10-31 2018-03-30 太原理工大学 一种bds/wlan组合定位算法
JP2020159997A (ja) * 2019-03-28 2020-10-01 本田技研工業株式会社 位置同定装置および位置同定方法
CN110645979A (zh) * 2019-09-27 2020-01-03 北京交通大学 基于gnss/ins/uwb组合的室内外无缝定位方法
WO2021176308A1 (en) * 2020-03-04 2021-09-10 Magellan Systems Japan, Inc. Indoor-outdoor dual-use high precision positioning system
CN111829525A (zh) * 2020-07-22 2020-10-27 深圳市微能信息科技有限公司 Uwb室内外一体智能导航定位方法和系统
CN113074732A (zh) * 2021-03-22 2021-07-06 东南大学 一种室内外无缝定位系统及其定位方法
CN113419264A (zh) * 2021-06-11 2021-09-21 杭州电子科技大学 一种高精度室内外定位系统及室内外定位与过渡方法
CN113568021A (zh) * 2021-08-10 2021-10-29 广东师大维智信息科技有限公司 一种室内外一体化精准定位的方法及系统
CN113899370A (zh) * 2021-09-26 2022-01-07 东南大学 一种基于gnss_uwb的多传感器组合室内外无缝定位方法

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
JIANG, WEI ET AL.: "Indoor and Outdoor Seamless Positioning Method Using UWB Enhanced Multi-Sensor Tightly-Coupled Integration", 《IEEE TRANSACTIONS ON VEHICULAR TECHNOLOGY》, vol. 70, no. 10, 27 October 2021 (2021-10-27), pages 10633 - 10645, XP011883010, DOI: 10.1109/TVT.2021.3110325 *
刘志平;余前勇;: "多传感器融合的手机室内三维定位试验", 山东科技大学学报(自然科学版), no. 06, 31 December 2015 (2015-12-31), pages 96 - 101 *
姚子扬等: "一种多源融合室内外无缝定位方法", 《传感技术学报》, vol. 35, no. 1, 15 January 2022 (2022-01-15), pages 72 - 83 *
胡可等: "基于GPS与Wi-Fi位置指纹的室内外无缝定位研究", 《计算机工程》, vol. 42, no. 2, 29 February 2016 (2016-02-29), pages 98 - 103 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116086448A (zh) * 2023-04-12 2023-05-09 成都信息工程大学 基于uwb、imu、gnss融合的无人设备多场景无缝定位方法

Also Published As

Publication number Publication date
CN114526737B (zh) 2024-04-12

Similar Documents

Publication Publication Date Title
CA2393505C (en) Method and apparatus for determining an algebraic solution to gps terrestrial hybrid location system equations
CN106255065B (zh) 智能手机室内外无缝定位系统及其方法
US9158001B2 (en) Indoor satellite navigation system
Li et al. 3D DOPs for positioning applications using range measurements
GB2508255A (en) Determining Locations of a Plurality of Radio Frequency Signal Sources
WO2010085822A2 (en) Systems and methods with improved three-dimensional source location processing including constraint of location solutions to a two-dimensional plane
CN109974694B (zh) 一种基于uwb/imu/气压计的室内行人3d定位方法
CN108845345B (zh) 利用gnss测速原理的双天线定向测姿的方法
Adjrad et al. Intelligent urban positioning using shadow matching and GNSS ranging aided by 3D mapping
CN114526737A (zh) 一种基于gnss/uwb/dba融合的室内外无缝切换定位方法
JIANG et al. A New Kind of Real‐Time PPP Method for GPS Single‐Frequency Receiver Using CORS Network
EP3265846A1 (en) Gnss cooperative receiver system
Wang et al. Mobile location method for non-line-of-sight situation
WO2011041430A1 (en) Determining position in a hybrid positioning system using a dilution of precision metric
CN109116396B (zh) 一种多天线gnss差分定位方法
Wang et al. Velocity estimations by combining time-differenced GPS and Doppler observations
CN109490828B (zh) 基于同源基线阵列的定位方法
Sakamoto et al. High-accuracy IMES localization using a movable receiver antenna and a three-axis attitude sensor
US7821457B2 (en) Method and device for automatically determining the position of transceivers of navigation signals
Roth Data Collection.
Adjrad et al. 3D-mapping-aided GNSS exploiting Galileo for better accuracy in dense urban environments
CN114167469A (zh) 一种基于5g/gnss组合的车辆导航信息监测方法和装置
Raghunath et al. Analysis of GPS errors during different times in a day
Kim et al. Indoor positioning system using single pseudolite with multiple antenna
Yun et al. A GNSS/Barometric Altimeter Tightly-coupled Integration for Three-Dimensional Semi-indoor Mapping with Android Smartphones

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