CN108107458A - 实现gnss接收机首次定位的方法、装置及移动终端 - Google Patents
实现gnss接收机首次定位的方法、装置及移动终端 Download PDFInfo
- Publication number
- CN108107458A CN108107458A CN201611058787.2A CN201611058787A CN108107458A CN 108107458 A CN108107458 A CN 108107458A CN 201611058787 A CN201611058787 A CN 201611058787A CN 108107458 A CN108107458 A CN 108107458A
- Authority
- CN
- China
- Prior art keywords
- mtd
- location information
- msub
- mrow
- sequential
- 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
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
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
本发明提供一种实现GNSS接收机首次定位的方法、装置及移动终端。所述方法包括:在GNSS接收机进行当前首次定位之前,判断当前所保存的序贯先验位置信息是否有效,其中,所述序贯先验位置信息为满足预定精度判定条件的历史位置信息;若当前所保存的序贯先验位置信息有效,则根据当前所保存的序贯先验位置信息,利用序贯最小二乘解算,获得GNSS接收机当前首次定位的位置信息。本发明能够提高GNSS接收机首次定位的精度。
Description
技术领域
本发明涉及导航定位技术领域,尤其涉及一种实现GNSS接收机首次定位的方法、装置及移动终端。
背景技术
GNSS(Global Navigation Satellite System,全球导航卫星系统)接收机,利用GPS(Global Positioning System,美国全球定位系统)、BDS(BeiDou NavigationSatellite System,中国北斗卫星导航系统)、GLONASS(Global Navigation SatelliteSystem,俄罗斯全球导航卫星系统)、Galileo(欧盟卫星导航系统),QZSS(Quasi-ZenithSatellite System,日本准天顶卫星系统)中的一个或多个系统的多颗卫星发射的导航定位信号,以提供实时的位置、速度、时间信息。
目前,GNSS终端用户在一定场景下进行重新定位的情况十分常见。例如:驾车导航至加油站或高速路服务区后关闭GNSS,驶离时需要重新开启导航;搭载GNSS芯片的设备(如手机)重启需要进行重新定位;步行导航至商场后,离开商场重新导航需要进行再次定位。
现有的首次定位计算方法仍然广泛采用LSQ(Least Square,最小二乘算法),针对用户对GNSS终端的多次启动操作,独立考虑利用接收机单次的卫星观测量进行定位计算。这样,首次定位精度完全依赖于单次的观测量精度。如果在开阔地,由于可见卫星数目多,且几乎没有信号遮挡,利用LSQ的定位精度通常可达10m以内。而在复杂环境下(峡谷地、建筑物密集区等),可见星数目减少,导致卫星几何构型差,且这些可见星信号多径效应十分明显。一些GNSS终端(例如搭载有GNSS芯片的智能手机)受制于天线体积的限制,在卫星信号源上,难以有效改善多径效应造成的影响。受此影响,定位精度可能出现数百米,甚至数千米的误差,直接影响KF(Kalman Filter,卡尔曼滤波算法)的收敛过程,从而引起定位轨迹的整体偏移。
在实现本发明的过程中,发明人发现现有技术中至少存在如下技术问题:
采用现有的导航定位方法,当在复杂环境下进行首次定位时,GNSS接收机的定位精度较低。
发明内容
本发明提供的实现GNSS接收机首次定位的方法、装置及移动终端,能够提高GNSS接收机首次定位的精度。
第一方面,本发明提供一种实现GNSS接收机首次定位的方法,包括:
在GNSS接收机进行当前首次定位之前,判断当前所保存的序贯先验位置信息是否有效,其中,所述序贯先验位置信息为满足预定精度判定条件的历史位置信息;
若当前所保存的序贯先验位置信息有效,则根据当前所保存的序贯先验位置信息,利用序贯最小二乘解算,获得GNSS接收机当前首次定位的位置信息。
可选地,在所述判断当前所保存的序贯先验位置信息是否有效之前,所述方法还包括:
在GNSS信号连续跟踪阶段,不断解算更新定位信息;
根据所述定位信息,计算所有参与定位卫星的后验残差的均方根误差;
进行精度因子值解算,得到反映当前星空图几何构型的精度因子值;
获取多系统的定位卫星数目;
根据所述所有参与定位卫星的后验残差的均方根误差、所述反映当前星空图几何构型的精度因子值以及所述多系统的定位卫星数目,判断当前位置信息的定位精度是否满足预定精度判定条件;
若当前位置信息的定位精度满足预定精度判定条件,则将当前时刻的位置信息作为序贯先验位置信息进行保存。
可选地,所述根据所述所有参与定位卫星的后验残差的均方根误差、所述反映当前星空图几何构型的精度因子值以及所述多系统的定位卫星数目,判断当前位置信息的定位精度是否满足预定精度判定条件包括:
判断所述所有参与定位卫星的后验残差的均方根误差是否小于第一阈值、所述反映当前星空图几何构型的精度因子值是否小于第二阈值以及所述多系统的定位卫星数目是否大于第三阈值;
若上述阈值判断条件均成立,则判定当前位置信息的定位精度满足预定精度判定条件。
可选地,所述判断当前所保存的序贯先验位置信息是否有效包括:
基于当前时刻的伪距观测量及星历参数,进行首次预定位,解算出当前时刻GNSS接收机的概略钟差;
结合已消除误差改正项的伪距观测量,利用当前所保存的序贯先验位置信息,按照如下公式计算得到各伪距观测量的残差δρ:
式中,ρ为消除误差改正项的观测量,为卫星位置XS到序贯先验位置之间的几何距离,为接收机概略钟差,c为预设系数;
计算最大偏差和次大偏差,其中,所述最大偏差等于最大残差减去最小残差,所述次大偏差等于次大残差减去次小残差;
判断所述最大偏差是否小于预先设定的最大阈值,判断所述次大偏差是否小于预先设定的次大阈值;
若上述阈值判断条件均成立,则判定当前所保存的序贯先验位置信息有效。
可选地,所述根据当前所保存的序贯先验位置信息,利用序贯最小二乘解算,获得GNSS接收机当前首次定位的位置信息包括:
利用如下公式确定方差调整因子:
其中,pi为方差调整因子,vi为第i颗卫星的残差,为残差的均方差,k为预设常数;
根据所述方差调整因子更新各卫星伪距观测量对应的方差信息;
通过当前时刻和历史位置信息对应时刻t0,以及历史速度信息v0,利用位置不确定度,获取序贯先验位置的先验方差;
根据如下公式的观测方程:
采用如下公式计算参数解及方差:
其中,Y为伪距观测量,R为对应的方差信息;X0为序贯先验位置,为对应的先验方差,G为系数矩阵,X为待求位置及钟差参数以及相应方差,为当前首次定位的位置估值;
其中,上述计算参数解及方差的公式可改写为序贯形式的如下公式:
其中,为增益矩阵;
将各伪距观测量按照各自方差从小到大的顺序,按照上述序贯形式的公式,逐个进入序贯最小二乘解算,最终解得GNSS接收机当前首次定位的位置信息。
第二方面,本发明提供一种实现GNSS接收机首次定位的装置,包括:
第一判断单元,用于在GNSS接收机进行当前首次定位之前,判断当前所保存的序贯先验位置信息是否有效,其中,所述序贯先验位置信息为满足预定精度判定条件的历史位置信息;
第一解算单元,用于当所述第一判断单元判定当前所保存的序贯先验位置信息有效时,根据当前所保存的序贯先验位置信息,利用序贯最小二乘解算,获得GNSS接收机当前首次定位的位置信息。
可选地,所述装置还包括:
第二解算单元,用于在所述第一判断单元判断当前所保存的序贯先验位置信息是否有效之前,在GNSS信号连续跟踪阶段,不断解算更新定位信息;
计算单元,用于根据所述定位信息,计算所有参与定位卫星的后验残差的均方根误差;
第三解算单元,用于进行精度因子值解算,得到反映当前星空图几何构型的精度因子值;
获取单元,用于获取多系统的定位卫星数目;
第二判断单元,用于根据所述所有参与定位卫星的后验残差的均方根误差、所述反映当前星空图几何构型的精度因子值以及所述多系统的定位卫星数目,判断当前位置信息的定位精度是否满足预定精度判定条件;
保存单元,用于当所述第二判断单元判定所述当前位置信息的定位精度满足预定精度判定条件时,将当前时刻的位置信息作为序贯先验位置信息进行保存。
可选地,所述第二判断单元,用于判断所述所有参与定位卫星的后验残差的均方根误差是否小于第一阈值、所述反映当前星空图几何构型的精度因子值是否小于第二阈值以及所述多系统的定位卫星数目是否大于第三阈值;当上述阈值判断条件均成立时,判定当前位置信息的定位精度满足预定精度判定条件。
可选地,所述第一判断单元包括:
第一解算模块,用于基于当前时刻的伪距观测量及星历参数,进行首次预定位,解算出当前时刻GNSS接收机的概略钟差;
第一计算模块,用于结合已消除误差改正项的伪距观测量,利用当前所保存的序贯先验位置信息,按照如下公式计算得到各伪距观测量的残差δρ:
式中,ρ为消除误差改正项的观测量,为卫星位置XS到序贯先验位置之间的几何距离,为接收机概略钟差,c为预设系数;
第二计算模块,用于计算最大偏差和次大偏差,其中,所述最大偏差等于最大残差减去最小残差,所述次大偏差等于次大残差减去次小残差;
判断模块,用于判断所述最大偏差是否小于预先设定的最大阈值,判断所述次大偏差是否小于预先设定的次大阈值;当上述阈值判断条件均成立时,判定当前所保存的序贯先验位置信息有效。
可选地,所述第一解算单元包括:
确定模块,用于利用如下公式确定方差调整因子:
其中,pi为方差调整因子,vi为第i颗卫星的残差,为残差的均方差,k为预设常数;
更新模块,用于根据所述方差调整因子更新各卫星伪距观测量对应的方差信息;
获取模块,用于通过当前时刻和历史位置信息对应时刻t0,以及历史速度信息v0,利用位置不确定度,获取序贯先验位置的先验方差;
第三计算模块,用于根据如下公式的观测方程:
采用如下公式计算参数解及方差:
其中,Y为伪距观测量,R为对应的方差信息;X0为序贯先验位置,为对应的先验方差,G为系数矩阵,X为待求位置及钟差参数以及相应方差,为当前首次定位的位置估值;
第二解算模块,用于将各伪距观测量按照各自方差从小到大的顺序,按照以下由上述计算参数解及方差的公式改写成的序贯形式的公式,逐个进入序贯最小二乘解算,最终解得GNSS接收机当前首次定位的位置信息:
其中,为增益矩阵。
第三方面,本发明提供一种移动终端,所述移动终端包括上述实现GNSS接收机首次定位的装置。
本发明实施例提供的实现GNSS接收机首次定位的方法、装置及移动终端,在GNSS接收机进行当前首次定位之前,判断当前所保存的序贯先验位置信息是否有效,如果有效,则根据当前所保存的序贯先验位置信息,利用序贯最小二乘解算,获得GNSS接收机当前首次定位的位置信息。与现有技术相比,本发明在进行GNSS接收机首次定位时,在综合考虑历史位置信息可靠性的前提下,采用稳健估计以保证序贯最小二乘具备一定的抗粗差特性,相比现有的首次导航定位方法,本发明在卫星信号遮挡严重、多径效应明显、卫星几何构型差等条件下,具备更优的首次定位精度。
附图说明
图1为本发明一实施例实现GNSS接收机首次定位的方法的流程图;
图2为本发明另一实施例实现GNSS接收机首次定位的方法的流程图;
图3为本发明一实施例实现GNSS接收机首次定位的装置的结构示意图;
图4为本发明另一实施例实现GNSS接收机首次定位的装置的结构示意图;
图5为本发明又一实施例实现GNSS接收机首次定位的装置的结构示意图;
图6为本发明再一实施例实现GNSS接收机首次定位的装置的结构示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明实施例提供一种实现GNSS接收机首次定位的方法,如图1所示,所述方法包括:
S11、在GNSS接收机进行当前首次定位之前,判断当前所保存的序贯先验位置信息是否有效,其中,所述序贯先验位置信息为满足预定精度判定条件的历史位置信息。
S12、若当前所保存的序贯先验位置信息有效,则根据当前所保存的序贯先验位置信息,利用序贯最小二乘解算,获得GNSS接收机当前首次定位的位置信息。
若当前所保存的序贯先验位置信息无效,则利用常规的首次定位方法计算GNSS接收机当前首次定位的位置信息。
本发明实施例提供的实现GNSS接收机首次定位的方法,在GNSS接收机进行当前首次定位之前,判断当前所保存的序贯先验位置信息是否有效,如果有效,则根据当前所保存的序贯先验位置信息,利用序贯最小二乘解算,获得GNSS接收机当前首次定位的位置信息。与现有技术相比,本发明在进行GNSS接收机首次定位时,在综合考虑历史位置信息可靠性的前提下,采用稳健估计以保证序贯最小二乘具备一定的抗粗差特性,相比现有的首次导航定位方法,本发明在卫星信号遮挡严重、多径效应明显、卫星几何构型差等条件下,具备更优的首次定位精度。
本发明实施例提供另一种实现GNSS接收机首次定位的方法,如图2所示,所述方法包括:
S21、在GNSS接收机进行当前首次定位之前,在GNSS信号连续跟踪阶段,不断解算更新定位信息。
具体地,可以通过LSQ或KF不断解算更新定位信息。
其中,GNSS接收机首先通过测量得到卫星信号接收时刻的伪距观测量;然后根据接口文件描述的格式对帧同步后的导航电文进行解码,获取卫星星历参数;接着利用基带多径相关指标、Raim自检及其它粗差探测手段对异常观测量的筛选剔除以及对电离层、对流层、地球自转、相对论等的误差改正;最后基于以上数据,利用最小二乘方法或卡尔曼滤波方法,得到最终的位置结果及接收机钟差信息。
S22、根据所述定位信息,计算所有参与定位卫星的后验残差的RMS(Root MeanSquare,均方根)误差;
S23、进行DOP(Dilution of Precision,精度因子)值解算,得到反映当前星空图几何构型的精度因子值;
S24、获取多系统的定位卫星数目;
S25、根据所述所有参与定位卫星的后验残差的RMS误差、所述反映当前星空图几何构型的DOP值以及所述多系统的定位卫星数目,判断当前位置信息的定位精度是否满足预定精度判定条件;若当前位置信息的定位精度满足预定精度判定条件,执行步骤S26,否则返回执行步骤S21,继续判定下一时刻的定位精度。
具体地,判断所述所有参与定位卫星的后验残差的RMS误差是否小于第一阈值ThRms、所述反映当前星空图几何构型的DOP值是否小于第二阈值ThDop以及所述多系统的定位卫星数目是否大于第三阈值ThNum;其中,所述多系统的定位卫星数目为(SatNum–SysNum(GNSS系统数))。若上述阈值判断条件均成立,则判定当前位置信息的定位精度满足预定精度判定条件。
S26、将当前时刻的位置信息作为序贯先验位置信息进行保存。
其中,在动态过程中,满足精度判定的历史位置信息需要不断更新。而静态时,需要更新DOP值、RMS误差、卫星数最优时的位置信息。需要保存上述条件下的相关信息:位置坐标,当前具体时刻(t0)及速度信息(v0)。序贯先验位置信息保存或更新成功后,继续下一时刻的先验信息解算及精度判定,返回执行步骤S21。
S27、判断当前所保存的序贯先验位置信息是否有效,若有效,则执行步骤S28,否则执行步骤S29。
具体地,首先,基于当前时刻的伪距观测量及星历参数,进行首次预定位,解算出当前时刻GNSS接收机的概略钟差。其中,可以利用LSQ进行首次预定位。
其次,结合已消除误差改正项的伪距观测量,利用当前所保存的序贯先验位置信息,按照如下公式计算得到各伪距观测量的残差δρ:
其中,ρ为消除误差改正项的观测量,为卫星位置XS到序贯先验位置之间的几何距离,为接收机概略钟差,c为预设系数;
然后,计算最大偏差和次大偏差,其中,所述最大偏差等于最大残差减去最小残差,所述次大偏差等于次大残差减去次小残差;
接着,判断所述最大偏差是否小于预先设定的最大阈值ThVar,判断所述次大偏差是否小于预先设定的次大阈值ThSecVar;若上述阈值判断条件均成立,则判定当前所保存的序贯先验位置信息有效,否则判定当前所保存的序贯先验位置信息无效。
S28、根据当前所保存的序贯先验位置信息,利用序贯最小二乘解算,获得GNSS接收机当前首次定位的位置信息。
具体地,首先,进行稳健估计,可选择Huber函数的稳健估计方法,利用如下公式确定方差调整因子:
其中,pi为方差调整因子,vi为第i颗卫星的残差,为残差的均方差,k为预设常数,可以取2.0。
其次,根据所述方差调整因子更新各卫星伪距观测量对应的方差信息;
据此,经稳健估计调整后的方差能够使序贯最小二乘方法具有一定的抗差特性。
然后,通过当前时刻和历史位置信息对应时刻t0,以及历史速度信息v0,利用位置不确定度,获取序贯先验位置的先验方差;
根据如下公式的观测方程:
采用如下公式计算参数解及方差:
其中,Y为伪距观测量,R为对应的方差信息;X0为序贯先验位置,为对应的先验方差,G为系数矩阵,X为待求位置及钟差参数以及相应方差,为当前首次定位的位置估值;
其中,上述计算参数解及方差的公式可改写为序贯形式的如下公式:
其中,为增益矩阵;
接着,将各伪距观测量按照各自方差从小到大的顺序,按照上述序贯形式的公式,逐个进入序贯最小二乘解算,最终解得GNSS接收机当前首次定位的位置信息。
S29、利用常规的首次定位方法计算GNSS接收机当前首次定位的位置信息。
本发明实施例还提供一种实现GNSS接收机首次定位的装置,如图3所示,所述装置包括:
第一判断单元11,用于在GNSS接收机进行当前首次定位之前,判断当前所保存的序贯先验位置信息是否有效,其中,所述序贯先验位置信息为满足预定精度判定条件的历史位置信息;
第一解算单元12,用于当所述第一判断单元11判定当前所保存的序贯先验位置信息有效时,根据当前所保存的序贯先验位置信息,利用序贯最小二乘解算,获得GNSS接收机当前首次定位的位置信息。
本发明实施例提供的实现GNSS接收机首次定位的装置,在GNSS接收机进行当前首次定位之前,判断当前所保存的序贯先验位置信息是否有效,如果有效,则根据当前所保存的序贯先验位置信息,利用序贯最小二乘解算,获得GNSS接收机当前首次定位的位置信息。与现有技术相比,本发明在进行GNSS接收机首次定位时,在综合考虑历史位置信息可靠性的前提下,采用稳健估计以保证序贯最小二乘具备一定的抗粗差特性,相比现有的首次导航定位方法,本发明在卫星信号遮挡严重、多径效应明显、卫星几何构型差等条件下,具备更优的首次定位精度。
进一步地,如图4所示,所述装置还包括:
第二解算单元13,用于在所述第一判断单元11判断当前所保存的序贯先验位置信息是否有效之前,在GNSS信号连续跟踪阶段,不断解算更新定位信息;
计算单元14,用于根据所述定位信息,计算所有参与定位卫星的后验残差的均方根误差;
第三解算单元15,用于进行精度因子值解算,得到反映当前星空图几何构型的精度因子值;
获取单元16,用于获取多系统的定位卫星数目;
第二判断单元17,用于根据所述所有参与定位卫星的后验残差的均方根误差、所述反映当前星空图几何构型的精度因子值以及所述多系统的定位卫星数目,判断当前位置信息的定位精度是否满足预定精度判定条件;
保存单元18,用于当所述第二判断单元17判定所述当前位置信息的定位精度满足预定精度判定条件时,将当前时刻的位置信息作为序贯先验位置信息进行保存。
可选地,所述第二判断单元17,用于判断所述所有参与定位卫星的后验残差的均方根误差是否小于第一阈值、所述反映当前星空图几何构型的精度因子值是否小于第二阈值以及所述多系统的定位卫星数目是否大于第三阈值;当上述阈值判断条件均成立时,判定当前位置信息的定位精度满足预定精度判定条件。
进一步地,如图5所示,所述第一判断单元11包括:
第一解算模块111,用于基于当前时刻的伪距观测量及星历参数,进行首次预定位,解算出当前时刻GNSS接收机的概略钟差;
第一计算模块112,用于结合已消除误差改正项的伪距观测量,利用当前所保存的序贯先验位置信息,按照如下公式计算得到各伪距观测量的残差δρ:
式中,ρ为消除误差改正项的观测量,为卫星位置XS到序贯先验位置之间的几何距离,为接收机概略钟差,c为预设系数;
第二计算模块113,用于计算最大偏差和次大偏差,其中,所述最大偏差等于最大残差减去最小残差,所述次大偏差等于次大残差减去次小残差;
判断模块114,用于判断所述最大偏差是否小于预先设定的最大阈值,判断所述次大偏差是否小于预先设定的次大阈值;当上述阈值判断条件均成立时,判定当前所保存的序贯先验位置信息有效。
进一步地,如图6所示,所述第一解算单元12包括:
确定模块121,用于利用如下公式确定方差调整因子:
其中,pi为方差调整因子,vi为第i颗卫星的残差,为残差的均方差,k为预设常数;
更新模块122,用于根据所述方差调整因子更新各卫星伪距观测量对应的方差信息;
获取模块123,用于通过当前时刻和历史位置信息对应时刻t0,以及历史速度信息v0,利用位置不确定度,获取序贯先验位置的先验方差;
第三计算模块124,用于根据如下公式的观测方程:
采用如下公式计算参数解及方差:
其中,Y为伪距观测量,R为对应的方差信息;X0为序贯先验位置,为对应的先验方差,G为系数矩阵,X为待求位置及钟差参数以及相应方差,为当前首次定位的位置估值;
第二解算模块125,用于将各伪距观测量按照各自方差从小到大的顺序,按照以下由上述计算参数解及方差的公式改写成的序贯形式的公式,逐个进入序贯最小二乘解算,最终解得GNSS接收机当前首次定位的位置信息:
其中,为增益矩阵。
本发明实施例还提供一种移动终端,所述移动终端包括上述实现GNSS接收机首次定位的装置。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于一计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,所述的存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)或随机存储记忆体(Random AccessMemory,RAM)等。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应该以权利要求的保护范围为准。
Claims (11)
1.一种实现GNSS接收机首次定位的方法,其特征在于,包括:
在GNSS接收机进行当前首次定位之前,判断当前所保存的序贯先验位置信息是否有效,其中,所述序贯先验位置信息为满足预定精度判定条件的历史位置信息;
若当前所保存的序贯先验位置信息有效,则根据当前所保存的序贯先验位置信息,利用序贯最小二乘解算,获得GNSS接收机当前首次定位的位置信息。
2.根据权利要求1所述的方法,其特征在于,在所述判断当前所保存的序贯先验位置信息是否有效之前,所述方法还包括:
在GNSS信号连续跟踪阶段,不断解算更新定位信息;
根据所述定位信息,计算所有参与定位卫星的后验残差的均方根误差;
进行精度因子值解算,得到反映当前星空图几何构型的精度因子值;
获取多系统的定位卫星数目;
根据所述所有参与定位卫星的后验残差的均方根误差、所述反映当前星空图几何构型的精度因子值以及所述多系统的定位卫星数目,判断当前位置信息的定位精度是否满足预定精度判定条件;
若当前位置信息的定位精度满足预定精度判定条件,则将当前时刻的位置信息作为序贯先验位置信息进行保存。
3.根据权利要求2所述的方法,其特征在于,所述根据所述所有参与定位卫星的后验残差的均方根误差、所述反映当前星空图几何构型的精度因子值以及所述多系统的定位卫星数目,判断当前位置信息的定位精度是否满足预定精度判定条件包括:
判断所述所有参与定位卫星的后验残差的均方根误差是否小于第一阈值、所述反映当前星空图几何构型的精度因子值是否小于第二阈值以及所述多系统的定位卫星数目是否大于第三阈值;
若上述阈值判断条件均成立,则判定当前位置信息的定位精度满足预定精度判定条件。
4.根据权利要求1所述的方法,其特征在于,所述判断当前所保存的序贯先验位置信息是否有效包括:
基于当前时刻的伪距观测量及星历参数,进行首次预定位,解算出当前时刻GNSS接收机的概略钟差;
结合已消除误差改正项的伪距观测量,利用当前所保存的序贯先验位置信息,按照如下公式计算得到各伪距观测量的残差δρ:
<mrow>
<mi>&delta;</mi>
<mi>&rho;</mi>
<mo>=</mo>
<mi>&rho;</mi>
<mo>-</mo>
<msub>
<mi>r</mi>
<mrow>
<mo>(</mo>
<msup>
<mi>X</mi>
<mi>S</mi>
</msup>
<mo>,</mo>
<msubsup>
<mi>X</mi>
<mn>0</mn>
<mi>r</mi>
</msubsup>
<mo>)</mo>
</mrow>
</msub>
<mo>-</mo>
<msubsup>
<mi>c&delta;t</mi>
<mn>0</mn>
<mi>r</mi>
</msubsup>
</mrow>
式中,ρ为消除误差改正项的观测量,为卫星位置XS到序贯先验位置之间的几何距离,为接收机概略钟差,c为预设系数;
计算最大偏差和次大偏差,其中,所述最大偏差等于最大残差减去最小残差,所述次大偏差等于次大残差减去次小残差;
判断所述最大偏差是否小于预先设定的最大阈值,判断所述次大偏差是否小于预先设定的次大阈值;
若上述阈值判断条件均成立,则判定当前所保存的序贯先验位置信息有效。
5.根据权利要求1所述的方法,其特征在于,所述根据当前所保存的序贯先验位置信息,利用序贯最小二乘解算,获得GNSS接收机当前首次定位的位置信息包括:
利用如下公式确定方差调整因子:
<mrow>
<msub>
<mi>p</mi>
<mi>i</mi>
</msub>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mn>1</mn>
<mo>,</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<msub>
<mi>v</mi>
<mi>i</mi>
</msub>
<mo>|</mo>
<mo>&le;</mo>
<msub>
<mi>k&sigma;</mi>
<msub>
<mi>v</mi>
<mi>i</mi>
</msub>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mfrac>
<mrow>
<mo>|</mo>
<msub>
<mi>v</mi>
<mi>i</mi>
</msub>
<mo>|</mo>
</mrow>
<mi>k</mi>
</mfrac>
<mo>,</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<msub>
<mi>v</mi>
<mi>i</mi>
</msub>
<mo>|</mo>
<mo>></mo>
<msub>
<mi>k&sigma;</mi>
<msub>
<mi>v</mi>
<mi>i</mi>
</msub>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
其中,pi为方差调整因子,vi为第i颗卫星的残差,为残差的均方差,k为预设常数;
根据所述方差调整因子更新各卫星伪距观测量对应的方差信息;
通过当前时刻和历史位置信息对应时刻t0,以及历史速度信息v0,利用位置不确定度,获取序贯先验位置的先验方差;
根据如下公式的观测方程:
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>Y</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<msup>
<mi>X</mi>
<mn>0</mn>
</msup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>G</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>I</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mi>X</mi>
<mo>,</mo>
<mi>P</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>R</mi>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msub>
<mi>P</mi>
<msup>
<mi>X</mi>
<mn>0</mn>
</msup>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
采用如下公式计算参数解及方差:
其中,Y为伪距观测量,R为对应的方差信息;X0为序贯先验位置,为对应的先验方差,G为系数矩阵,X为待求位置及钟差参数以及相应方差,为当前首次定位的位置估值;
其中,上述计算参数解及方差的公式可改写为序贯形式的如下公式:
其中,为增益矩阵;
将各伪距观测量按照各自方差从小到大的顺序,按照上述序贯形式的公式,逐个进入序贯最小二乘解算,最终解得GNSS接收机当前首次定位的位置信息。
6.一种实现GNSS接收机首次定位的装置,其特征在于,包括:
第一判断单元,用于在GNSS接收机进行当前首次定位之前,判断当前所保存的序贯先验位置信息是否有效,其中,所述序贯先验位置信息为满足预定精度判定条件的历史位置信息;
第一解算单元,用于当所述第一判断单元判定当前所保存的序贯先验位置信息有效时,根据当前所保存的序贯先验位置信息,利用序贯最小二乘解算,获得GNSS接收机当前首次定位的位置信息。
7.根据权利要求6所述的装置,其特征在于,所述装置还包括:
第二解算单元,用于在所述第一判断单元判断当前所保存的序贯先验位置信息是否有效之前,在GNSS信号连续跟踪阶段,不断解算更新定位信息;
计算单元,用于根据所述定位信息,计算所有参与定位卫星的后验残差的均方根误差;
第三解算单元,用于进行精度因子值解算,得到反映当前星空图几何构型的精度因子值;
获取单元,用于获取多系统的定位卫星数目;
第二判断单元,用于根据所述所有参与定位卫星的后验残差的均方根误差、所述反映当前星空图几何构型的精度因子值以及所述多系统的定位卫星数目,判断当前位置信息的定位精度是否满足预定精度判定条件;
保存单元,用于当所述第二判断单元判定所述当前位置信息的定位精度满足预定精度判定条件时,将当前时刻的位置信息作为序贯先验位置信息进行保存。
8.根据权利要求7所述的装置,其特征在于,所述第二判断单元,用于判断所述所有参与定位卫星的后验残差的均方根误差是否小于第一阈值、所述反映当前星空图几何构型的精度因子值是否小于第二阈值以及所述多系统的定位卫星数目是否大于第三阈值;当上述阈值判断条件均成立时,判定当前位置信息的定位精度满足预定精度判定条件。
9.根据权利要求6所述的装置,其特征在于,所述第一判断单元包括:
第一解算模块,用于基于当前时刻的伪距观测量及星历参数,进行首次预定位,解算出当前时刻GNSS接收机的概略钟差;
第一计算模块,用于结合已消除误差改正项的伪距观测量,利用当前所保存的序贯先验位置信息,按照如下公式计算得到各伪距观测量的残差δρ:
<mrow>
<mi>&delta;</mi>
<mi>&rho;</mi>
<mo>=</mo>
<mi>&rho;</mi>
<mo>-</mo>
<msub>
<mi>r</mi>
<mrow>
<mo>(</mo>
<msup>
<mi>X</mi>
<mi>S</mi>
</msup>
<mo>,</mo>
<msubsup>
<mi>X</mi>
<mn>0</mn>
<mi>r</mi>
</msubsup>
<mo>)</mo>
</mrow>
</msub>
<mo>-</mo>
<msubsup>
<mi>c&delta;t</mi>
<mn>0</mn>
<mi>r</mi>
</msubsup>
</mrow>
式中,ρ为消除误差改正项的观测量,为卫星位置XS到序贯先验位置之间的几何距离,为接收机概略钟差,c为预设系数;
第二计算模块,用于计算最大偏差和次大偏差,其中,所述最大偏差等于最大残差减去最小残差,所述次大偏差等于次大残差减去次小残差;
判断模块,用于判断所述最大偏差是否小于预先设定的最大阈值,判断所述次大偏差是否小于预先设定的次大阈值;当上述阈值判断条件均成立时,判定当前所保存的序贯先验位置信息有效。
10.根据权利要求6所述的装置,其特征在于,所述第一解算单元包括:
确定模块,用于利用如下公式确定方差调整因子:
<mrow>
<msub>
<mi>p</mi>
<mi>i</mi>
</msub>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mn>1</mn>
<mo>,</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<msub>
<mi>v</mi>
<mi>i</mi>
</msub>
<mo>|</mo>
<mo>&le;</mo>
<msub>
<mi>k&sigma;</mi>
<msub>
<mi>v</mi>
<mi>i</mi>
</msub>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mfrac>
<mrow>
<mo>|</mo>
<msub>
<mi>v</mi>
<mi>i</mi>
</msub>
<mo>|</mo>
</mrow>
<mi>k</mi>
</mfrac>
<mo>,</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<msub>
<mi>v</mi>
<mi>i</mi>
</msub>
<mo>|</mo>
<mo>></mo>
<msub>
<mi>k&sigma;</mi>
<msub>
<mi>v</mi>
<mi>i</mi>
</msub>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
其中,pi为方差调整因子,vi为第i颗卫星的残差,为残差的均方差,k为预设常数;
更新模块,用于根据所述方差调整因子更新各卫星伪距观测量对应的方差信息;
获取模块,用于通过当前时刻和历史位置信息对应时刻t0,以及历史速度信息v0,利用位置不确定度,获取序贯先验位置的先验方差;
第三计算模块,用于根据如下公式的观测方程:
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>Y</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<msup>
<mi>X</mi>
<mn>0</mn>
</msup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>G</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>I</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mi>X</mi>
<mo>,</mo>
<mi>P</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>R</mi>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msub>
<mi>P</mi>
<msup>
<mi>X</mi>
<mn>0</mn>
</msup>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
采用如下公式计算参数解及方差:
其中,Y为伪距观测量,R为对应的方差信息;X0为序贯先验位置,为对应的先验方差,G为系数矩阵,X为待求位置及钟差参数以及相应方差,为当前首次定位的位置估值;
第二解算模块,用于将各伪距观测量按照各自方差从小到大的顺序,按照以下由上述计算参数解及方差的公式改写成的序贯形式的公式,逐个进入序贯最小二乘解算,最终解得GNSS接收机当前首次定位的位置信息:
其中,为增益矩阵。
11.一种移动终端,其特征在于,所述移动终端包括如权利要求6至10中任一项所述的实现GNSS接收机首次定位的装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611058787.2A CN108107458B (zh) | 2016-11-24 | 2016-11-24 | 实现gnss接收机首次定位的方法、装置及移动终端 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611058787.2A CN108107458B (zh) | 2016-11-24 | 2016-11-24 | 实现gnss接收机首次定位的方法、装置及移动终端 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108107458A true CN108107458A (zh) | 2018-06-01 |
CN108107458B CN108107458B (zh) | 2021-07-23 |
Family
ID=62205338
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611058787.2A Active CN108107458B (zh) | 2016-11-24 | 2016-11-24 | 实现gnss接收机首次定位的方法、装置及移动终端 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108107458B (zh) |
Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101246208A (zh) * | 2007-02-14 | 2008-08-20 | 凹凸科技(中国)有限公司 | 减少开机后首次定位时间的gps接收机及方法 |
CN101398477A (zh) * | 2007-09-28 | 2009-04-01 | 英特尔公司 | 用于使用预下载辅助数据的快速全球定位系统(gps)定位的方法和装置 |
CN102209911A (zh) * | 2008-09-11 | 2011-10-05 | 加利福尼亚技术学院 | 用于内部接收器自动预测gnss星历的方法和装置 |
CN103152745A (zh) * | 2013-03-26 | 2013-06-12 | 华南师范大学 | 一种强自适应性移动节点定位的方法 |
CN103148813A (zh) * | 2013-01-31 | 2013-06-12 | 湖南致力地质资源环境工程科技有限公司 | 用于处理gps变形监测数据的方法 |
CN103344946A (zh) * | 2013-07-08 | 2013-10-09 | 杭州电子科技大学 | 一种地基雷达与空中移动平台雷达的实时误差配准方法 |
CN103941272A (zh) * | 2014-04-09 | 2014-07-23 | 上海华测导航技术有限公司 | Gps、glonass和bds联合解算的定位方法 |
CN104035113A (zh) * | 2014-06-26 | 2014-09-10 | 桂林电子科技大学 | 基于伪距的多模gnss接收机的可靠定位方法 |
US20140375493A1 (en) * | 2012-12-28 | 2014-12-25 | Trimble Navigation Limited | Locally measured movement smoothing of gnss position fixes |
CN104459722A (zh) * | 2014-11-13 | 2015-03-25 | 中交三航局第三工程有限公司 | 一种基于多余观测分量的整周模糊度可靠性检验方法 |
US20150153460A1 (en) * | 2012-06-26 | 2015-06-04 | St-Ericsson Sa | Sequential Estimation in a Real-Time Positioning or Navigation System Using Historical States |
US9201983B2 (en) * | 2011-05-31 | 2015-12-01 | Samsung Electronics Co., Ltd. | Apparatus and method for providing search pattern of user in mobile terminal |
CN105204048A (zh) * | 2014-06-24 | 2015-12-30 | 东南大学 | 一种北斗兼容gps/glonass的网络rtk参考站间模糊度快速解算方法 |
CN105527640A (zh) * | 2014-09-29 | 2016-04-27 | 展讯通信(上海)有限公司 | 定位方法、装置及接收机 |
-
2016
- 2016-11-24 CN CN201611058787.2A patent/CN108107458B/zh active Active
Patent Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101246208A (zh) * | 2007-02-14 | 2008-08-20 | 凹凸科技(中国)有限公司 | 减少开机后首次定位时间的gps接收机及方法 |
CN101398477A (zh) * | 2007-09-28 | 2009-04-01 | 英特尔公司 | 用于使用预下载辅助数据的快速全球定位系统(gps)定位的方法和装置 |
CN102209911A (zh) * | 2008-09-11 | 2011-10-05 | 加利福尼亚技术学院 | 用于内部接收器自动预测gnss星历的方法和装置 |
US9201983B2 (en) * | 2011-05-31 | 2015-12-01 | Samsung Electronics Co., Ltd. | Apparatus and method for providing search pattern of user in mobile terminal |
US20150153460A1 (en) * | 2012-06-26 | 2015-06-04 | St-Ericsson Sa | Sequential Estimation in a Real-Time Positioning or Navigation System Using Historical States |
US20140375493A1 (en) * | 2012-12-28 | 2014-12-25 | Trimble Navigation Limited | Locally measured movement smoothing of gnss position fixes |
CN103148813A (zh) * | 2013-01-31 | 2013-06-12 | 湖南致力地质资源环境工程科技有限公司 | 用于处理gps变形监测数据的方法 |
CN103152745A (zh) * | 2013-03-26 | 2013-06-12 | 华南师范大学 | 一种强自适应性移动节点定位的方法 |
CN103344946A (zh) * | 2013-07-08 | 2013-10-09 | 杭州电子科技大学 | 一种地基雷达与空中移动平台雷达的实时误差配准方法 |
CN103941272A (zh) * | 2014-04-09 | 2014-07-23 | 上海华测导航技术有限公司 | Gps、glonass和bds联合解算的定位方法 |
CN105204048A (zh) * | 2014-06-24 | 2015-12-30 | 东南大学 | 一种北斗兼容gps/glonass的网络rtk参考站间模糊度快速解算方法 |
CN104035113A (zh) * | 2014-06-26 | 2014-09-10 | 桂林电子科技大学 | 基于伪距的多模gnss接收机的可靠定位方法 |
CN105527640A (zh) * | 2014-09-29 | 2016-04-27 | 展讯通信(上海)有限公司 | 定位方法、装置及接收机 |
CN104459722A (zh) * | 2014-11-13 | 2015-03-25 | 中交三航局第三工程有限公司 | 一种基于多余观测分量的整周模糊度可靠性检验方法 |
Non-Patent Citations (2)
Title |
---|
LIYAN LI等: "Doppler-Aided GNSS Position Estimation With Weighted Least Squares", 《IEEE TRANSACTIONS ON VEHICULAR TECHNOLOGY》 * |
李红涛: "基于GPS和GLONASS的单站授时和时差监测研究", 《中国优秀硕士学位论文全文数据库 基础科学辑》 * |
Also Published As
Publication number | Publication date |
---|---|
CN108107458B (zh) | 2021-07-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP1718987B1 (en) | Satellite-based positioning of mobile terminals | |
KR101581653B1 (ko) | 위성 위치 확인 수신기 및 그것의 위치 결정 방법 | |
CN105849589B (zh) | 全球导航卫星系统、定位终端、定位方法以及记录介质 | |
US8593342B2 (en) | Utilizing SBAS signals to improve GNSS receiver performance | |
US20140070986A1 (en) | Apparatuses and methods for tracking a navigation receiver | |
EP2652523A1 (en) | Method and system for localizing mobile communications terminals | |
US20030236621A1 (en) | Determining the position of a receiver and/or the system time of a positioning system | |
KR102188880B1 (ko) | 단말, 기준국 및 위치 측위 방법 | |
CN111913201B (zh) | 一种gnss差分定位方法、装置及计算机可读存储介质 | |
CN104181562A (zh) | 一种全球导航卫星系统的卫星优选和定位方法 | |
CN110988934A (zh) | 多模式接收机星基增强技术装置及处理方法 | |
US20230400590A1 (en) | Enhanced real-time kinematic (rtk) | |
CN111913199B (zh) | 基于变分模态分解的手机gnss数据噪声提取方法 | |
CN114779301B (zh) | 一种基于广播星历的卫星导航实时精密单点定位方法 | |
US10386495B1 (en) | Method and apparatus for detecting poor Doppler measurement results in global navigation satellite system navigation | |
CN108107458A (zh) | 实现gnss接收机首次定位的方法、装置及移动终端 | |
CN114966757A (zh) | 用于基于gnss定位车辆的方法 | |
US20120249369A1 (en) | Quasi-cold start satellite vehicle search method and system | |
Zhang et al. | GNSS position-aided delay-locked loops for accurate urban navigation | |
CN117335899B (zh) | 一种北斗星基增强服务降效程度评估方法 | |
US11947019B2 (en) | Secondary code determination in a snapshot receiver based upon transmission time alignment | |
Martini et al. | PPP and Galileo high accuracy service with satellite selection strategies for kinematic applications | |
CN117826200A (zh) | 基于PPP-B2b的海上实时精密定位方法、系统和介质 | |
Kabir et al. | Minimizing GNSS Code Phase Positioning Error in Multipath Environments Using Deep Learning Model | |
CN117630996A (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 |