CN106597512A - 一种室内伪卫星快速定位方法 - Google Patents
一种室内伪卫星快速定位方法 Download PDFInfo
- Publication number
- CN106597512A CN106597512A CN201611231655.5A CN201611231655A CN106597512A CN 106597512 A CN106597512 A CN 106597512A CN 201611231655 A CN201611231655 A CN 201611231655A CN 106597512 A CN106597512 A CN 106597512A
- Authority
- CN
- China
- Prior art keywords
- receiver
- pseudo satellite
- pseudolite
- signal
- positioning
- 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.)
- Pending
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/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
- G01S19/49—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled
-
- 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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明提供一种室内伪卫星快速定位方法,包括以下步骤:S1、获取接收机在跟踪阶段的信噪比,并利用信噪比计算得到接收机的初始位置坐标;S2、根据初始位置坐标,通过惯性导航进行定位;S3、判断接收机是否输出伪距;S4、如果是,利用伪距进行定位,获取定位结果;S5、如果否,重复步骤S2。本发明通过惯性导航将伪卫星基于信噪比的定位方式和基于伪距的定位方式相结合,使定位***既能够快速定位,又能够在之后进行精确定位;同时,在室内环境复杂、伪卫星信号易受遮挡时,该方法仍能发挥作用,达到持续定位的效果。
Description
技术领域
本发明属于伪卫星定位技术领域,具体涉及一种室内伪卫星快速定位方法。
背景技术
目前,室内定位技术广泛,但其中的室内伪卫星定位尚处于起步阶段,做的最为成熟的是locata***。
对于伪卫星定位方案而言,其基本定位原理与卫星导航定位***基本相同,都需要经过捕获、跟踪、位同步、帧同步、电文解析等诸多过程才能完成定位。在没有有效的卫星星历和历书的帮助下,完成这一过程需要约60秒的时间;即使接收机中保存有历书信息,定位时间也将在40秒左右。对于广阔的室外而言,40秒尚能忍受,但到了室内,40秒有可能走完一半的定位区域了。因此,减少首次定位时间十分必要。
发明内容
本发明的目的在于提供一种室内伪卫星快速定位方法,该方法解决了现有室内伪卫星定位***首次定位时间长的问题。
为达到上述要求,本发明的主要思路是将惯性定位和伪距定位相结合,在用户刚进入室内时,利用信噪比获取初始位置坐标,之后通过惯性导航进行后续定位,等到接收机能够输出伪距之后,在利用伪距进行定位。同时,在伪卫星信号受到遮挡,信号功率降低或不可用时,也可利用惯性导航进行持续导航,直到用户走过遮蔽区。
基于上述思路,本发明提供一种室内伪卫星快速定位方法,包括以下步骤:
S1、获取接收机在跟踪阶段的信噪比,并利用信噪比计算得到接收机的初始位置坐标;
S2、根据初始位置坐标,通过惯性导航进行定位;
S3、判断接收机是否输出伪距;
S4、如果是,利用伪距进行定位,获取定位结果;
S5、如果否,重复步骤S2至S3。
与现有技术相比,本发明具有的优点是:通过惯性导航将伪卫星基于信噪比的定位方式和基于伪距的定位方式相结合,在伪距输出之前先使用惯性导航,在伪距输出后使用伪距定位,使定位***既能够快速定位,又能够在之后进行精确定位;同时,在室内环境复杂、伪卫星信号易受遮挡时,该方法仍能发挥作用,达到持续定位的效果;现有技术是直接根据初始位置坐标进行伪距定位,但是伪距的输出需要一段时间,这段时间有可能人也在行走,会导致定位不精确,因此在伪距输出之前先进行惯性导航,伪距输出后就切换成伪距定位,这样相结合的方式更精确。
附图说明
此处所说明的附图用来提供对本申请的进一步理解,构成本申请的一部分,在这些附图中使用相同的参考标号来表示相同或相似的部分,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:
图1为本发明的流程示意图。
图2为本发明三角定位的示意图。
具体实施方式
为使本申请的目的、技术方案和优点更加清楚,以下结合附图及具体实施例,对本申请作进一步地详细说明。为简单起见,以下描述中省略了本领域技术人员公知的某些技术特征。
根据本申请的一个实施方式,提供一种室内伪卫星快速定位方法,如图1所示,包括以下步骤:
S1、获取接收机在跟踪阶段的信噪比(SNR),并利用信噪比计算得到接收机的初始位置坐标;
S2、根据初始位置坐标,通过惯性导航进行定位;
S3、判断接收机是否输出伪距;
S4、如果是,利用伪距进行定位,获取定位结果;
S5、如果否,重复步骤S2至S3。
根据本申请的一个实施方式,步骤S1包括:
S11、获取接收机在跟踪阶段的信噪比,并将信噪比转换为信号强度;
信号强度的计算公式为:
PR=SNR*N0*Bn
其中,PR表示信号强度,N0表示噪声频谱功率密度,Bn为噪声带宽。
S12、将信号强度转换为接收机到发射天线的距离;
接收机到发射天线距离的计算公式为:
其中,d表示接收机到发射天线的距离;A和n分别表示接收机距离天线1m处的信号强度与路径损耗指数,在定位前测得;PR表示信号强度。
S13、选择信号强度最大的三颗伪卫星,根据接收机分别到三颗伪卫星发射天线的距离以及三颗伪卫星发射天线的位置坐标,使用三角定位算法得到接收机初始位置坐标。
如图2所示,假设图中三个圆的圆心A、B、C是对应的三个伪卫星天线的位置,其对应的坐标分别为(x1,y1)、(x2,y2)、(x3,y3),三个圆的交点D即为待定位的接收机位置,坐标为(x,y)。接收机分别到三颗伪卫星发射天线的距离为d1、d2、d3。
根据几何关系可知:
将上式最后式减去前两式,可得:
由上式得到终端的位置坐标:
根据本申请的一个实施方式,步骤S2包括:
S21、利用陀螺仪获取用户方向;
S22、通过加速度计判断用户是否行走;
S23、如果是,根据用户方向和用户前一时刻的位置更新用户位置;
更新用户位置的公式为:
xt+1=xt+l*sinθt
yt+1=yt+l*cosθt
其中,(xt+1,yt+1)表示更新后的位置,(xt,yt)表示用户前一时刻的位置,l表示用户步长,θt表示通过陀螺仪获取的用户方向。
在第一次更新时,用户前一时刻的位置即为接收机的初始位置坐标。
S24、如果否,重复步骤S21至S22。
惯性导航***属于推算导航方式,即从一已知点的位置根据连续测得的运动体航向角和速度推算出其下一点的位置,因而可连续测出运动体的当前位置。惯性导航***中的陀螺仪用来形成一个导航坐标系,使加速度计的测量轴稳定在该坐标系中,并给出航向和姿态角;加速度计用来测量运动体的加速度,经过对时间的一次积分得到速度,速度再经过对时间的一次积分即可得到位移。
本发明通过惯性导航将伪卫星基于信噪比的定位方式和基于伪距的定位方式相结合,使定位***既能够快速定位,又能够在之后进行精确定位;同时,在室内环境复杂、伪卫星信号易受遮挡时,该方法仍能发挥作用,达到持续定位的效果。
以上所述实施例仅表示本发明的几种实施方式,其描述较为具体和详细,但并不能理解为对本发明范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明保护范围。因此本发明的保护范围应该以所述权利要求为准。
Claims (8)
1.一种室内伪卫星快速定位方法,其特征在于,包括以下步骤:
S1、获取接收机在跟踪阶段的信噪比,并采用信噪比计算接收机的初始位置坐标;
S2、根据初始位置坐标,通过惯性导航进行定位;
S3、判断接收机是否输出伪距;
S4、如果是,利用伪距进行定位,获取定位结果;
S5、如果否,重复步骤S2至S3。
2.根据权利要求1所述的室内伪卫星快速定位方法,其特征在于,所述步骤S1包括:
S11、获取接收机在跟踪阶段的信噪比,并将信噪比转换为信号强度;
S12、将所述信号强度转换为接收机到发射天线的距离;
S13、选择信号强度最大的三颗伪卫星,根据接收机到三颗伪卫星发射天线的距离以及三颗伪卫星发射天线的位置坐标,使用三角定位算法得到接收机初始位置坐标。
3.根据权利要求2所述的室内伪卫星快速定位方法,其特征在于,所述步骤S11中信号强度的计算公式为:
PR=SNR*N0*Bn
其中,PR表示信号强度,N0表示噪声频谱功率密度,Bn为噪声带宽。
4.根据权利要求2所述的室内伪卫星快速定位方法,其特征在于,所述步骤S12中接收机到发射天线距离的计算公式为:
其中,d表示接收机到发射天线的距离;A和n分别表示接收机距离天线1m处的信号强度与路径损耗指数,在定位前测得;PR表示信号强度。
5.根据权利要求2所述的室内伪卫星快速定位方法,其特征在于,所述步骤S13中接收机初始位置坐标的计算公式为:
其中,(x,y)表示接收机初始位置坐标,(x1,y1)、(x2,y2)、(x3,y3)分别为三颗伪卫星发射天线的位置坐标,d1、d2、d3分别为接收机到三颗伪卫星发射天线的距离。
6.根据权利要求1所述的室内伪卫星快速定位方法,其特征在于,所述步骤S2包括:
S21、利用陀螺仪获取用户方向;
S22、通过加速度计判断用户是否行走;
S23、如果是,根据用户方向和用户前一时刻的位置更新用户位置;
S24、如果否,重复步骤S21至S22。
7.根据权利要求6所述的室内伪卫星快速定位方法,其特征在于,所述S23中在第一次更新时,前一时刻的位置即为初始位置坐标。
8.根据权利要求6所述的室内伪卫星快速定位方法,其特征在于,所述步骤S23中更新用户位置的公式为:
xt+1=xt+l*sinθt
yt+1=yt+l*cosθt
其中,(xt+1,yt+1)表示更新后的位置,(xt,yt)表示用户前一时刻的位置,l表示用户步长,θt表示通过陀螺仪获取的用户方向。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611231655.5A CN106597512A (zh) | 2016-12-28 | 2016-12-28 | 一种室内伪卫星快速定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611231655.5A CN106597512A (zh) | 2016-12-28 | 2016-12-28 | 一种室内伪卫星快速定位方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106597512A true CN106597512A (zh) | 2017-04-26 |
Family
ID=58604526
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611231655.5A Pending CN106597512A (zh) | 2016-12-28 | 2016-12-28 | 一种室内伪卫星快速定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106597512A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109000661A (zh) * | 2018-07-05 | 2018-12-14 | 格星微电子科技成都有限公司 | 一种基于伪卫星载躁比指纹的室内导航方法 |
CN110456307A (zh) * | 2019-07-31 | 2019-11-15 | 东南大学 | 一种基于室内伪卫星信号载噪比的终端定位方法 |
CN113820730A (zh) * | 2021-08-30 | 2021-12-21 | 厦门大学 | 一种室内定位*** |
CN116540284A (zh) * | 2023-07-06 | 2023-08-04 | 河北新合芯电子科技有限公司 | 室内导航定位方法、装置、***及存储介质 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101464157A (zh) * | 2009-01-23 | 2009-06-24 | 北京北斗星通导航技术股份有限公司 | 一种组合定位仪 |
CN102419180A (zh) * | 2011-09-02 | 2012-04-18 | 无锡智感星际科技有限公司 | 一种基于惯性导航***和wifi的室内定位方法 |
-
2016
- 2016-12-28 CN CN201611231655.5A patent/CN106597512A/zh active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101464157A (zh) * | 2009-01-23 | 2009-06-24 | 北京北斗星通导航技术股份有限公司 | 一种组合定位仪 |
CN102419180A (zh) * | 2011-09-02 | 2012-04-18 | 无锡智感星际科技有限公司 | 一种基于惯性导航***和wifi的室内定位方法 |
Non-Patent Citations (3)
Title |
---|
刘莎莉: "基于指纹-惯导融合的WiFi室内定位研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
王亚宾: "伪卫星室内独立定位演示验证***研究和设计", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
陈群: "ZigBee技术在室内定位中的应用研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109000661A (zh) * | 2018-07-05 | 2018-12-14 | 格星微电子科技成都有限公司 | 一种基于伪卫星载躁比指纹的室内导航方法 |
CN109000661B (zh) * | 2018-07-05 | 2021-10-22 | 格星微电子科技成都有限公司 | 一种基于伪卫星载噪比指纹的室内导航方法 |
CN110456307A (zh) * | 2019-07-31 | 2019-11-15 | 东南大学 | 一种基于室内伪卫星信号载噪比的终端定位方法 |
CN110456307B (zh) * | 2019-07-31 | 2022-04-22 | 东南大学 | 一种基于室内伪卫星信号载噪比的终端定位方法 |
CN113820730A (zh) * | 2021-08-30 | 2021-12-21 | 厦门大学 | 一种室内定位*** |
CN113820730B (zh) * | 2021-08-30 | 2024-06-04 | 厦门大学 | 一种室内定位*** |
CN116540284A (zh) * | 2023-07-06 | 2023-08-04 | 河北新合芯电子科技有限公司 | 室内导航定位方法、装置、***及存储介质 |
CN116540284B (zh) * | 2023-07-06 | 2023-10-20 | 河北新合芯电子科技有限公司 | 室内导航定位方法、装置、***及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108871336A (zh) | 一种车辆位置估算***及方法 | |
CN109099912A (zh) | 室外精确定位导航方法、装置、电子设备及存储介质 | |
CN105607104A (zh) | 一种基于gnss与ins的自适应导航定位***及方法 | |
CN106597512A (zh) | 一种室内伪卫星快速定位方法 | |
CN102253399B (zh) | 一种利用载波相位中心值的多普勒差分补偿测速方法 | |
CN111751852A (zh) | 基于点云配准的无人车gnss定位可靠性评价方法 | |
CN102243315A (zh) | 具有辅助定位功能的移动终端及方法 | |
KR20140089516A (ko) | 루트 평탄화 | |
US20220082387A1 (en) | Dead reckoning by determining misalignment angle between movement direction and sensor heading direction | |
US20110153266A1 (en) | Augmented vehicle location system | |
CN108496096A (zh) | 可视化惯性里程计参考系与卫星定位***参考系的对准 | |
CN103674064B (zh) | 捷联惯性导航***的初始标定方法 | |
CN109855620A (zh) | 一种基于自回溯算法的室内行人导航方法 | |
JP2009074930A (ja) | 測位装置、測位システム、コンピュータプログラム及び測位方法 | |
CN109725284B (zh) | 用于确定物体的运动方向的方法和*** | |
CN106093992A (zh) | 一种基于cors的亚米级组合定位导航***及导航方法 | |
CN110057356A (zh) | 一种隧道内车辆定位方法及装置 | |
JP2009025049A (ja) | 搬送波位相式移動体測位装置 | |
CN101266153B (zh) | 测绘工程类陀螺全站仪精度评定方法 | |
CN113325455B (zh) | 用于跟踪和确定物体的室内位置的方法和*** | |
CN108426577B (zh) | 基于可穿戴设备的辅助骑行增强定位的方法和装置 | |
Chiang et al. | Multifusion schemes of INS/GNSS/GCPs/V-SLAM applied using data from smartphone sensors for land vehicular navigation applications | |
KR20170015768A (ko) | Gnss 음영 지역에서의 위치 보정 시스템 및 방법 | |
JP2016206017A (ja) | 電子機器、及び移動速度算出プログラム | |
Hsu et al. | Sensor integration of 3D map aided GNSS and smartphone PDR in urban canyon with dense foliage |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170426 |
|
RJ01 | Rejection of invention patent application after publication |