CN105549057B - 一种惯性辅助的gps/bds融合大比例尺快速宗地测量装置与方法 - Google Patents
一种惯性辅助的gps/bds融合大比例尺快速宗地测量装置与方法 Download PDFInfo
- Publication number
- CN105549057B CN105549057B CN201510881356.5A CN201510881356A CN105549057B CN 105549057 B CN105549057 B CN 105549057B CN 201510881356 A CN201510881356 A CN 201510881356A CN 105549057 B CN105549057 B CN 105549057B
- Authority
- CN
- China
- Prior art keywords
- fuzziness
- observation
- gnss
- inertial navigation
- success rate
- 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.)
- Expired - Fee Related
Links
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/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
-
- 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/43—Determining position using carrier phase measurements, e.g. kinematic positioning; using long or short baseline interferometry
- G01S19/44—Carrier phase ambiguity resolution; Floating ambiguity; LAMBDA [Least-squares AMBiguity Decorrelation Adjustment] method
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)
Abstract
本发明公开了一种惯性辅助的GPS/BDS融合大比例尺快速宗地测量装置与方法,惯性辅助的GPS/BDS融合大比例尺快速宗地测量装置包括捷联惯导模块(3)、GNSS OEM板卡(2)、手簿控制端(100)以及FPGA核心板卡(4);该宗地测量方法集成连续跟踪卫星信号、惯性导航定位输出,基于秒脉冲信号实现数据的同步与集成,采用载波相位观测值进行紧组合定位解算,实现惯性辅助的GPS/BDS融合模糊度解算,并采用部分模糊度固定策略,有利于提高模糊度固定的成功率,该方法能够显著提高系统在遮蔽、半遮蔽区的定位精度和可靠性。本发明能够应用于各种实地宗地测量环境,很好的提高宗地测量作业的效率。
Description
技术领域
本发明涉及卫星定位、惯性定位以及组合导航定位技术,尤其是一种惯性辅助的GPS/BDS融合大比例快速宗地测量装置与方法,属于测绘与导航技术领域,是一种宗地测量方法。
背景技术
随着我国国民经济的快速发展,各行业对位置信息的需求日益增加,特别对于城镇区域大比例尺地形图,是国土管理与规划部门的基础资料,大比例尺地形图成为城镇建设规划必不可少的基础信息。目前,城镇区域存在着无图、图件缺少以及图件老旧的现状,极大地制约城镇区域空间规划。然而,面向城镇区域空间规划对三维地理信息图件的迫切需求,亟需解决城镇大比例尺快速更新难题。传统方法仍然是利用GPS(全球导航定位系统)和全站仪进行分级布网,完成宗地测量任务,普遍存在着宗地测量精度不高、自身技术受限制等诸多问题。为完成我国城镇区域海量高精度三维空间地理信息的快速采集,迫切需要一种适应各种复杂环境的快速宗地测量技术装备,保障我国城镇地理空间信息的现势性,满足城镇规划的需要。
GPS技术的问世,给导航与测量行业带来了深刻的变革,特别是载波相位实时动态定位技术(RTK)的出现,基于模糊度实时固定,可以实现厘米级与毫米级的定位精度,在地形图测量、地籍测量等领域发挥了重要的作用。随着我国自主建立的北斗导航卫星系统(BDS)的快速发展,通过多系统的融合,能够进一步提高系统的可靠性以及精度。卫星导航定位的实现前提是保证接收到4颗以上的卫星信号,但在城镇区域的宗地测量过程中,由于建筑物、树木密集,卫星信号受遮挡时常发生,极大地影响到了宗地测量的效率。
惯性导航系统(INS)是20世纪初发展起来的一种新的导航技术,通过惯性测量单元(IMU)测量角加速度及线加速度值,提供载体的实时位置,但定位误差随时间累积。惯性测量基于给定的初始动态(位置、速度及姿态),对加速度测量值进行一次积分得到速度信息,对速度信息进行一次积分获得位置信息,对角速度积分推算载体的姿态角,实现坐标的转换。惯性测量是一种无需外界信息的自主测量技术,更新速率快,适应各种作业环境,具有短时高精度的特点。但长时导航会出现位置偏离,需要外界信息进行修正。
集成卫星定位技术与惯性测量技术既可提高卫星定位模型的收敛速度,又可限制INS误差累积,随着惯性导航技术的进步以及惯导设备制造技术的不断成熟,采用高精度、低成本的惯导系统成为可能,从而能够极大的减小组合系统的重量、大小以及成本,使系统实用性得以增强。组合系统的使用能够有效提高外业人员的工作效率,减少作业成本,是解决遮蔽区大比例尺地形图测绘的必然趋势与发展方向。
发明内容
本发明的目的是针对现有宗地测量技术的不足,提供一种基于卫星定位与惯性定位的大比例尺快速宗地测量装置与方法,本发明能够快速、便捷、高效地完成村镇区域多种复杂环境的宗地测量工作。
本发明为实现上述目标,采用如下技术方案:
一种惯性辅助的GPS/BDS融合大比例尺快速宗地测量装置,包括捷联惯导模块(3)、GNSS OEM板卡(2)、手簿控制端(100)以及FPGA核心板卡(4);捷联惯导模块(3)用于采集惯性测量信息,输出包括加速度、角速度在内的惯导观测数据到FPGA核心板卡(4),GNSSOEM板卡(2)用于完成高精度GNSS信号的接收与处理,输出包括伪距、相位、时间在内的GNSS观测数据到FPGA核心板卡(4);FPGA核心板卡(4)用于标定惯导数据时间以及进行GNSS观测数据与惯导观测数据的数据融合,通过通讯模块(8)传输到手簿控制端,手簿控制端(100)包括捷联解算模块(9)、惯导辅助部分模糊度固定模块(10)、组合滤波模块(11);捷联解算模块(9)利用惯导数据进行捷联解算,惯导辅助部分模糊度固定模块(10)用于在卫星信号重新捕获后,利用惯导输出的定位信息进行部分模糊度固定,输出高精度相位信息;组合滤波模块(11)集成高精度相位信息和惯导输出进行GNSS/INS组合滤波;手簿控制端还接收GNSS原始观测信息与惯性测量信息,采用载波紧集成技术进行综合解算,同时进行点位信息存储与显示。
所述的宗地测量装置,惯导辅助部分模糊度固定模块(10)利用惯导输出的定位信息进行部分模糊度固定:
1)首先同步接收参考站和移动站GNSS载波相位和伪距观测信息,形成双差观测值
式中,为双差算子,“*”表示GPS“G”或北斗“C”.ρ和φ为伪距和载波观测值,星地距为ρ(0),T表示对流层误差,I为电离层误差,λ为载波波长,M和m分别表示伪距和载波多路径误差,ερ和εφ是伪距和载波观测噪声;
2)获得双差观测值后进行降相关处理;
3)集成利用INS预测位置信息,提高模糊度解算的可靠性,组合系统模糊度解算方差:
式中为GPS/BDS系统双差伪距,为双差相位观测值,为INS预测星地距,Xb为位置误差改正数,Xa为n维模糊度参数向量,Hb为设计矩阵,aρ和eφ分别为伪距和载波观测噪声,eINS为INS系统观测噪声,由组合滤波先验方程阵得到;L为观测向量,H为观测模型系数矩阵,X为待估参数向量,e为观测噪声向量;
由最小二乘解算得到的浮点解的方差为
式中,P为观测值权阵;
对模糊度浮点解及式(5)采用LAMBDA方法即可实现模糊度的固定;
4)首先进行整体模糊度解算(FAR),进行模糊度成功率和Ratio检验,若检验通过,FAR解算成功,则直接利用固定的载波相位观测值进行紧组合系统状态更新;
模糊度成功率表示为
其中 为实数模糊度方差协方差分解后的矩阵对角线元素,I={i+1,...,n},若Ps≥P(0),P(0)为模糊度成功率检验阈值,则表示模糊度成功率检验通过;
Ratio检验公式为
其中为最优模糊度组残差二次型,为次优模糊度组残差二次型,若Ratio≥K,K为Ratio检验阈值,则表示Ratio检验成功;
5)如果FAR失败,则采用部分模糊度固定(PAR)策略,采用模糊度取整固定成功率方法对模糊度浮点解按成功率从高到底进行排序,删除当前成功率最小的模糊度浮点解,获取模糊度子集,重新采用LAMBDA进行解算,按式(6)和(7)进行检验,检验通过后可利用固定的载波观测值进行组合滤波解算,若检验不通过,删除下一个取整固定成功率最小的模糊度浮点解,依次递推,直至检验通过;
模糊度浮点解的取整固定成功率为
6)利用已固定模糊度的载波相位观测值重新解算,获得更高精度的剩余模糊度浮点解,再次进行模糊度解算;
7)如果当前历元无法成功固定模糊度,则采用伪距观测值进行系统状态更新。
所述的宗地测量装置,通讯模块(8)包括RS232串口和蓝牙通讯模块,用于实时传输GNSS原始观测信息和惯性测量信息。
所述的宗地测量装置,还包括一根可拆卸的对中杆,用于点位对中;装置顶部安装了一个高精度的指北针和一个圆水准气泡,用于惯性模块的姿态初始化,包含惯导初始方位、俯仰角及横滚角的初始化;装置侧面安装电源总开关、GNSS电源开关、惯导电源开关以及FPGA板卡的电源开关,用于系统的启动控制。
一种惯性辅助的GPS/BDS融合大比例尺快速宗地测量方法,该方法能够完成卫星信号遮蔽、半遮蔽区的快速宗地测量工作,具体步骤如下:
1)在单站RTK或网络RTK工作模式下,在测区起始点架设仪器,确保线路连接正确后,依次打开总电源开关、GNSS电源开关和惯导电源开关,进行10s左右的系统预热,再打开FPGA板卡电源开关;
2)打开控制手簿,通过串口或蓝牙与宗地测量装置进行连接,建立宗地测量坐标系统,并配置GNSS数据采集模式,包括串口号、采样率以及数据存储选择,以及配置惯导采集模式,包括采样率,数据输出格式
3)利用圆水准器,完成系统的对中整平,并利用高精度指北针记录载体初始方位,完成宗地测量系统的姿态初始化,同时利用RTK获取起始点三维坐标,或架设在已知坐标点,完成组合系统的状态初始化,形成初始导航基准;
4)保持系统开机状态,通过控制手簿接收惯性器件及GNSS接收机的原始观测信息,同时同步接收参考站GNSS接收机的原始观测信息,完成组合系统的动态初始化过程;
5)根据预先设定的作业路线,将仪器放置到碎部点,利用圆水准器完成对中整平,在手簿控制端采用GNSS/INS载波紧组合定位模式进行解算,该解算模式可完成观测卫星数少于4颗的定位解算,存储原始观测数据,并操作手簿,完成碎部点点位坐标以及时间信息存储,设定测量标记,在手簿端进行碎部点的同步显示与绘图,存储的原始观测数据和碎部点测量时段信息可用于事后的高精度数据处理;
6)重复步骤5)测量测区内所有的碎部点的点位坐标,作业路线形成网状并覆盖测区,存储原始观测信息及测量点位信息;
7)当设备到达卫星信号全遮蔽区的待测碎部点,由于卫星信号不可用,仅通过惯导系统进行位置推算,由卫星信号失锁前的参考点作为惯性系统位置推算的起点,将组合滤波器(11)输出的惯性器件偏差修正原始惯性测量输出,经过捷联解算推求待测点的坐标;
8)卫星信号重新捕获后,采用惯性定位信息约束完成系统的快速初始化,重新获取高精度定位信息,采用反馈平滑方法提高卫星信号遮蔽区碎部点的点位精度;
9)若长时间在卫星信号遮蔽区作业,系统采用零速修正以及外界坐标已知点位修正,维持系统定位精度;
10)测量工作结束后,手簿存储所有观测信息和点位信息,端口断开连接,并依次关闭FPGA板卡电源开关、惯导电源开关、GNSS电源开关以及电源总开关。
所述的惯性辅助的GPS/BDS融合大比例尺快速宗地测量方法,步骤8)所述的惯性辅助系统快速初始化方法为:
1)首先同步接收参考站和移动站GNSS载波相位和伪距观测信息,形成双差观测值
式中,为双差算子,“*”表示GPS“G”或北斗“C”.ρ和φ为伪距和载波观测值,星地距为ρ(0),T表示对流层误差,I为电离层误差,λ为载波波长,M和m分别表示伪距和载波多路径误差,ερ和εφ是伪距和载波观测噪声;
2)获得双差观测值后进行降相关处理;
3)集成利用INS预测位置信息,提高模糊度解算的可靠性,组合系统模糊度解算方差:
式中为GPS/BDS系统双差伪距,为双差相位观测值,为INS预测星地距,Xb为位置误差改正数,Xa为n维模糊度参数向量,Hb为设计矩阵,eρ和eφ分别为伪距和载波观测噪声,eINS为INS系统观测噪声,由组合滤波先验方程阵得到;L为观测向量,H为观测模型系数矩阵,X为待估参数向量,e为观测噪声向量;
由最小二乘解算得到的浮点解的方差为
式中,P为观测值权阵;
对模糊度浮点解及式(5)采用LAMBDA方法即可实现模糊度的固定;
4)首先进行整体模糊度解算(FAR),进行模糊度成功率和Ratio检验,若检验通过,FAR解算成功,则直接利用固定的载波相位观测值进行紧组合系统状态更新;
模糊度成功率表示为
其中 为实数模糊度方差协方差分解后的矩阵对角线元素,I={i+1,...,n},若Ps≥P(0),P(0)为模糊度成功率检验阈值,则表示模糊度成功率检验通过;
Ratio检验公式为
其中为最优模糊度组残差二次型,为次优模糊度组残差二次型,若Ratio≥K,K为Ratio检验阈值,则表示Ratio检验成功;
5)如果FAR失败,则采用部分模糊度固定(PAR)策略,采用模糊度取整固定成功率方法对模糊度浮点解按成功率从高到底进行排序,删除当前成功率最小的模糊度浮点解,获取模糊度子集,重新采用LAMBDA进行解算,按式(6)和(7)进行检验,检验通过后可利用固定的载波观测值进行组合滤波解算,若检验不通过,删除下一个取整固定成功率最小的模糊度浮点解,依次递推,直至检验通过;
模糊度浮点解的取整固定成功率为
6)利用已固定模糊度的载波相位观测值重新解算,获得更高精度的剩余模糊度浮点解,再次进行模糊度解算;
7)如果当前历元无法成功固定模糊度,则采用伪距观测值进行系统状态更新。
根据模糊度取整固定成功率来选取模糊度子集,实现部分模糊度的固定,从而提高模糊度固定效率,使得组合系统能够完成快速初始化。
本发明的优点及有益效果:该宗地测量装置及方法集成连续跟踪卫星信号、惯性导航定位输出,基于秒脉冲信号实现数据的同步与集成,采用载波相位观测值进行紧组合定位解算,实现惯性辅助的GPS/BDS融合模糊度解算,并采用部分模糊度固定策略,有利于提高模糊度固定的成功率,该方法能够显著提高系统在遮蔽、半遮蔽区的定位精度和可靠性。本发明能够应用于各种实地宗地测量环境,很好的提高宗地测量作业的效率。
附图说明
图1为本发明装置结构图;
图2为本发明的设备连接与工作原理图;
图3为本发明实施例的作业流程图;
图4为本发明惯性辅助GPS/BDS部分模糊度固定技术流程图。
1、GNSS天线,2、GNSS OEM板卡,3、捷联惯导模块,4、FPGA核心板卡,5、电源,6、GNSS观测数据,7、惯导观测数据,8、通讯模块,9、捷联解算模块,10、惯导辅助部分模糊度固定模块,11、组合滤波模块,12、指北针,13、可伸缩天线连接杆,14、连接螺丝,15、圆水准气泡,16、固定板,17、GNSS电源开关,18、惯导电源开关,19、FPGA板卡电源开关,20、电源总开关,21、配电模块,22、RS232串口,23、连接螺丝,24、可拆卸对中杆,25、机箱,A、初始化起始点,B、卫星信号良好区碎部点,C、卫星信号半遮蔽区碎部点,D、卫星信号全遮蔽区碎部点,E、坐标检核点,F、测图作业路线,100、手簿控制端。
具体实施方式
以下结合具体实施例,对本发明进行详细说明。
图1为惯性辅助的GPS/BDS融合大比例尺快速宗地测量装置的结构图,包括捷联惯导模块3、GNSS OEM板卡2、手簿控制端100以及FPGA核心板卡4。
捷联惯导模块3用于采集惯性测量信息,输出包括加速度、角速度在内的惯导观测数据到FPGA核心板卡4,GNSS OEM板卡2用于完成高精度GNSS信号的接收与处理,输出包括伪距、相位、时间在内的GNSS观测数据到FPGA核心板卡4;FPGA核心板卡4用于标定惯导数据时间以及进行GNSS观测数据与惯导观测数据的数据融合;通过通讯模块8传输到手簿控制端,手簿控制端100包括捷联解算模块9、惯导辅助部分模糊度固定模块10、组合滤波模块11;捷联解算模块9利用惯导数据进行捷联解算,惯导辅助部分模糊度固定模块10利用惯导输出的定位信息进行部分模糊度固定,输出高精度相位信息;组合滤波模块11集成高精度相位信息和惯导输出进行GNSS/INS组合滤波;手簿控制端还接收GNSS原始观测信息与惯性测量信息,采用载波紧集成技术进行综合解算,同时进行点位信息存储与显示。
图2为本发明的设备连接与工作原理图。各模块说明:GNSS接收机天线1:用来接收来自GPS与BDS的卫星信号;GNSS OEM板卡2:完成高精度GNSS信号的接收与处理;捷联惯导模块3:用于采集惯性测量信息;FPGA核心板卡4:用于标定惯导数据时间以及进行GNSS与惯导的数据融合;电源模块5:用于给GNSS OEM板卡、捷联惯导模块以及FPGA核心板供电;GNSS观测数据6:包含GNSS的伪距、相位观测信息与GNSS同步时间信息;惯导观测数据7:包含加速度与角速度观测信息;通讯模块8:包含串口与蓝牙单元,实现GNSS与惯导融合数据的实时传输;捷联解算模块9:基于惯导数据的捷联解算;惯导辅助部分模糊度固定模块10:利用惯导定位输出辅助GPS/BDS部分模糊度固定,输出高精度相位信息;组合滤波模块11:集成高精度相位信息和惯导输出进行GNSS/INS组合滤波。
图3为本发明的作业流程图,下面结合该流程图对实施例进行说明。在作业区域,选择卫星信号良好区域选择起始点A,在A点架设仪器,利用圆水准器进行对中整平,由高精度指北针获取初始方位角,打开仪器,配置单机站RTK或网络RTK,接收参考站GNSS观测值的原始观测信息,初始化起点的坐标可以RTK测量得到或者可在已知坐标点位架设仪器,在A点完成组合宗地测量系统的初始化,包含位置、速度以及姿态的初始化;初始化完成后,保存设备开机状态,按照规划宗地测量路线,平稳移动设备到达碎部点B,并进行对中整平,在移动过程中,卫星信号良好,手簿控制端同步接收流动站GNSS原始观测信息(卫星星历和载波相位、伪距原始观测值)和惯性测量信息(线加速度和角加速度)以及参考站发来的差分信号,进行数据融合,利用惯性辅助快速解算整周模糊度,实施基于载波相位的紧组合解算方式,在B点进行测量,打上测量标记,存储点位坐标和时标,在手簿端输出定位坐标,与底图比较,若发现错误,则需进行重新初始化;继续移动设备,从B点前往卫星信号半遮蔽区的一个碎部点C,在这个区域,卫星信号由于受到遮挡,可视卫星数少于4颗,由于本系统采用的是紧组合解算方式,仍然可以利用GNSS观测信息和惯性测量信息进行连续测量,保障了数据的可用性和连续性;从半遮蔽区重新回到卫星信号无遮蔽区,此时卫星信号良好,可获得更高精度的定位结果,利用在线反馈平滑功能来重新解算C点的坐标,进一步提高C的点位精度;从无遮蔽区移动宗地测量设备进行卫星信号全遮蔽区,测量全遮蔽区内的碎部点D,由于此时卫星信号不可用,仅能通过惯导系统进行捷联推算,利用紧组合滤波器(组合滤波模块11)输出的惯导仪器误差校正原始惯性测量输出,同时充分利用零速修正点和已知坐标点进行系统修正,维持长时的高精度定位输出;在设备返回卫星信号无遮蔽区,采用惯性定位信息约束完成系统的快速初始化,重新获取高精度定位信息,采用反馈平滑方法提高卫星信号遮蔽区碎部点的点位精度;测量作业结束后,选择一已知坐标点或已测点E进行检核,手簿存储所有原始观测信息以及在线解算点位信息,原始观测信息可用于事后高精度后处理,完成测区的测量工作。
图4为本发明的惯性辅助GPS/BDS部分模糊度固定技术流程图。系统进入卫星信号遮蔽区后,无法进行GNSS与惯导的组合定位解算,而一旦卫星信号重新捕获,需要系统具备快速初始化能力。在GPS/BDS/INS紧组合定位中,模糊度的解算是高精度定位的前提,若模糊度无法固定,系统只能以伪距观测值进行更新。在组合系统的模糊度解算过程中,由于INS能够提供连续定位能力,使得模糊度浮点解的精度得以提高,进而约束模糊度搜索空间,提高模糊度固定效率,使得组合系统能够完成快速初始化。
具体技术流程为:
1)首先同步接收参考站和移动站GNSS载波相位和伪距观测信息,形成双差观测值
式中,为双差算子,“*”表示GPS“G”或北斗“C”.ρ和φ为伪距和载波观测值,星地距为ρ0,T表示对流层误差,I为电离层误差,λ为载波波长,M和m分别表示伪距和载波多路径误差,ερ和εφ是伪距和载波观测噪声。
2)获得双差观测值后进行降相关处理;
3)集成利用INS预测位置信息,提高模糊度解算的可靠性,组合系统模糊度解算方差
式中为GPS/BDS系统双差伪距,为双差相位观测值,为INS预测星地距,Xb为位置误差改正数,Xa为n维模糊度参数向量,Hb为设计矩阵,eρ和eφ分别为伪距和载波观测噪声,eINS为INS系统观测噪声,由组合滤波先验方程阵得到。L为观测向量,H为观测模型系数矩阵,X为待估参数向量,e为观测噪声向量。
由最小二乘解算得到的浮点解的方差为
式中,P为观测值权阵。
对模糊度浮点解及式(5)采用LAMBDA方法即可实现模糊度的固定。
4)首先进行整体模糊度解算(FAR),进行模糊度成功率和Ratio检验,若检验通过,FAR解算成功,则直接利用固定的载波相位观测值进行紧组合系统状态更新;(注:由于FAR是常规模糊度解算方案,图4中模糊度成功率和Ratio检验只在PAR中画出。)
模糊度成功率表示为
其中 为实数模糊度方差协方差分解后的矩阵对角线元素,I={i+1,...,n},若Ps≥P0(P0为模糊度成功率检验阈值),则表示模糊度成功率检验通过。
Ratio检验公式为
其中为最优模糊度组残差二次型,为次优模糊度组残差二次型,若Ratio≥K(K为Ratio检验阈值),则表示Ratio检验成功。
5)如果FAR失败,则采用部分模糊度固定(PAR)策略,采用模糊度取整固定成功率方法对模糊度浮点解按成功率从高到底进行排序,删除当前成功率最小的模糊度浮点解,获取模糊度子集,重新采用LAMBDA进行解算,按式(6)和(7)进行检验,检验通过后可利用固定的载波观测值进行组合滤波解算,若检验不通过,删除下一个取整固定成功率最小的模糊度浮点解,依次递推,直至检验通过;
模糊度浮点解的取整固定成功率为
6)利用已固定模糊度的载波相位观测值重新解算,获得更高精度的剩余模糊度浮点解,再次进行模糊度解算;
7)如果当前历元无法成功固定模糊度,则采用伪距观测值进行系统状态更新。
应当理解的是,对本领域普通技术人员来说,可以根据上述说明加以改进或变换,而所有这些改进和变换都应属于本发明所附权利要求的保护范围。
Claims (4)
1.一种惯性辅助的GPS/BDS融合大比例尺快速宗地测量装置,其特征在于,包括捷联惯导模块(3)、GNSS OEM板卡(2)、手簿控制端(100)以及FPGA核心板卡(4);捷联惯导模块(3)用于采集惯性测量信息,输出包括加速度、角速度在内的惯导观测数据到FPGA核心板卡(4),GNSS OEM板卡(2)用于完成高精度GNSS信号的接收与处理,输出包括伪距、相位、时间在内的GNSS观测数据到FPGA核心板卡(4);FPGA核心板卡(4)用于标定惯导数据时间以及进行GNSS观测数据与惯导观测数据的数据融合,通过通讯模块(8)传输到手簿控制端,手簿控制端(100)包括捷联解算模块(9)、惯导辅助部分模糊度固定模块(10)、组合滤波模块(11);捷联解算模块(9)利用惯导数据进行捷联解算,惯导辅助部分模糊度固定模块(10)用于在卫星信号重新捕获后,利用惯导输出的定位信息进行部分模糊度固定,输出高精度相位信息;组合滤波模块(11)集成高精度相位信息和惯导输出进行GNSS/INS组合滤波;手簿控制端还接收GNSS原始观测信息与惯性测量信息,采用载波紧集成技术进行综合解算,同时进行点位信息存储与显示;惯导辅助部分模糊度固定模块(10)利用惯导输出的定位信息进行部分模糊度固定:
1)首先同步接收参考站和移动站GNSS载波相位和伪距观测信息,形成双差观测值
式中,为双差算子,“*”表示GPS“G”或北斗“C”,ρ和φ为伪距观测值和载波观测值,星地距为ρ0,T表示对流层误差,I为电离层误差,λ为载波波长,M和m分别表示伪距多路径误差和载波多路径误差,ερ和εφ是伪距观测噪声和载波观测噪声;
2)获得双差观测值后进行降相关处理;
3)集成利用INS预测位置信息,提高模糊度解算的可靠性,GPS/BDS/INS紧组合系统模糊度解算方程:
式中为GPS/BDS系统双差伪距,为双差相位观测值,为INS预测星地距,Xb为位置误差改正数,Xa为n维模糊度参数向量,Hb为设计矩阵,eρ和eφ分别为伪距观测噪声和载波观测噪声,eins为INS系统观测噪声,由组合滤波先验方程阵得到;L为观测向量,H为观测模型系数矩阵,X为待估参数向量,e为观测噪声向量;
由最小二乘解算得到的浮点解的方差为
式中,P为观测值权阵;
对模糊度浮点解及式(5)采用LAMBDA方法即可实现模糊度的固定;
4)首先进行整体模糊度解算(FAR),进行模糊度成功率和Ratio检验,若检验通过,FAR解算成功,则直接利用固定的载波相位观测值进行GPS/BDS/INS紧组合系统状态更新;
模糊度成功率表示为
其中 为实数模糊度方差协方差分解后的矩阵对角线元素,I={i+1,...,n},若Ps≥P(0),P(0)为模糊度成功率检验阈值,则表示模糊度成功率检验通过;
Ratio检验公式为
其中为最优模糊度组残差二次型,为次优模糊度组残差二次型,若Ratio≥K,K为Ratio检验阈值,则表示Ratio检验成功;
5)如果FAR失败,则采用部分模糊度固定(PAR)策略,采用模糊度取整固定成功率方法对模糊度浮点解按成功率从高到底进行排序,删除当前成功率最小的模糊度浮点解,获取模糊度子集,重新采用LAMBDA进行解算,按式(6)和(7)进行检验,检验通过后利用固定的载波观测值进行组合滤波解算,若检验不通过,删除下一个取整固定成功率最小的模糊度浮点解,依次递推,直至检验通过;
模糊度浮点解的取整固定成功率为
其中 为第i个模糊度的最近整数;
6)利用已固定模糊度的载波相位观测值重新解算,获得更高精度的剩余模糊度浮点解,再次进行模糊度解算;
7)如果当前历元无法成功固定模糊度,则采用伪距观测值进行系统状态更新。
2.根据权利要求1所述的宗地测量装置,其特征在于,通讯模块(8)包括RS232串口和蓝牙通讯模块,用于实时传输GNSS原始观测信息和惯性测量信息。
3.根据权利要求1所述的宗地测量装置,其特征在于,还包括一根可拆卸的对中杆,用于点位对中;装置顶部安装了一个高精度的指北针和一个圆水准气泡,用于捷联惯导模块的姿态初始化,包含惯导初始方位、俯仰角及横滚角的初始化;装置侧面安装电源总开关、GNSS电源开关、惯导电源开关以及FPGA核心板卡的电源开关,用于系统的启动控制。
4.一种惯性辅助的GPS/BDS融合大比例尺快速宗地测量方法,其特征在于:该方法能够完成卫星信号遮蔽、半遮蔽区的快速宗地测量工作,具体步骤如下:
1)在单站RTK或网络RTK工作模式下,在测区起始点架设仪器,确保线路连接正确后,依次打开总电源开关、GNSS电源开关和惯导电源开关,进行10s左右的系统预热,再打开FPGA板卡电源开关;
2)打开手簿控制端,通过串口或蓝牙与宗地测量装置进行连接,建立宗地测量坐标系统,并配置GNSS数据采集模式,包括串口号、采样率以及数据存储选择,以及配置惯导采集模式,包括采样率,数据输出格式
3)利用圆水准器,完成系统的对中整平,并利用高精度指北针记录载体初始方位,完成宗地测量系统的姿态初始化,同时利用RTK获取起始点三维坐标,或架设在已知坐标点,完成组合系统的状态初始化,形成初始导航基准;
4)保持系统开机状态,通过手簿控制端接收惯性器件及GNSS接收机的原始观测信息,同时同步接收参考站GNSS接收机的原始观测信息,完成组合系统的动态初始化过程;
5)根据预先设定的作业路线,将仪器放置到碎部点,利用圆水准器完成对中整平,在手簿控制端采用GNSS/INS载波紧组合定位模式进行解算,该解算模式可完成观测卫星数少于4颗的定位解算,存储原始观测数据,并操作手簿,完成碎部点点位坐标以及时间信息存储,设定测量标记,在手簿控制端进行碎部点的同步显示与绘图,存储的原始观测数据和碎部点测量时段信息用于事后的高精度数据处理;
6)重复步骤5)测量测区内所有的碎部点的点位坐标,作业路线形成网状并覆盖测区,存储原始观测信息及测量点位信息;
7)当设备到达卫星信号全遮蔽区的待测碎部点,由于卫星信号不可用,仅通过惯性系统进行位置推算,由卫星信号失锁前的参考点作为惯性系统位置推算的起点,将组合滤波器输出的惯性器件偏差修正原始惯性测量输出,经过捷联解算推求待测点的坐标;
8)卫星信号重新捕获后,采用惯性定位信息约束完成系统的快速初始化,重新获取高精度定位信息,采用反馈平滑方法提高卫星信号遮蔽区碎部点的点位精度;
9)若长时间在卫星信号遮蔽区作业,系统采用零速修正以及外界坐标已知点位修正,维持系统定位精度;
10)测量工作结束后,手簿存储所有观测信息和点位信息,端口断开连接,并依次关闭FPGA板卡电源开关、惯导电源开关、GNSS电源开关以及总电源开关;
步骤8)所述的快速初始化方法为:
1)首先同步接收参考站和移动站GNSS载波相位和伪距观测信息,形成双差观测值
式中,为双差算子,“*”表示GPS“G”或北斗“C”,ρ和φ为伪距观测值和载波观测值,星地距为ρ0,T表示对流层误差,I为电离层误差,λ为载波波长,M和m分别表示伪距多路径误差和载波多路径误差,ερ和εφ是伪距观测噪声和载波观测噪声;
2)获得双差观测值后进行降相关处理;
3)集成利用INS预测位置信息,提高模糊度解算的可靠性,GPS/BDS/INS紧组合系统模糊度解算方程:
式中为GPS/BDS紧组合系统双差伪距,为双差相位观测值,为INS预测星地距,Xb为位置误差改正数,Xa为n维模糊度参数向量,Hb为设计矩阵,eρ和eφ分别为伪距观测噪声和载波观测噪声,eins为INS系统观测噪声,由组合滤波先验方程阵得到;L为观测向量,H为观测模型系数矩阵,X为待估参数向量,e为观测噪声向量;
由最小二乘解算得到的浮点解的方差为
式中,
P为观测值权阵;
对模糊度浮点解及式(5)采用LAMBDA方法即可实现模糊度的固定;
4)首先进行整体模糊度解算(FAR),进行模糊度成功率和Ratio检验,若检验通过,FAR解算成功,则直接利用固定的载波相位观测值进行GPS/BDS/INS紧组合系统状态更新;
模糊度成功率表示为
其中 为实数模糊度方差协方差分解后的矩阵对角线元素,I={i+1,...,n},若Ps≥P(0),P(0)为模糊度成功率检验阈值,则表示模糊度成功率检验通过;
Ratio检验公式为
其中为最优模糊度组残差二次型,为次优模糊度组残差二次型,若Ratio≥K,K为Ratio检验阈值,则表示Ratio检验成功;
5)如果FAR失败,则采用部分模糊度固定(PAR)策略,采用模糊度取整固定成功率方法对模糊度浮点解按成功率从高到底进行排序,删除当前成功率最小的模糊度浮点解,获取模糊度子集,重新采用LAMBDA进行解算,按式(6)和(7)进行检验,检验通过后利用固定的载波观测值进行组合滤波解算,若检验不通过,删除下一个取整固定成功率最小的模糊度浮点解,依次递推,直至检验通过;
模糊度浮点解的取整固定成功率为
其中 为第i个模糊度的最近整数;
6)利用已固定模糊度的载波相位观测值重新解算,获得更高精度的剩余模糊度浮点解,再次进行模糊度解算;
7)如果当前历元无法成功固定模糊度,则采用伪距观测值进行系统状态更新。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510881356.5A CN105549057B (zh) | 2015-12-07 | 2015-12-07 | 一种惯性辅助的gps/bds融合大比例尺快速宗地测量装置与方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510881356.5A CN105549057B (zh) | 2015-12-07 | 2015-12-07 | 一种惯性辅助的gps/bds融合大比例尺快速宗地测量装置与方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105549057A CN105549057A (zh) | 2016-05-04 |
CN105549057B true CN105549057B (zh) | 2018-08-17 |
Family
ID=55828357
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510881356.5A Expired - Fee Related CN105549057B (zh) | 2015-12-07 | 2015-12-07 | 一种惯性辅助的gps/bds融合大比例尺快速宗地测量装置与方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105549057B (zh) |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105806339B (zh) * | 2016-05-14 | 2018-09-25 | 中卫物联成都科技有限公司 | 一种基于gnss、ins和守时系统的组合导航方法和设备 |
CN106597508A (zh) * | 2016-12-20 | 2017-04-26 | 广东电网有限责任公司电力调度控制中心 | 一种基于北斗和gps终端定位数据的优化方法及装置 |
CN108226981A (zh) * | 2017-12-27 | 2018-06-29 | 北京北方联星科技有限公司 | 一种减小多径干扰的伪距反馈组合导航方法 |
CN108196616B (zh) * | 2017-12-28 | 2021-01-08 | 沈阳工业大学 | 管道内检测变径惯导子系统数据的时间同步方法 |
CN108873034A (zh) * | 2018-03-30 | 2018-11-23 | 广州海格通信集团股份有限公司 | 一种惯导辅助载波模糊度解算的实现方法 |
CN108802782B (zh) * | 2018-05-18 | 2021-02-09 | 东南大学 | 一种惯导辅助的北斗三频载波相位整周模糊度求解方法 |
CN109884677B (zh) * | 2019-03-07 | 2023-03-28 | 成都纵横融合科技有限公司 | 后处理rtk定位解算的优化方法 |
CN113093256B (zh) * | 2019-12-23 | 2024-02-13 | 上海华测导航技术股份有限公司 | 一种gnss/imu测绘系统和方法 |
CN111578935B (zh) * | 2020-05-08 | 2021-08-20 | 北京航空航天大学 | 一种利用惯导位置增量辅助gnss模糊度固定的方法 |
CN112229401B (zh) * | 2020-09-15 | 2022-08-05 | 北京菲斯罗克光电技术有限公司 | 适用于ins-gps伪距融合的量测信息同步外推方法及系统 |
CN112415542B (zh) * | 2021-01-25 | 2021-04-16 | 湖南联智科技股份有限公司 | 一种基于北斗和ins结合的变形监测解算方法 |
CN112945231A (zh) * | 2021-01-28 | 2021-06-11 | 深圳市瑞立视多媒体科技有限公司 | 一种imu与刚体姿态对齐的方法、装置、设备以及可读存储介质 |
CN112923923A (zh) * | 2021-01-28 | 2021-06-08 | 深圳市瑞立视多媒体科技有限公司 | 一种imu与刚体姿态、位置对齐的方法、装置、设备以及可读存储介质 |
CN113238264B (zh) * | 2021-05-07 | 2024-04-02 | 南宁市自然资源信息集团有限公司 | 一种林权调查手簿及森林测量方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102621569A (zh) * | 2012-03-22 | 2012-08-01 | 哈尔滨工程大学 | 一种分布滤波式全球定位及捷联惯导组合导航方法 |
CN103616710A (zh) * | 2013-12-17 | 2014-03-05 | 靳文瑞 | 基于fpga的多传感器组合导航时间同步系统 |
CN104297773A (zh) * | 2014-02-27 | 2015-01-21 | 北京航天时代光电科技有限公司 | 一种高精度北斗三频sins深组合导航系统 |
CN104375157A (zh) * | 2014-10-22 | 2015-02-25 | 南京航空航天大学 | 短基线下惯导辅助的北斗单频整周模糊度求解方法 |
CN104422948A (zh) * | 2013-09-11 | 2015-03-18 | 南京理工大学 | 一种嵌入式组合导航系统及其方法 |
CN104459745A (zh) * | 2014-12-25 | 2015-03-25 | 东南大学 | 一种多星座长基线网络rtk部分模糊度快速解算方法 |
CN204347258U (zh) * | 2014-08-18 | 2015-05-20 | 北京七维航测科技股份有限公司 | 双天线gnss/ins组合导航系统 |
CN104656111A (zh) * | 2014-10-13 | 2015-05-27 | 北京航空航天大学 | 一种用于组合导航半实物仿真的北斗数据建模方法 |
CN105068102A (zh) * | 2015-08-11 | 2015-11-18 | 南京理工大学 | 一种基于dsp+fpga的超紧组合导航方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8473207B2 (en) * | 2008-10-21 | 2013-06-25 | Texas Instruments Incorporated | Tightly-coupled GNSS/IMU integration filter having calibration features |
-
2015
- 2015-12-07 CN CN201510881356.5A patent/CN105549057B/zh not_active Expired - Fee Related
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102621569A (zh) * | 2012-03-22 | 2012-08-01 | 哈尔滨工程大学 | 一种分布滤波式全球定位及捷联惯导组合导航方法 |
CN104422948A (zh) * | 2013-09-11 | 2015-03-18 | 南京理工大学 | 一种嵌入式组合导航系统及其方法 |
CN103616710A (zh) * | 2013-12-17 | 2014-03-05 | 靳文瑞 | 基于fpga的多传感器组合导航时间同步系统 |
CN104297773A (zh) * | 2014-02-27 | 2015-01-21 | 北京航天时代光电科技有限公司 | 一种高精度北斗三频sins深组合导航系统 |
CN204347258U (zh) * | 2014-08-18 | 2015-05-20 | 北京七维航测科技股份有限公司 | 双天线gnss/ins组合导航系统 |
CN104656111A (zh) * | 2014-10-13 | 2015-05-27 | 北京航空航天大学 | 一种用于组合导航半实物仿真的北斗数据建模方法 |
CN104375157A (zh) * | 2014-10-22 | 2015-02-25 | 南京航空航天大学 | 短基线下惯导辅助的北斗单频整周模糊度求解方法 |
CN104459745A (zh) * | 2014-12-25 | 2015-03-25 | 东南大学 | 一种多星座长基线网络rtk部分模糊度快速解算方法 |
CN105068102A (zh) * | 2015-08-11 | 2015-11-18 | 南京理工大学 | 一种基于dsp+fpga的超紧组合导航方法 |
Non-Patent Citations (2)
Title |
---|
单频GPS/BDS/MEMS IMU紧组合模糊度固定抗差模型;韩厚增等;《中国惯性技术学报》;20150831;第23卷(第4期);493-499 * |
基于部分整周模糊度固定的非差GPS 精密单点定位方法;潘宗鹏等;《测绘学报》;20151130;第44卷(第11期);1210-1218 * |
Also Published As
Publication number | Publication date |
---|---|
CN105549057A (zh) | 2016-05-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105549057B (zh) | 一种惯性辅助的gps/bds融合大比例尺快速宗地测量装置与方法 | |
CN105158780B (zh) | 一种基于多种导航卫星可互换的导航定位方法 | |
CN103048671A (zh) | 全球导航卫星系统RTD、MEMS-IMU、ZigBee组合高精度无缝导航新方法 | |
Xu | Application of GPS-RTK technology in the land change survey | |
CN106941703A (zh) | 基于态势感知的室内外无缝定位装置和方法 | |
CN107991697A (zh) | 一种多频多模rtk定位系统 | |
CN106455046A (zh) | 一种卫星‑WiFi飞行时间组合定位系统及其方法 | |
CN108253942A (zh) | 一种提高倾斜摄影测量空三质量的方法 | |
Zhang et al. | Using UWB aided GNSS/INS integrated navigation to bridge GNSS outages based on optimal anchor distribution strategy | |
CN107340530A (zh) | 一种基于rtk的分体式gnss真北定向装置 | |
Ellum et al. | A mobile mapping system for the survey community | |
Roberts | GPS for cadastral surveying: Practical considerations | |
KR101723342B1 (ko) | 측지측량 시스템 | |
CN102033235A (zh) | 基于gps/sins城镇地籍图根点快速测量及事后数据处理方法 | |
Yurdakul et al. | The effect of GLONASS on position accuracy in CORS-TR measurements at different baseline distances | |
Garrido et al. | Dense regional active networks and high accuracy positioning services. A case study based on the Andalusian Positioning Network (Southern Spain) | |
Tamrakar | Potential use of GPS technology for cadastral surveys in Nepal | |
Løvås | Increasing the accuracy of positioning in mobile mapping systems-a method supported by simultaneous localization and mapping | |
Karimi et al. | GQMAP: Improving performance and productivity of mobile mapping systems through GPS quality of service | |
Alkan et al. | Comparison of single baseline RTK and network RTK GNSS methods | |
Wing | Consumer-grade Global Positioning Systems performance in an urban forest setting | |
Bala et al. | Second order control extension in Millennium City, Chikun Local Government Area, Kaduna State, Nigeria | |
Archana et al. | Preparation of topographic map using Total station and GNSS | |
Olatunde et al. | Control Extension Using Global Navigation Satellite System Receivers in Auchi, Nigeria | |
Zvirgzds et al. | GNSS RTK Performance Improvements using Galileo Satellite Signal |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20180817 Termination date: 20181207 |