CN108919304B - 一种基于参考平面的移动测量系统中pos误差补偿方法 - Google Patents
一种基于参考平面的移动测量系统中pos误差补偿方法 Download PDFInfo
- Publication number
- CN108919304B CN108919304B CN201810183853.1A CN201810183853A CN108919304B CN 108919304 B CN108919304 B CN 108919304B CN 201810183853 A CN201810183853 A CN 201810183853A CN 108919304 B CN108919304 B CN 108919304B
- Authority
- CN
- China
- Prior art keywords
- pos
- error
- coordinate system
- reference plane
- errors
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
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/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/03—Cooperating elements; Interaction or communication between different cooperating elements or between cooperating elements and receivers
- G01S19/07—Cooperating elements; Interaction or communication between different cooperating elements or between cooperating elements and receivers providing data for correcting measured positioning data, e.g. DGPS [differential GPS] or ionosphere corrections
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于参考平面的移动测量系统中POS误差补偿方法,其包括如下步骤:s1.利用已有的平面特征(建筑平面等)或人工布设的平面作为参考平面,利用测绘手段结合GNSS控制网获取参考平面上点的三维坐标,从而获取参考平面的参数,在此基础上根据已知参考平面方程和点云定位方程建立平差模型,求解出移动测量系统在经过该遮挡区域时的POS误差;s2.上述求解得到的POS误差仅是离散的某些时刻的误差,要利用这些POS误差补偿整个被遮挡时间段的POS信息还需分析POS误差的特性,得到POS误差和时间的相关关系,以此建立类线性或类高斯模型将POS误差补偿到POS信息中。本发明在GNSS卫星信号失锁时补偿POS误差信息,进一步提高了移动测量系统的点云成果指标。
Description
技术领域
本发明涉及一种基于参考平面的移动测量系统中POS误差补偿方法。
背景技术
目前移动测量系统中最常用的POS系统为全球卫星导航系统(Globle NavigationSatellite System,GNSS)和惯性导航系统(Inertial Navigation System,INS)组合导航技术。INS导航系统能够在任何介质环境里进行独立自主的、隐蔽的、连续的空间三维定位和定向,但是受惯性器件误差、初始对准的精度以及载体的动态特性的影响使得导航误差随时间不断累积。而GNSS卫星导航系统具有定位精度高、观测时间短、全天候作业等优点,能够对INS导航系统不断进行误差修正。二者优势互补共同为移动测量系统提供高精度定位定姿信息。
但是在城市环境下测量时,GNSS导航系统的天线头容易被城市高楼遮挡,产生GNSS信号失锁现象,使得GNSS无法准确定位,若GNSS信号持续失锁,长时间无法为INS导航系统提供误差修正,会直接导致导航误差不断累积,无法满足移动测量系统的精度要求。故在遮挡严重的环境下进行移动测量作业必须找到一种POS误差补偿方式,以便在测量作业中遇到高楼遮挡导致GNSS信号失锁不能提供位置信息时,可以及时补偿POS信息,从而保持移动测量系统精度。
随着移动测量技术的发展,国内外学者针对移动测量系统中在复杂环境下GNSS信号失锁时提高POS精度进行了广泛的研究。其中,关于GNSS失锁时提高POS精度问题的一般做法是:1、增加其他的观测值,如里程计等;2、增加约束,非完整约束,包括零速更新等;3、通过控制点坐标进行修正。
其中,通过控制点坐标信息来改善POS信息的方法中,多是通过在轨迹内提取特征点,或者提前安置好的易识别的位置坐标已知的特征点,计算对应的测量的点云的坐标差异,来获取给定时间的外部位置更新,但是该类方法在实际应用过程中存在的最大问题便是在点云信息中的特征点主要靠手工操作提取,很难做到精确提取。而且这些特征点坐标的获取也会耗费大量的人力资源,成本高、效率低。
另外,通过里程计信息改善POS信息的方法中,通过计算相应GNSS失锁时间内里程计输出的脉冲个数对GNSS/INS车载组合导航系统的状态量进行校正。但一方面里程计刻度因子受温度、胎压等影响其初值并不明确;另一方面其误差随行驶距离而线型累积且该误差受车速影响较大。
发明内容
本发明的目的在于提出一种基于参考平面的移动测量系统中POS误差补偿方法,以便在GNSS卫星信号失锁时补偿POS误差信息,从而提高POS精度。
本发明为了实现上述目的,采用如下技术方案:
一种基于参考平面的移动测量系统中POS误差补偿方法,包括如下步骤:
s1.基于参考平面的POS误差求解
s1.1在移动测量系统中进行坐标转换
激光点云在WGS84坐标系下的定位方程为:
其中:
为当地水平坐标系到WGS84坐标系的旋转矩阵;
为激光点云在WGS84坐标系下的坐标;
其中:
利用POS信息获得;
POS误差包括三个位置误差和三个姿态误差,其中,三个位置误差分别为ΔXoe、ΔYoe、ΔZoe,三个姿态误差分别为Δr、Δp、Δy;
在GNSS信号遮挡导致POS出现误差时,激光点云的定位方程为:
s1.2计算参考平面参数
使用全站仪结合GNSS控制网获得参考平面上点的坐标,设定参考平面上共有n个测量点数据,每个测量点的坐标为(xi,yi,zi),其中,i=1,2,…,n,已知空间平面的一般形式为:
ax+by+cz-d=0 (11)
其中,a,b,c为平面的单位法向量,d为坐标原点到平面的距离;
通过特征值法获取参考平面的参数;
s1.3平差模型的建立及POS误差解算
s1.3.1Gauss-Helmert平差模型的一般形式为:
s1.3.2参考平面在WGS84坐标系下的平面方程为:
apXe+bpYe+cpZe-dp=0 (13)
其中,ap、bp、cp、dp表示第p个参考平面的平面参数;Xe、Ye、Ze表示激光点云在WGS84坐标系下的坐标;
s1.3.3建立POS误差解算的函数平差模型
根据公式(2)和公式(6)得到基于参考平面的POS误差解算的平差函数模型::
观测值:l=[Xb Yb Zb]T;
POS误差参数:x=[ΔXoe ΔYoe ΔZoe Δr Δp Δy];
对公式(7)进行线性化得Gauss-Helmert模型,即公式(5),其中:
s1.3.4求解法方程,得到POS误差
其中,Φ表示新的函数模型,P表示权重矩阵,K表示联系数向量;
得到附有参数条件平差的基础方程:
令Naa=AP-1AT,得到法方程:
最终形式为:
其中,
求解法方程,得到未知数POS误差;
s2.基于POS误差和时间相关关系的POS误差补偿
GNSS信号失锁后的位置误差变化具有一定的类线性关系以及一定的类高斯函数特征,因此有两种方式进行误差补偿:
第一种为类线性函数模型POS误差补偿;第二种为类高斯分布函数模型POS误差补偿;
下面分别采用以上两种方法进行POS误差补偿:
s2.1类线性模型补偿
设GNSS卫星信号在t0~tn时刻被遮挡,一般情况下,经过平滑后解算出的导航信息在中间时刻tmid误差达到最大值,GNSS信号失锁时间段内误差和时间存在如下类线性关系:
yt=±|k(t-tmid)|+bt,t0≤t≤tn (10)
根据公式(10)对解算出的POS数据中的位置误差进行类线性补偿;
s2.2类高斯模型补偿
设GNSS卫星信号在t0~tn时刻被遮挡,一般情况下,经过平滑后解算出的导航信息在中间时刻tmid误差达到最大值,GNSS信号失锁时间段内误差和时间存在如下类高斯关系:
根据公式(11)对解算出的POS数据中的位置误差进行高斯函数模型补偿。
本发明具有如下优点:
本发明提出的基于参考平面的POS误差补偿方法,是在卫星信号失锁区域布设参考平面,通过点云定位方程和平面方程设计出一种求解POS误差的函数模型,进而求解出某一时间段内的POS误差,在GNSS卫星信号失锁时补偿POS误差信息,提高POS精度。其优势在于:1、本发明方法可依赖现有的建筑平面,相对于已知点来说,方便寻找,易于实施,精度更高;2、另外,本发明方法没有车速限制,可直接对GNSS信号失锁时间段进行POS误差补偿。
附图说明
图1为本发明中基于参考平面的移动测量系统中POS误差补偿方法的原理框图。
具体实施方式
下面结合附图以及具体实施方式对本发明作进一步详细说明:
一种基于参考平面的移动测量系统中POS误差补偿方法,主要包括基于参考平面特征的POS误差求解以及基于POS误差和时间相关关系的POS误差补偿两个步骤。
其中,在基于参考平面特征的POS误差求解步骤中:
在高大建筑,GNSS信号易被遮挡的地段布设参考平面,设计一种基于参考平面的POS误差求解模型,即根据参考平面方程和点云定位方程建立平差模型,并求出移动测量系统经过该遮挡区域时的POS误差。
在基于POS误差和时间相关关系的POS误差补偿步骤中:
通过分析卫星失锁时间段内POS误差的特性得到POS误差和时间相关关系,以此建立类线性或类高斯模型,将POS误差补偿到POS信息中。
下面对以上两个步骤作进一步详细说明:
结合图1所示,一种基于参考平面的移动测量系统中POS误差补偿方法,包括步骤:
s1.基于参考平面的POS误差求解
s1.1移动测量系统中坐标转换
移动测量系统定位的几何模型,是在不同坐标系转换的基础上推导的。
系统测量直接得到的是激光扫描仪参考坐标系下的点云坐标,经过一系列的坐标转换,最终将激光点的坐标转换到WGS-84坐标系下,实现激光点云的定位。坐标转换顺序是激光扫描参考坐标系→惯性平台参考坐标系→当地水平参考坐标系→WGS-84坐标系。
对此,经过一系列坐标转换,可以得到激光点云在WGS84坐标系下的定位方程为:
其中:
为惯性平台坐标系到当地水平坐标系的旋转矩阵;
其中:
因此在整个定位过程中,POS信息的精度相当重要。POS误差包括三个位置误差和三个姿态误差,三个位置误差分别为ΔXoe、ΔYoe、ΔZoe,三个姿态误差分别为Δr、Δp、Δy。
在GNSS信号遮挡导致POS出现误差时,激光点云的定位方程为:
s1.2计算参考平面参数
使用全站仪结合GNSS控制网获得参考平面上点的坐标,设定参考平面上共有n个测量点数据,每个测量点的坐标为(xi,yi,zi),其中,i=1,2,…,n,已知空间平面的一般形式为:
ax+by+cz-d=0 (18)
其中,a、b、c为平面的单位法向量,d为坐标原点到平面的距离;
通过特征值法获取参考平面的参数a、b、c、d。
s1.3平差模型的建立及POS误差解算
s1.3.1Gauss-Helmert平差模型的一般形式为:
s1.3.2参考平面在WGS84坐标系下的平面方程为:
apXe+bpYe+cpZe-dp=0 (20)
其中,ap、bp、cp、dp表示第p个参考平面的平面参数;Xe、Ye、Ze表示激光点云在WGS84坐标系下的坐标。
s1.3.3建立POS误差解算的函数平差模型
根据公式(2)和公式(6)得到基于参考平面的POS误差解算的平差函数模型:
其中:
观测值:l=[Xb Yb Zb]T;
POS误差参数:x=[ΔXoe ΔYoe ΔZoe Δr Δp Δy]。
对公式(7)进行线性化得Gauss-Helmert模型,即公式(5),其中:
s1.3.4求解法方程,得到POS误差
其中,Φ表示新的函数模型,P表示权重矩阵,K表示联系数向量。
对v和分别求一阶导数并令其为零,得到:
得到附有参数条件平差的基础方程:
化简得到:
令Naa=AP-1AT,得到法方程:
最终形式为:
求解法方程,得到未知数POS误差。
s2.基于POS误差和时间相关关系的POS误差补偿
GNSS信号失锁后的位置误差变化具有一定的类线性关系以及一定的类高斯函数特征,可以有两种方式进行误差补偿:
第一种为类线性函数模型POS误差补偿;第二种为类高斯分布函数模型POS误差补偿。
本发明实施,分别采用两种方法进行POS误差补偿:
s2.1类线性模型补偿
设GNSS卫星信号在t0~tn时刻被遮挡,一般情况下,经过平滑后解算出的导航信息在中间时刻tmid误差达到最大值,通过实际实验分析:
GNSS信号失锁时间段内误差和时间存在如下类线性关系:
yt=±|k(t-tmid)|+bt,t0≤t≤tn (10)
根据公式(10)对解算出的POS数据中的位置误差进行类线性补偿;
s2.2类高斯模型补偿
设GNSS卫星信号在t0~tn时刻被遮挡,一般情况下,经过平滑后解算出的导航信息在中间时刻tmid误差达到最大值,通过实际实验分析:
GNSS信号失锁时间段内误差和时间存在如下类高斯关系:
根据公式(11)对解算出的POS数据中的位置误差进行高斯函数模型补偿。
由于本发明首先通过布设的参考平面信息和点云信息计算出GNSS信号失锁时间段内的中间时刻的POS误差值,然后根据POS误差和时间的相关关系对该时间段内其它时刻进行POS误差补偿,因此在GNSS卫星信号失锁时便于补偿POS误差信息,提高POS精度。
需要说明的是,本实施例中的参考平面可以由曲面、球面等特征面代替。
当然,以上说明仅仅为本发明的较佳实施例,本发明并不限于列举上述实施例,应当说明的是,任何熟悉本领域的技术人员在本说明书的教导下,所做出的所有等同替代、明显变形形式,均落在本说明书的实质范围之内,理应受到本发明的保护。
Claims (1)
1.一种基于参考平面的移动测量系统中POS误差补偿方法,其特征在于,包括如下步骤:
s1.基于参考平面的POS误差求解
s1.1在移动测量系统中进行坐标转换
激光点云在WGS84坐标系下的定位方程为:
其中:
为当地水平坐标系到WGS84坐标系的旋转矩阵;
为激光点云在WGS84坐标系下的坐标;
经过精密检校后,和可视为没有误差,则公式(1)可简化为:
其中:
为激光点云在惯性平台坐标系下的坐标;
POS误差包括三个位置误差和三个姿态误差,其中,三个位置误差分别为ΔXoe、ΔYoe、ΔZoe,三个姿态误差分别为Δr、Δp、Δy;
在GNSS信号遮挡导致POS出现误差时,激光点云的定位方程为:
s1.2计算参考平面参数
使用全站仪结合GNSS控制网获得参考平面上点的坐标,设定参考平面上共有n个测量点数据,每个测量点的坐标为(xi,yi,zi),其中,i=1,2,…,n,已知空间平面的一般形式为:
ax+by+cz-d=0 (4)
其中,a,b,c为平面的单位法向量,d为坐标原点到平面的距离;
通过特征值法获取参考平面的参数;
s1.3平差模型的建立及POS误差解算
s1.3.1Gauss-Helmert平差模型的一般形式为:
s1.3.2参考平面在WGS84坐标系下的平面方程为:
apXe+bpYe+cpZe-dp=0 (6)
其中,ap、bp、cp、dp表示第p个参考平面的平面参数;Xe、Ye、Ze表示激光点云在WGS84坐标系下的坐标;
s1.3.3建立POS误差解算的平差模型
根据公式(2)和公式(6)得到基于参考平面的POS误差解算的平差模型:
观测值:l=[Xb Yb Zb]T;
POS误差参数:x=[ΔXoe ΔYoe ΔZoe Δr Δp Δy];
对公式(7)进行线性化得Gauss-Helmert模型,即公式(5),其中:
s1.3.4求解法方程得到POS误差
其中,Φ表示新的函数模型,P表示权重矩阵,K表示联系数向量;
对v和分别求一阶导数并令其为零,得到:
得到附有参数条件平差的基础方程:
化简得到:
令Naa=AP-1AT,得到法方程:
最终形式为:
求解法方程,得到未知数POS误差;
s2.基于POS误差和时间相关关系的POS误差补偿
GNSS信号失锁后的位置误差变化具有一定的类线性关系以及一定的类高斯函数特征,因此有两种方式进行误差补偿:
第一种为类线性函数模型POS误差补偿;第二种为类高斯分布函数模型POS误差补偿;
下面分别采用以上两种方法进行POS误差补偿:
s2.1类线性模型补偿
设GNSS卫星信号在t0~tn时刻被遮挡,一般情况下,经过平滑后解算出的导航信息在中间时刻tmid误差达到最大值,GNSS信号失锁时间段内误差和时间存在如下类线性关系:
yt=±|k(t-tmid)|+bt,t0≤t≤tn (10)
其中,
根据公式(10)对解算出的POS数据中的位置误差进行类线性补偿;
s2.2类高斯模型补偿
设GNSS卫星信号在t0~tn时刻被遮挡,一般情况下,经过平滑后解算出的导航信息在中间时刻tmid误差达到最大值,GNSS信号失锁时间段内误差和时间存在如下类高斯关系:
根据公式(11)对解算出的POS数据中的位置误差进行高斯函数模型补偿。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810183853.1A CN108919304B (zh) | 2018-03-07 | 2018-03-07 | 一种基于参考平面的移动测量系统中pos误差补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810183853.1A CN108919304B (zh) | 2018-03-07 | 2018-03-07 | 一种基于参考平面的移动测量系统中pos误差补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108919304A CN108919304A (zh) | 2018-11-30 |
CN108919304B true CN108919304B (zh) | 2020-01-14 |
Family
ID=64403163
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810183853.1A Active CN108919304B (zh) | 2018-03-07 | 2018-03-07 | 一种基于参考平面的移动测量系统中pos误差补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108919304B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110044379B (zh) * | 2019-04-19 | 2020-10-16 | 武汉地震计量检定与测量工程研究院有限公司 | 一种移动测量系统标定方法 |
CN112817019B (zh) * | 2020-12-30 | 2024-03-12 | 北京理工大学 | 一种基于姿态信息的可控震源车工作点定位误差补偿方法 |
CN113658190B (zh) * | 2021-06-29 | 2022-06-14 | 桂林理工大学 | 张量投票的面特征航带平差方法 |
CN116184368B (zh) * | 2023-04-25 | 2023-07-11 | 山东科技大学 | 基于高斯-马尔科夫的机载雷达安置误差插值校正方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102415859B1 (ko) * | 2014-12-12 | 2022-07-04 | 삼성전자주식회사 | 위치를 추정하는 방법, 전자 장치 및 서버 |
CN107024687B (zh) * | 2016-02-01 | 2020-07-24 | 北京自动化控制设备研究所 | 一种离线快速实现pos/激光雷达安装误差标定的方法 |
CN106546262B (zh) * | 2016-10-11 | 2019-05-10 | 山东科技大学 | 基于平面控制和约束结合的移动测量系统外参数标定方法 |
CN107747944B (zh) * | 2017-09-18 | 2020-03-17 | 北京航空航天大学 | 基于融合权重矩阵的机载分布式pos传递对准方法和装置 |
-
2018
- 2018-03-07 CN CN201810183853.1A patent/CN108919304B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN108919304A (zh) | 2018-11-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108919304B (zh) | 一种基于参考平面的移动测量系统中pos误差补偿方法 | |
US20200103530A1 (en) | Method for extracting elevation control point with assistance of satellite laser altimetry data | |
CN109917356B (zh) | 一种机载激光扫描系统误差标定方法 | |
CN110220491B (zh) | 一种无人机的光学吊舱安装误差角估算方法 | |
CN106960174A (zh) | 高分影像激光雷达高程控制点提取及其辅助定位方法 | |
CN112987065B (zh) | 一种融合多传感器的手持式slam装置及其控制方法 | |
CN102346033B (zh) | 基于卫星观测角误差估计的直接定位方法及系统 | |
CN108230375B (zh) | 基于结构相似性快速鲁棒的可见光图像与sar图像配准方法 | |
CN106093892A (zh) | 基于标校卫星同时开展雷达rcs标定与外测标定系统 | |
CN104535080B (zh) | 大方位失准角下基于误差四元数的传递对准方法 | |
CN112833917B (zh) | 基于磁航向角和最小二乘法的三轴磁传感器标定方法 | |
CN103852760B (zh) | 一种基于刚性和柔性基线组合的多基线测量方法 | |
CN113538595B (zh) | 利用激光测高数据辅助提升遥感立体影像几何精度的方法 | |
CN103954953A (zh) | 一种基于数据驱动的机载激光雷达盲源误差补偿方法 | |
CN110363758B (zh) | 一种光学遥感卫星成像质量确定方法及系统 | |
CN103390102A (zh) | 一种卫星图像立体交会角的计算方法 | |
CN108362201A (zh) | 一种基于三维激光扫描的导航传感器参数标定方法和装置 | |
CN107564046A (zh) | 一种基于点云与uav影像二次配准的建筑物轮廓精确提取方法 | |
Liu et al. | Accurate mapping method for UAV photogrammetry without ground control points in the map projection frame | |
CN110646822B (zh) | 一种基于惯导辅助的整周模糊度Kalman滤波算法 | |
CN112132875A (zh) | 一种基于面特征的多平台点云匹配方法 | |
CN110046563B (zh) | 一种基于无人机点云的输电线路断面高程修正方法 | |
Chen et al. | 3D LiDAR-GPS/IMU calibration based on hand-eye calibration model for unmanned vehicle | |
CN109188483B (zh) | 一种时序化高精度外方位元素自动定标方法 | |
CN113255740B (zh) | 一种多源遥感影像平差定位精度分析方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |