CN104502943B - 一种室内伪卫星差分相对定位方法 - Google Patents
一种室内伪卫星差分相对定位方法 Download PDFInfo
- Publication number
- CN104502943B CN104502943B CN201510021103.0A CN201510021103A CN104502943B CN 104502943 B CN104502943 B CN 104502943B CN 201510021103 A CN201510021103 A CN 201510021103A CN 104502943 B CN104502943 B CN 104502943B
- Authority
- CN
- China
- Prior art keywords
- pseudolite
- pseudo satellite
- receiver
- numbering
- receiver user
- 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/51—Relative positioning
-
- 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/40—Correcting position, velocity or attitude
- G01S19/41—Differential correction, e.g. DGPS [differential GPS]
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
本发明提供了一种室内伪卫星差分相对定位方法,以基准站接收机为坐标原点在世界坐标系中建立本地坐标系,通过公式推算,算出用户实际位置。本发明的有益效果是无需进行迭代运算,降低了工程实现的风险,是切实可行的实用技术,提出了一种新的适合于室内伪卫星定位的差分相对定位方法,有效消除了室内伪卫星定位过程中伪卫星以及用户接收机钟差对定位精度的影响,大大提高了室内伪卫星定位的定位精度。此外,本发明与现有的传统差分相对定位方法相比,计算量增加不大,易于工程实现。
Description
技术领域
本发明涉及卫星定位领域,尤其是室内伪卫星的定位。
背景技术
随着全球卫星导航系统的发展,人们对室内定位的需求越来越多,对室内定位的精度要求也越来越高。然而,由于其环境的复杂性导致很少甚至没有GNSS信号可以直接进入到室内。伪卫星的使用可以为室内环境提供有效的GNSS卫星信号,使室内高精度定位成为了可能。在室内定位过程中,没有电离层延时和对流层延时对定位精度的影响,但是由于室内伪卫星相对于用户接收机的距离远远小于室外卫星相对于用户接收机的距离,因此伪卫星的钟差以及用户接收机的钟差会给定位精度带来非常大的误差,导致室内伪卫星定位精度远远不能满足人们的正常需求。室外传统的差分相对定位方法可以减小卫星钟差以及用户接收机钟差对定位精度的影响,但是由于室内环境的特殊性,传统的差分相对定位方法不能在室内应用。因此,一种新的适用于室内伪卫星差分相对定位方法亟待提出。
发明内容
为了克服现有技术的不足,提高室内伪卫星的定位精度,本发明提供了一种基于室内伪卫星的差分相对定位方法,通过该方法可以有效的消除伪卫星和用户接收机的钟差,从而提高室内定位的精度。
本发明解决其技术问题所采用的技术方案的步骤是:
(1)以基准站接收机为坐标原点在世界坐标系O-XYZ中建立本地坐标系o-xyz,则基准站接收机位置R坐标为R=(0,0,0),给伪卫星用编号i来表示,i为1到n,n≥4,并精确测量每一颗伪卫星的位置,记其坐标为上标“i”为伪卫星编号,下标“s”代表伪卫星;
(2)利用单点定位算法,计算得到用户接收机的粗略位置M,记其坐标为M=(xu,f,yu,f,zu,f),下标“u,f”代表用户接收机粗略坐标;
(3)计算基准站接收机位置R到用户接收机粗略位置M的向量称向量为粗略基线,下标“f”表示粗略的意思;
(4)假设用户接收机的精确位置为U,坐标为U=(xu,yu,zu),下标“u”代表用户接收机,计算用户接收机粗略位置M到用户接收机精确位置U的向量
(5)计算用户接收机和基准站接收机对编号为i的伪卫星的载波相位单插测量值:
式(1)中,λ=0.19米,c=3×108米;表示用户接收机和基准站接收机对编号为i的伪卫星的载波相位单差测量值,上标“i”表示伪卫星的编号;为用户接收机到编号为i的伪卫星的几何距离;为用户接收机粗略位置M到编号为i的伪卫星的几何距离,且 为基准站接收机到编号为i的伪卫星的几何距离,且δtR为基准站接收机钟差,为未知数;δtU为用户接收机钟差,为未知数;为单差周整模糊度;
(6)将在用户接收机粗略位置M处进行泰勒展开,取一次项得:
因此有其中,向量是编号为i的伪卫星到用户接收机粗略位置M的单位向量
(7)用户接收机和基准站接收机对所有伪卫星的载波相位单差测量值,用矩阵表示得:
由式(3)可以得到载波相位双差方程组:
其中,为编号为i的伪卫星的载波相位单差测量值,i=1,2,…,n,为编号为j的伪卫星相对于编号为1的伪卫星的载波相位双差测量值,j=2,3,…,n,和的值可由基准站接收机和用户接收机直接测量得到,为已知数; 为编号为j的伪卫星相对于编号为1的伪卫星的单位向量,为编号为j的伪卫星相对于编号为1的伪卫星的双差周整模糊度,上标“j1”均表示参数是编号为“j”的伪卫星相对于编号为“1”的伪卫星;
(8)用户接收机和基准站接收机对所有伪卫星的伪距双差测量值,用矩阵表示为:
式(5)中,为伪距双差测量值,的值可由基准站接收机和用户接收机直接测量得到,为已知数;
(9)将式(4)和式(5)联立,得:
式(6)中, 0n-1,n-1表示(n-1)×(n-1)的零矩阵,En-1,n-1表示(n-1)×(n-1)的单位矩阵,上标“T”表示向量的转置;
(10)令计算精确基线的浮点解以及双差整周的浮点解得:
式(7)中,上标“T”代表矩阵的转置矩阵,上标“-1”代表矩阵的逆矩阵;
计算双差整周的协方差矩阵Q=(Hp,f T·Hp,f)-1,令经计算其中Q矩阵是一个(n+2)×(n+2)的已知矩阵,Qp,3×3、Qp,3×(n-1)、Qp,(n-1)×3以及Qp,(n-1)×(n-1)分别为Q矩阵相应的分块矩阵;
(11)由步骤(10)得到双差整周的浮点解以及双差整周的协方差矩阵Q后,使用LAMBDA算法计算解得双差整周的精确解
(12)计算精确基线的实际值:
(13)计算实际基线
(14)计算得出用户实际位置U:
U为用户最终的实际位置坐标,即定位结果。
本发明的有益效果是无需进行迭代运算,降低了工程实现的风险,是切实可行的实用技术,提出了一种新的适合于室内伪卫星定位的差分相对定位方法,有效消除了室内伪卫星定位过程中伪卫星以及用户接收机钟差对定位精度的影响,大大提高了室内伪卫星定位的定位精度。此外,本发明与现有的传统差分相对定位方法相比,计算量增加不大,易于工程实现。
附图说明
图1是本发明差分相对定位示意图,其中,Si表示编号为i的伪卫星,i=1,2,…,n,R表示基准站接收机位置,U表示用户接收机位置,M表示用户接收机的粗略位置,为用户接收机到编号为i的伪卫星的几何距离;为用户接收机粗略位置M 到编号为i的伪卫星的几何距离,为基准站接收机到编号为i的伪卫星的几何距离, 为实际基线,为精确基线,为粗略基线。
具体实施方式
下面结合附图和实施例对本发明进一步说明。
以下为具体步骤:
(1)以基准站接收机为坐标原点在世界坐标系O-XYZ中建立本地坐标系o-xyz,则基准站接收机位置R坐标为R=(0,0,0)。给伪卫星编号,分别为1到n(n≥4),编号用i来表示,并精确测量每一颗伪卫星的位置,记其坐标为上标“i”为伪卫星编号,下标“s”代表伪卫星。
(2)利用单点定位算法,计算得到用户接收机的粗略位置M,记其坐标为M=(xu,f,yu,f,zu,f),下标“u,f”代表用户接收机粗略坐标。
(3)计算基准站接收机位置R到用户接收机粗略位置M的向量 称向量为粗略基线,下标“f”表示粗略的意思;
(4)假设用户接收机的精确位置为U,坐标为U=(xu,yu,zu),下标“u”代表用户接收机,计算用户接收机粗略位置M到用户接收机精确位置U的向量
(5)计算用户接收机和基准站接收机对编号为i的伪卫星的载波相位单插测量值:
式(1)中,λ=0.19米,c=3×108米;表示用户接收机和基准站接收机对编号为i的伪卫星的载波相位单差测量值,上标“i”表示伪卫星的编号;为用户接收机到编号为i的伪卫星的几何距离;为用户接收机粗略位置M到编号为i的伪卫星的几何距离,且 为基准站接收机到编号为i的伪卫星的几何距离,且δtR为基准站接收机钟差,为未知数;δtU为用户接收机钟差,为未知数;为单差周整模糊度。
(6)将在用户接收机粗略位置M处进行泰勒展开,取一次项得:
因此有其中,向量是编号为i的伪卫星到用户接收机粗略位置M的单位向量
(7)用户接收机和基准站接收机对所有伪卫星的载波相位单差测量值,用矩阵表示得:
由式(3)可以得到载波相位双差方程组:
其中,为编号为i的伪卫星的载波相位单差测量值,i=1,2,…,n,为编号为j的伪卫星相对于编号为1的伪卫星的载波相位双差测量值,j=2,3,…,n,和的值可由基准站接收机和用户接收机直接测量得到,为已知数; 为编号为j的伪卫星相对于编号为1的伪卫星的单位向量,为编号为j的伪卫星相对于编号为1的伪卫星的双差周整模糊度,上标“j1”均表示参数是编号为“j”的伪卫星相对于编号为“1”的伪卫星。
(8)用户接收机和基准站接收机对所有伪卫星的伪距双差测量值,用矩阵表示为:
式(5)中,为伪距双差测量值,的值可由基准站接收机和用户接收机直接测量得到,为已知数。
(9)将式(4)和式(5)联立,得:
式(6)中, 0n-1,n-1表示(n-1)×(n-1)的零矩阵,En-1,n-1表示(n-1)×(n-1)的单位矩阵,上标“T”表示向量的转置;
(10)令计算精确基线的浮点解以及双差整周的浮点解得:
式(7)中,上标“T”代表矩阵的转置矩阵,上标“-1”代表矩阵的逆矩阵;
计算双差整周的协方差矩阵Q=(Hp,f T·Hp,f)-1,令经计算其中Q矩阵是一个(n+2)×(n+2)的已知矩阵,Qp,3×3、Qp,3×(n-1)、Qp,(n-1)×3以及Qp,(n-1)×(n-1)分别为Q矩阵相应的分块矩阵;
(11)由步骤(10)得到双差整周的浮点解以及双差整周的协方差矩阵Q后,使用LAMBDA算法计算解得双差整周的精确解
(12)计算精确基线的实际值:
(13)计算实际基线
(14)计算得出用户实际位置U:
U为用户最终的实际位置坐标,即定位结果。
Claims (1)
1.一种室内伪卫星差分相对定位方法,其特征在于包括下述步骤:
(1)以基准站接收机为坐标原点在世界坐标系O-XYZ中建立本地坐标系o-xyz,则基准站接收机位置R坐标为R=(0,0,0),给伪卫星用编号i来表示,i为1到n,n≥4,并精确测量每一颗伪卫星的位置,记其坐标为上标“i”为伪卫星编号,下标“s”代表伪卫星;
(2)利用单点定位算法,计算得到用户接收机的粗略位置M,记其坐标为M=(xu,f,yu,f,zu,f),下标“u,f”代表用户接收机粗略坐标;
(3)计算基准站接收机位置R到用户接收机粗略位置M的向量 称向量为粗略基线,下标“f”表示粗略的意思;
(4)假设用户接收机的精确位置为U,坐标为U=(xu,yu,zu),下标“u”代表用户接收机,计算用户接收机粗略位置M到用户接收机精确位置U的向量
(5)计算用户接收机和基准站接收机对编号为i的伪卫星的载波相位单插测量值:
式(1)中,λ=0.19米,c=3×108米;表示用户接收机和基准站接收机对编号为i的伪卫星的载波相位单差测量值,上标“i”表示伪卫星的编号;为用户接收机到编号为i的伪卫星的几何距离;为用户接收机粗略位置M到编号为i的伪卫星的几何距离,且 为基准站接收机到编号为i的伪卫星的几何距离,且δtR为基准站接收机钟差,为未知数;δtU为用户接收机钟差,为未知数;为单差周整模糊度;
(6)将在用户接收机粗略位置M处进行泰勒展开,取一次项得:
因此有其中,向量是编号为i的伪卫星到用户接收机粗略位 置M的单位向量
(7)用户接收机和基准站接收机对所有伪卫星的载波相位单差测量值,用矩阵表示得:
由式(3)可以得到载波相位双差方程组:
其中,为编号为i的伪卫星的载波相位单差测量值,i=1,2,…,n,为编号为j的伪卫星相对于编号为1的伪卫星的载波相位双差测量值,j=2,3,…,n,和的值可由基准站接收机和用户接收机直接测量得到,为已知数; 为编号为j的伪卫星相对于编号为1的伪卫星的单位向量,为编号为j的伪卫星相对于编号为1的伪卫星的双差周整模糊度,上标“j1”均表示参数是编号为“j”的伪卫星相对于编号为“1”的伪卫星;
(8)用户接收机和基准站接收机对所有伪卫星的伪距双差测量值,用矩阵表示为:
式(5)中,为伪距双差测量值,的值可由基准站接收机和用户接收机直接测量得到,为已知数;
(9)将式(4)和式(5)联立,得:
式(6)中, 0n-1,n-1表示(n-1)×(n-1)的零矩阵,En-1,n-1表示(n-1)×(n-1)的单位矩阵,上标“T”表示向量的转置;
(10)令计算精确基线的浮点解以及双差整周的浮点解得:
式(7)中,上标“T”代表矩阵的转置矩阵,上标“-1”代表矩阵的逆矩阵;
计算双差整周的协方差矩阵Q=(Hp,f T·Hp,f)-1,令经计算其中Q矩阵是一个(n+2)×(n+2)的已知矩阵,Qp,3×3、Qp,3×(n-1)、Qp,(n-1)×3以及Qp,(n-1)×(n-1)分别为Q矩阵相应的分块矩阵;
(11)由步骤(10)得到双差整周的浮点解以及双差整周的协方差矩阵Q后,使用LAMBDA算法计算解得双差整周的精确解
(12)计算精确基线的实际值:
(13)计算实际基线
(14)计算得出用户实际位置U:
U为用户最终的实际位置坐标,即定位结果。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510021103.0A CN104502943B (zh) | 2014-06-03 | 2015-01-15 | 一种室内伪卫星差分相对定位方法 |
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410305036 | 2014-06-03 | ||
CN2014103050360 | 2014-06-03 | ||
CN201510021103.0A CN104502943B (zh) | 2014-06-03 | 2015-01-15 | 一种室内伪卫星差分相对定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104502943A CN104502943A (zh) | 2015-04-08 |
CN104502943B true CN104502943B (zh) | 2017-07-04 |
Family
ID=52944354
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510021103.0A Expired - Fee Related CN104502943B (zh) | 2014-06-03 | 2015-01-15 | 一种室内伪卫星差分相对定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104502943B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106441174B (zh) * | 2016-09-09 | 2019-05-28 | 桂林电子科技大学 | 一种高边坡形变监测方法及系统 |
CN106842260B (zh) * | 2017-01-20 | 2019-04-23 | 大连理工大学 | 一种基于多层卫星信号中继器的室内定位方法 |
CN108226974B (zh) * | 2017-12-29 | 2021-09-28 | 北京航空航天大学 | 多无人机编队中的无人机定位方法和装置 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101710179A (zh) * | 2009-12-23 | 2010-05-19 | 武汉大学 | 一种gnss三频动对动定位方法 |
CN101825717A (zh) * | 2010-04-16 | 2010-09-08 | 北京航空航天大学 | 一种基于载波平滑码伪距技术的动态定姿方法 |
CN102736094A (zh) * | 2012-06-19 | 2012-10-17 | 哈尔滨工程大学 | 一种基于自适应遗传算法的单频gnss整周模糊度获取方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2849209B1 (fr) * | 2002-12-19 | 2007-04-06 | Agence Spatiale Europeenne | Procede et systeme de navigation en temps reel a l'aide de signaux radioelectriques a trois porteuses emis par des satellites et de corrections ionospheriques |
US7633437B2 (en) * | 2006-09-22 | 2009-12-15 | Navcom Technology, Inc. | Method for using three GPS frequencies to resolve whole-cycle carrier-phase ambiguities |
-
2015
- 2015-01-15 CN CN201510021103.0A patent/CN104502943B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101710179A (zh) * | 2009-12-23 | 2010-05-19 | 武汉大学 | 一种gnss三频动对动定位方法 |
CN101825717A (zh) * | 2010-04-16 | 2010-09-08 | 北京航空航天大学 | 一种基于载波平滑码伪距技术的动态定姿方法 |
CN102736094A (zh) * | 2012-06-19 | 2012-10-17 | 哈尔滨工程大学 | 一种基于自适应遗传算法的单频gnss整周模糊度获取方法 |
Non-Patent Citations (1)
Title |
---|
载波相位差分相对定位的模糊度求解;任小伟;《导航定位学报》;20140331;第2卷(第1期);正文第20-22页 * |
Also Published As
Publication number | Publication date |
---|---|
CN104502943A (zh) | 2015-04-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106168672B (zh) | 一种gnss多模单频rtk周跳探测方法及装置 | |
CN107193029B (zh) | 北斗三频信号的网络rtk基准站间模糊度快速确定方法 | |
CN106597499B (zh) | 网络rtk双差电离层延迟内插方法及装置 | |
CN107356947B (zh) | 基于单频导航卫星数据确定卫星差分伪距偏差的方法 | |
CN105891860B (zh) | 一种基于误差分离模式的gnss区域伪距差分增强定位方法 | |
CN107272039B (zh) | 一种基于双天线gps的定位测姿方法 | |
CN108931915A (zh) | 利用导航卫星的授时方法和装置、计算机可读存储介质 | |
CN103630914B (zh) | 一种gnss基线解算参考卫星选择方法 | |
CN104656108B (zh) | 一种顾及高程差异的稀疏参考站网络天顶对流层延迟建模方法 | |
CN105044741B (zh) | 一种伪距相位综合广域差分改正值的求解方法 | |
CN104614741B (zh) | 一种不受glonass码频间偏差影响的实时精密卫星钟差估计方法 | |
CN105929424A (zh) | 一种bds/gps高精度定位方法 | |
CN104680008A (zh) | 一种基于多参考站的网络rtk区域大气误差建模方法 | |
CN105699999B (zh) | 一种固定北斗地基增强系统基准站窄巷模糊度的方法 | |
CN103163542B (zh) | 一种gnss基线解算中基于观测常量的粗差探测方法 | |
CN104215977B (zh) | 一种基于卫星导航系统的精度评估方法及系统 | |
CN113848577A (zh) | 一种基于动态分区的大规模gnss网并行解算方法及系统 | |
CN107861131A (zh) | 一种斜路径电离层延迟的获取方法及系统 | |
CN104502943B (zh) | 一种室内伪卫星差分相对定位方法 | |
CN107121689B (zh) | Glonass频间偏差单历元快速估计方法 | |
CN107544075A (zh) | 基于精密单点定位与调和分析估计海潮负荷位移参数方法 | |
CN107193023A (zh) | 一种具有闭式解的高精度北斗卫星系统单点定位方法 | |
CN109444930A (zh) | 一种基于分步加权最小二乘估计的单点定位的方法及装置 | |
CN107402395A (zh) | 一种用于单系统和多系统卫星组合导航的选星方法 | |
CN103698790A (zh) | 北斗与gps双系统宽巷载波相位混频星间差分组合方法 |
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: 20170704 Termination date: 20180115 |