CN107144866B - 一种基于数字罗盘协同卫星定位的方法及*** - Google Patents

一种基于数字罗盘协同卫星定位的方法及*** Download PDF

Info

Publication number
CN107144866B
CN107144866B CN201710221324.1A CN201710221324A CN107144866B CN 107144866 B CN107144866 B CN 107144866B CN 201710221324 A CN201710221324 A CN 201710221324A CN 107144866 B CN107144866 B CN 107144866B
Authority
CN
China
Prior art keywords
information
navigator
geodetic
plane
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.)
Active
Application number
CN201710221324.1A
Other languages
English (en)
Other versions
CN107144866A (zh
Inventor
夏敬廷
李倩霞
花城
易家莉
李彩霞
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shenzhen Zhongming hi tech Information Industry Co.,Ltd.
Original Assignee
Shenzhen Zhongming Hi Tech Information Industry Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shenzhen Zhongming Hi Tech Information Industry Co ltd filed Critical Shenzhen Zhongming Hi Tech Information Industry Co ltd
Priority to CN201710221324.1A priority Critical patent/CN107144866B/zh
Publication of CN107144866A publication Critical patent/CN107144866A/zh
Application granted granted Critical
Publication of CN107144866B publication Critical patent/CN107144866B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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/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

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

本发明公开了一种基于数字罗盘协同卫星定位的方法及***，其方法包括：导航仪利用卫星广播的星历获取四颗卫星的卫星瞬时地心坐标，利用卫星的伪距观测量建立四颗卫星中每一颗卫星所对应的伪距观测方程；基于数字罗盘获取基于大地坐标下的平面方位信息，并基于平面方位信息建立平面信息约束方程；基于伪距观测方程和平面信息约束方程形成导航仪当前的大地坐标求解模型，并可通过地心坐标和大地坐标间的转换关系获取导航仪的地心坐标。在本发明实施例中，利用数字罗盘结合卫星信号实现定位，使定位更为准确，同时成本低，方便民用，大大增加了本方法可行性，同时实现了在卫星信号差或者仅有4个卫星时的协同定位功能。

Description

一种基于数字罗盘协同卫星定位的方法及***
技术领域
本发明涉及卫星导航技术领域，具体涉及一种基于数字罗盘协同卫星定位的方法及***。
背景技术
现有的卫星定位***，通过导航仪接收卫星信号，首先利用卫星广播的星历，计算出各个卫星的准确位置坐标，接着利用卫星的伪距观测量ρ建立伪距观测方程(1)，因为接收机存在钟差，需要把接收机钟差作为未知数与导航仪上的接收机位置坐标(X，Y，Z)一起求解。
Figure GDA0002758133470000011
其中，其中，(Xi、Yi、Zi)为由卫星星历求得的卫星瞬时地心坐标，(X、Y、Z)为待求接收机的地心坐标，c为光速，tr、
Figure GDA0002758133470000012
分别为接收机时钟与卫星时钟的误差，Vion为电离层延迟改正数，Vtrop为对流层延迟改正数。这里i取值一般在5以上，该伪距观测方程至少满足5个卫星的位置坐标，才可以实现。
通过建立5个以上的伪距观测方式形成求解模型之后，基于卡尔曼滤波求解，即可得出导航定位的位置速度和时间(Position Velocity and Time，PVT)解，通过残差及中误差等进行卫星定位质量分析，当质量分析不合格时，重新基于该求解模型再次求解，直到质量分析合格之后输出定位结果。
现阶段有些区域会存在一些城市峡谷区域，会导致导航***或者导航仪接收到的卫星会少于5个，导致导航的失灵，无法快速求解或者延迟。数字罗盘可以较准确地为用户提供平面方向信息。但是数字罗盘只是单纯地作为一种高度、方向的参考，并没有与卫星导航模型结合起来。
发明内容
为了解决现有技术的缺点，针对接收机面对5颗以下的卫星定位时，本发明提供一种基于数字罗盘协同卫星定位的方法及***，利用数字罗盘与四颗卫星的结合，可以实现卫星定位有效的补充。
为了实现本发明的目的，本发明提供一种基于数字罗盘协同卫星定位的方法，包括如下步骤：
导航仪利用卫星广播的星历获取四颗卫星的卫星瞬时地心坐标；
基于地心坐标与大地坐标间的转换关系，以导航仪的大地坐标为求解目标，利用卫星的伪距观测量建立四颗卫星中每一颗卫星所对应的伪距观测方程；
基于数字罗盘获取基于大地坐标下的平面方位信息，并基于平面方位信息建立平面信息约束方程；
基于伪距观测方程和平面信息约束方程形成导航仪当前的大地坐标求解模型，获取导航仪的大地坐标，通过地心坐标和大地坐标间的转换关系获得导航仪的地心坐标。
所述方法还包括：
判断导航仪搜索卫星的数量，当判断导航仪搜索的卫星数量为四颗时，启动数字罗盘获取基于大地坐标下的平面方位信息。
所述基于数字罗盘获取基于大地坐标下的平面方位信息还包括：
对所述平面方位信息进行质量分析，判断所述质量分析是否达标，若所述质量分析不达标，则继续获取平面方位信息或者停止基于所述平面方位信息建立平面信息约束方程；在判断所述质量分析达标以后，基于所述平面方位信息建立平面信息约束方程。
所述方法还包括：
判断导航仪搜索卫星的数量，当判断导航仪搜索的卫星数量为四颗时，启动MEMS压力传感器获取基于大地坐标下的高度信息。
所述方法还包括：
将高度信息和平面方位信息进行质量比对，若平面方位信息优于高度信息，则基于平面方位信息建立平面信息约束方程；若高度信息优于平面方位信息，则基于高度信息建立高程信息约束方程，基于伪距观测方程和高程信息约束方程形成导航仪当前的大地坐标求解模型，获取导航仪的大地坐标，并通过地心坐标和大地坐标间的转换关系获得导航仪的地心坐标；
或者在平面方位进行质量分析不达标之后，基于高度信息建立高程信息约束方程，基于伪距观测方程和高程信息约束方程形成导航仪当前的大地坐标求解模型，获取导航仪的大地坐标，并通过地心坐标和大地坐标间的转换关系获得导航仪的地心坐标。
所述获取导航仪的大地坐标，通过地心坐标和大地坐标间的转换关系获得导航仪的地心坐标包括：
基于所述大地坐标求解模型通过卡尔曼滤波得出导航定位在大地坐标系下的PVT解，并通过地心坐标和大地坐标间的转换关系获得导航仪的地心坐标；
通过残差及中误差进行定位质量分析，在定位质量分析合格之后输出定位结果。
相应的，本发明还提供了一种基于数字罗盘协同卫星定位的***，包括：
星历模块，用于获取四颗卫星的卫星瞬时地心坐标；
伪距观测模块，用于基于地心坐标和大地坐标间的转换关系，以导航仪大地坐标为求解目标，利用卫星的伪距观测量建立四颗卫星中每一颗卫星所对应的伪距观测方程；
数字罗盘模块，用于基于数字罗盘获取基于大地坐标下的平面方位信息；
平面信息约束模块，用于基于平面方位信息建立平面信息约束方程；
定位求解模块，用于基于伪距观测方程和平面信息约束方程形成导航仪当前的大地坐标求解模型，获取导航仪的大地坐标，并通过地心坐标和大地坐标间的转换关系获得导航仪的地心坐标。
所述***还包括：
卫星数量判断模块，用于判断导航仪搜索卫星的数量；
触发模块，用于在卫星数量判断模块判断导航仪搜索的卫星数量为四颗时，触发数字罗盘获取基于大地坐标下的平面方位信息。
所述***还包括：
平面信息质量分析模块，用于对所述平面方位信息进行质量分析，判断所述质量分析是否达标，若所述质量分析不达标，则继续获取平面方位信息或者停止基于所述平面方位信息建立平面信息约束方程；在判断所述质量分析达标以后，基于所述平面方位信息建立平面信息约束方程。
所述定位求解模块包括：
卡尔曼滤波单元，用于基于所述大地坐标求解模型通过卡尔曼滤波求解；
PVT解单元，基于卡尔曼滤波求解得出导航定位在大地坐标系下的PVT解，并通过地心坐标和大地坐标间的转换关系获得导航仪地心坐标系下的PVT解；
定位质量分析，用于通过残差及中误差进行定位质量分析；
定位输出单元，用于在定位质量分析合格之后输出定位结果。
采用上面的方案后，本发明的有益效果包括：
数字罗盘作为新一代惯性导航进展方式，相比于传统的惯性导航器件来说成本低，能耗小，微型化，本方法利用数字罗盘结合卫星信号实现定位，使定位更为准确，同时成本低，方便民用，大大增加了本方法可行性，同时实现了在卫星信号差或者仅有4个卫星时的协同定位功能。
传统上卫星定位与高度都是分开求解的，国内很少把MEMS压力传感器与卫星定位耦合起来求解，国外同样是很少把二者结合起来进行卫星定位求解。本发明把MEMS压力传感器、数字罗盘与卫星导航模型结合起来形成一种紧凑的技术方案，可以解决城市峡谷、树林等遮挡比较严重区域的定位求解难题。
本方法确立MEMS、数字罗盘、GNSS的集成定位模式，是技术上的一个独特思考，根据不同的定位条件，构建出基于MEMS压力传感器的集成GNSS卫星定位体系，当卫星信号不正常只能接收到4颗卫星的情况下，提供协同工作模式进行卫星定位求解，当卫星信号正常时正常求解，灵活性强，能够适应不同类型的定位区域。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其它的附图。
图1是本发明实施例中的基于数字罗盘协同卫星定位的方法流程图；
图2是本发明实施例中的基于数字罗盘协同卫星定位的方法第二流程图；
图3是本发明实施例中的基于数字罗盘协同卫星定位的***结构示意图；
图4是本发明实施例中的定位求解模块结构示意图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例，都属于本发明保护的范围。
本发明所涉及的基于数字罗盘协同卫星定位的方法主要通过如下实现：导航仪利用卫星广播的星历获取四颗卫星的卫星瞬时地心坐标；基于地心坐标与大地坐标间的转换关系，以导航仪的大地坐标为求解目标，利用卫星的伪距观测量建立四颗卫星中每一颗卫星所对应的伪距观测方程；基于数字罗盘获取基于大地坐标下的平面方位信息，并基于平面方位信息建立平面信息约束方程；基于伪距观测方程和平面信息约束方程形成导航仪当前的大地坐标求解模型，获取导航仪的大地坐标，通过地心坐标和大地坐标间的转换关系获得导航仪的地心坐标。
具体的，图1示出了本发明实施例中的基于数字罗盘协同卫星定位的方流程图，包括如下步骤：
S101、导航仪接收卫星信号；
在完整实施情况下，导航仪可携带有MEMS压力传感器来协同定位，该协同定位一般是在导航仪搜到的卫星数量为4时才开始启动。
S102、基于卫星信号判断卫星数量；
S103、是否大于4，若大于4则进入到S107，若等于4则进入到S104和S104；
需要说明的是，本发明实施例中可以实现四颗卫星与MEMS压力传感器间的协同定位功能，只需要满足四颗卫星数量就可以实现，若搜索过程中，存在4颗以上的卫星，也可以只需要取4个卫星数量的信号来基于MEMS压力传感器实现协同定位。这里为了实现原有情况下，一般在搜索到大于4颗卫星的情况下，还是参照原有的卫星定位来实现，即通过建立多个卫星相对应的伪距观测方程来实现最终卫星导航定位结果的输出。
需要说明的是，步骤S104和步骤S105可以是同时进行，也可以具有先后步骤，也可以是在四颗卫星条件下触发启动。
S104、基于4颗卫星数量建立伪距观测方程；
当导航仪搜索到4颗卫星数的时候，首先利用卫星广播的星历，计算出第i颗卫星的准确位置坐标(Xi，Yi，Zi)(i≤4)；接着利用卫星的伪距观测量ρ建立观测方程如下式(2)。因为接收机存在钟差，因而把接收机钟差作为未知参数与接收机位置坐标(X，Y，Z)一起求解。
Figure GDA0002758133470000061
其中，i≤4，(Xi、Yi、Zi)为由卫星星历求得的卫星瞬时地心坐标，(X、Y、Z)为待求接收机的地心坐标，c为光速，tr、
Figure GDA0002758133470000062
分别为接收机时钟与卫星时钟的误差，Vion为电离层延迟改正数，Vtrop为对流层延迟改正数。
根据地心坐标和大地坐标的线性转换关系来建立，假定ρ已经经过对流层、电离层和卫星时钟改正，利用接收机近似坐标(X0，Y0，Z0)转换为大地坐标(B0，L0，H0)，四颗卫星的观测方程经线性化后，可以得到以下矩阵方程：
Figure GDA0002758133470000071
其中，A为伪距观测方程系数矩阵，K1为常数矩阵，通过观测方程的线性化可得；δB、δL、δH是接收机近似大地坐标(B0，L0，H0)的改正数，得到接收机位置坐标(B，L，H)＝(B0+δB，L0+δL，H0+δH)；tr为接收机钟差。
S105、基于数字罗盘获取平面方位信息；
运用数字罗盘提取平面方位信息，即大地方位角α。
具体实施过程中，还涉及到对平面方位信息进行质量分析，判断该平面方位信息是否达标，若质量分析不达标，则继续获取平面方位信息或者停止基于平面方位信息建立平面信息约束方程；只有在判断质量分析达标以后，才基于该平面方位信息建立平面信息约束方程，进入S106。
S106、基于平面方位信息建立平面信息约束方程；
应用大地方位角α与待求解坐标的大地经纬度B和L间的关系建立平面信息约束方程(4)如下：
Figure GDA0002758133470000072
其中：D为平面信息约束条件方程对应的系数矩阵，K3为常数矩阵，其他变量关系与(3)中相同。
需要说明的是，基于伪距观测方程(3)和高程信息约束方程(4)形成导航仪当前的大地坐标求解模型(5)，从而可以实现导航仪的大地坐标求解，即后续可以通过卡尔曼滤波即可得出导航定位PVT解，即直接进入S108实现。
Figure GDA0002758133470000081
S107、基于卫星数量建立伪距观测方程；
需要说明的是，该卫星数量达到5颗以上时，至少可以建立5个相关的伪距观测方程，因此其可以求解出相应的四个未知数，不需要借助于数字罗盘来实现协同定位功能。
S108、卡尔曼滤波求解；
S109、PVT解算,并通过地心坐标与大地坐标的转换关系，获得导航仪的地心坐标；
S110、导航定位质量分析，若质量分析不合格，则进入到S103，若质量合格则进入到S111；
S111、输出导航结果。
步骤S108至S111中传统卫星定位实现解算的原理过程，在基于数字罗盘实现过程中，首先基于大地坐标求解模型通过卡尔曼滤波得出导航定位在大地坐标系下的PVT解，并通过地心坐标和大地坐标间的转换关系获得导航仪的地心坐标；通过残差及中误差进行定位质量分析，在定位质量分析合格之后输出定位结果。而传统的方式基于多个伪距观测方程来直接求得地心坐标，通过卡尔曼滤波得出导航定位的PVT解；以及通过残差及中误差进行定位质量分析，在定位质量分析合格之后输出定位结果，这里不再赘述。
具体的，图2示出了本发明实施例中的基于数字罗盘协同卫星定位的方法第二流程图，包括如下步骤：
本发明实施例子是在导航仪只需要四颗卫星条件下实现，在获取到四颗卫星数据之后，开始整个过程；
S201、导航仪利用卫星广播的星历获取四颗卫星的卫星瞬时地心坐标；
S202、利用卫星的伪距观测量建立四颗卫星中每一颗卫星所对应的伪距观测方程；
具体实施过程中，结合地心坐标和大地坐标的转换关系，以导航仪的大地坐标为求解目标，利用卫星的伪距观测量建立四颗卫星中每一颗卫星所对应的伪距观测方程，其整个伪距观测方程和观测方程线性化如式(2)和(3)，这里不再赘述。
S203、基于MEMS压力传感器获取基于大地坐标下的高度信息；
S204、数字罗盘获取基于大地坐标下的平面方位信息；
需要说明的是，在四颗卫星条件下，可以启动MEMS来协同定位，也可以启动数字罗盘来协同定位。在导航仪搜索到卫星数量为4颗时，可以先启动一个来协同定位，比如先启动MEMS压力传感器来获取高度信息，可以对高度信息进行质量分析，若质量分析不达标，则启动数字罗盘获取平面方位信息；也可以先启动数字罗盘来获取平面方位信息，对平面方位信息进行质量分析，若质量分析不达标，则启动MEMS压力传感器来获取高度信息。通过这种质量分析，选择其中质量优的数据建立约束方程。
图2中实现过程可以是，在四颗星定位情况下，启动了MEMS压力传感器和数字罗盘来各自获取数据，然后采用高度信息与方位信息进行质量对比，即实现S205判断过程。
S205、判断高程信息是否优于平面信息，若高程信息优于平面信息则进入S206，若平面信息优于高程信息则进入S207；
S206、基于高度信息建立高程信息约束方程；
该步骤S206是在高程信息优于平面信息情况下建立的，GNSS卫星定位的实质是根据接收机与其所观测到的卫星之间的距离和所观测卫星的空间位置来求取接收机的空间位置。因为MEMS压力传感器测出的高度为大约一米的分辨精度，而利用伪距测量的定位方法精度同样为米级或亚米级，如果利用载波相位测量定位方法，则可以达到厘米级的精度，本技术方案阐述MEMS压力传感器与伪距测量协同定位方法的原理。
利用MEMS压力传感器提取高度。MEMS压力传感器在导航仪中，可以根据大气压与海拔高度的关系公式，计算海拔高度，为卫星定位求解提供一个高精度的高度信息。大气压与海拔高度的一般关系公式可以表示为：
P＝P0*(1-Altitude/44330)^5.255 (6)
其中P0是标准大气压，等于1013.25mbar；Altitude是以米为单位的海拔高度。P是在某一高度的以mbar为单位的气压，P可通过导航仪如智能手机中的数字气压计读取相关数据。
在基于MEMS压力传感器获得高度H之后，形成高程信息约束方程(7)：
C*δH+K2＝0(对应的权阵为P2) (7)
需要说明的是，C为高程信息约束方程的系数矩阵，基于伪距观测方程(3)和高程信息约束方程(7)形成导航仪当前的大地坐标求解模型(8)，从而可以实现导航仪的大地坐标求解，即后续可以通过卡尔曼滤波即可得出导航定位PVT解。
Figure GDA0002758133470000101
S207、基于平面方位信息建立平面信息约束方程；
当平面方位信息优于高程信息时，运用数字罗盘提取平面方位信息，即大地方位角α，应用大地方位角α与待求解坐标大地经纬度B、L等参数间的关系建立平面信息约束方程，其实现过程如步骤S106中。
S208、求解卫星接收机的地心坐标。
由此可见，针对四颗星的过程，该方案可以采用MEMS压力传感器来实现协同，也可以采用数字罗盘来实现协同。
在高程信息数据更优的情况下，采用高程信息约束方程所建立的大地坐标求解模型先求解出导航仪的大地坐标；在平面信息数据更优的情况下，采用平面信息约束方程与所建立的大地坐标求解模型先求解出导航仪的大地坐标。
通过卡尔曼滤波即可得出导航定位PVT解，然后通过残差及中误差等进行质量分析，基于此过程中，基于大地坐标求解模型通过卡尔曼滤波得出导航定位在大地坐标系下的PVT解，并通过地心坐标和大地坐标间的转换关系获得导航仪的地心坐标。当质量分析不合格时需要重新运用上述数学模型再次求解，直到质量分析合格之后输出定位结果。所以在只观测到4颗卫星的情况下，运用本方法同样能完成卫星定位求解，解决城市峡谷、树林等遮挡比较严重区域的导航困境。
相应的，图3示出了本发明实施例中的基于数字罗盘协同卫星定位的***结构示意图，该***一般位于卫星导航仪器或者具有导航功能的设备上，该***包括：
星历模块，用于获取四颗卫星的卫星瞬时地心坐标；
伪距观测模块，用于基于地心坐标和大地坐标间的转换关系，以导航仪大地坐标为求解目标，利用卫星的伪距观测量建立四颗卫星中每一颗卫星所对应的伪距观测方程；
数字罗盘模块，用于基于数字罗盘获取基于大地坐标下的平面方位信息；
平面信息约束模块，用于基于平面方位信息建立平面信息约束方程；
定位求解模块，用于基于伪距观测方程和平面信息约束方程形成导航仪当前的大地坐标求解模型，通获取导航仪的大地坐标，通过地心坐标和大地坐标间的转换关系获得导航仪的地心坐标。
相应的，该***还包括：
卫星数量判断模块，用于判断导航仪搜索卫星的数量；
触发模块，用于在卫星数量判断模块判断导航仪搜索的卫星数量为四颗时，触发数字罗盘获取基于大地坐标下的平面方位信息。
相应的，该***还包括：
平面信息质量分析模块，用于对所述高度信息进行质量分析，判断所述质量分析是否达标，若所述质量分析不达标，则继续获取高度信息或者停止高程信息约束模块基于所述高度信息建立高程信息约束方程；在判断所述质量分析达标以后，高程信息约束模块基于所述高度信息建立高程信息约束方程。
相应的，图4示出了定位求解模块结构示意图，该定位求解模块包括：
卡尔曼滤波单元，用于基于所述大地坐标求解模型通过卡尔曼滤波求解；
PVT解单元，基于卡尔曼滤波求解得出导航定位大地坐标系下的PVT解，并通过地心坐标和大地坐标间的转换关系获得导航仪地心坐标系下的PVT解；
定位质量分析单元，用于通过残差及中误差进行定位质量分析；
定位输出单元，用于在定位质量分析合格之后输出定位结果。
以上各模块实现过程内容，其整个内容与图1至图3中的内容方法一致，这里不再赘述。
采用上面的方案后，本发明的有益效果包括：
数字罗盘作为新一代惯性导航进展方式，相比于传统的惯性导航器件来说成本低，能耗小，微型化，本方法利用数字罗盘结合卫星信号实现定位，使定位更为准确，同时成本低，方便民用，大大增加了本方法可行性，同时实现了在卫星信号差或者仅有4个卫星时的协同定位功能。
传统上卫星定位与高度都是分开求解的，国内很少把MEMS压力传感器与卫星定位耦合起来求解，国外同样是很少把二者结合起来进行卫星定位求解。本发明把MEMS压力传感器、数字罗盘与卫星导航模型结合起来形成一种紧凑的技术方案，可以解决城市峡谷、树林等遮挡比较严重区域的定位求解难题。
本方法确立MEMS、数字罗盘、GNSS的集成定位模式，是技术上的一个独特思考，根据不同的定位条件，构建出基于MEMS压力传感器的集成GNSS卫星定位体系，当卫星信号不正常只能接收到4颗卫星的情况下，提供协同工作模式进行卫星定位求解，当卫星信号正常时正常求解，灵活性强，能够适应不同类型的定位区域。
本领域普通技术人员可以理解上述实施例的各种方法中的全部或部分步骤是可以通过程序来指令相关的硬件来完成，该程序可以存储于一计算机可读存储介质中，存储介质可以包括：只读存储器(ROM，Read Only Memory)、随机存取存储器(RAM，RandomAccess Memory)、FLASH、磁盘或光盘等。
以上对本发明实施例所提供的基于数字罗盘协同卫星定位的方法及***进行了详细介绍，本文中应用了具体个例对本发明的原理及实施方式进行了阐述，以上实施例的说明只是用于帮助理解本发明的方法及其核心思想；同时，对于本领域的一般技术人员，依据本发明的思想，在具体实施方式及应用范围上均会有改变之处，综上所述，本说明书内容不应理解为对本发明的限制。

Claims (6)

1.一种基于数字罗盘协同卫星定位的方法，其特征在于，包括如下步骤：
判断导航仪搜索卫星的数量，当判断导航仪搜索的卫星数量为四颗时，启动MEMS压力传感器获取基于大地坐标下的高度信息；
导航仪利用卫星广播的星历获取四颗卫星的卫星瞬时地心坐标；
基于地心坐标与大地坐标间的转换关系，以导航仪的大地坐标为求解目标，利用卫星的伪距观测量建立四颗卫星中每一颗卫星所对应的伪距观测方程；
基于数字罗盘获取基于大地坐标下的平面方位信息，将高度信息和平面方位信息进行质量比对，若平面方位信息优于高度信息，基于平面方位信息建立平面信息约束方程；
当平面方位信息优于高度信息时，基于伪距观测方程和平面信息约束方程形成导航仪当前的大地坐标求解模型，获取导航仪的大地坐标，通过地心坐标和大地坐标间的转换关系获得导航仪的地心坐标；
所述获取导航仪的大地坐标，通过地心坐标和大地坐标间的转换关系获得导航仪的地心坐标包括：基于所述大地坐标求解模型通过卡尔曼滤波得出导航定位在大地坐标系下的PVT解，并通过地心坐标和大地坐标间的转换关系获得导航仪的地心坐标；通过残差及中误差进行定位质量分析，在定位质量分析合格之后输出定位结果。
2.如权利要求1所述的基于数字罗盘协同卫星定位的方法，其特征在于，所述方法还包括：
判断导航仪搜索卫星的数量，当判断导航仪搜索的卫星数量为四颗时，启动数字罗盘获取基于大地坐标下的平面方位信息。
3.如权利要求1所述的基于数字罗盘协同卫星定位的方法，其特征在于，所述基于数字罗盘获取基于大地坐标下的平面方位信息还包括：
对所述平面方位信息进行质量分析，判断所述质量分析是否达标，若所述质量分析不达标，则继续获取平面方位信息或者停止基于所述平面方位信息建立平面信息约束方程；在判断所述质量分析达标以后，基于所述平面方位信息建立平面信息约束方程。
4.如权利要求1至3任一项所述的基于数字罗盘协同卫星定位的方法，其特征在于，所述方法还包括：
若高度信息优于平面方位信息，则基于高度信息建立高程信息约束方程，基于伪距观测方程和高程信息约束方程形成导航仪当前的大地坐标求解模型，获取导航仪的大地坐标，并通过地心坐标和大地坐标间的转换关系获得导航仪的地心坐标；
或者在平面方位信息进行质量分析不达标之后，基于高度信息建立高程信息约束方程，基于伪距观测方程和高程信息约束方程形成导航仪当前的大地坐标求解模型，获取导航仪的大地坐标，并通过地心坐标和大地坐标间的转换关系获得导航仪的地心坐标。
5.一种基于数字罗盘协同卫星定位的***，其特征在于，包括：
星历模块，用于获取四颗卫星的卫星瞬时地心坐标；
伪距观测模块，用于基于地心坐标和大地坐标间的转换关系，以导航仪大地坐标为求解目标，利用卫星的伪距观测量建立四颗卫星中每一颗卫星所对应的伪距观测方程；
数字罗盘模块，用于基于数字罗盘获取基于大地坐标下的平面方位信息；
平面信息约束模块，用于将高度信息和平面方位信息进行质量比对，若平面方位信息优于高度信息，基于平面方位信息建立平面信息约束方程；
定位求解模块，用于当平面方位信息优于高度信息时基于伪距观测方程和平面信息约束方程形成导航仪当前的大地坐标求解模型，获取导航仪的大地坐标，并通过地心坐标和大地坐标间的转换关系获得导航仪的地心坐标；
卫星数量判断模块，用于判断导航仪搜索卫星的数量；
触发模块，用于在卫星数量判断模块判断导航仪搜索的卫星数量为四颗时，触发数字罗盘获取基于大地坐标下的平面方位信息；
所述定位求解模块包括：
卡尔曼滤波单元，用于基于所述大地坐标求解模型通过卡尔曼滤波求解；
PVT解单元，基于卡尔曼滤波求解得出导航定位在大地坐标系下的PVT解，并通过地心坐标和大地坐标间的转换关系获得导航仪地心坐标系下的PVT解；
定位质量分析，用于通过残差及中误差进行定位质量分析；
定位输出单元，用于在定位质量分析合格之后输出定位结果。
6.如权利要求5所述的基于数字罗盘协同卫星定位的***，其特征在于，所述***还包括：
平面信息质量分析模块，用于对所述平面方位信息进行质量分析，判断所述质量分析是否达标，若所述质量分析不达标，则继续获取平面方位信息或者停止基于所述平面方位信息建立平面信息约束方程；在判断所述质量分析达标以后，基于所述平面方位信息建立平面信息约束方程。
CN201710221324.1A 2017-04-06 2017-04-06 一种基于数字罗盘协同卫星定位的方法及*** Active CN107144866B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710221324.1A CN107144866B (zh) 2017-04-06 2017-04-06 一种基于数字罗盘协同卫星定位的方法及***

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710221324.1A CN107144866B (zh) 2017-04-06 2017-04-06 一种基于数字罗盘协同卫星定位的方法及***

Publications (2)

Publication Number Publication Date
CN107144866A CN107144866A (zh) 2017-09-08
CN107144866B true CN107144866B (zh) 2021-03-02

Family

ID=59774719

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710221324.1A Active CN107144866B (zh) 2017-04-06 2017-04-06 一种基于数字罗盘协同卫星定位的方法及***

Country Status (1)

Country Link
CN (1) CN107144866B (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108680939B (zh) * 2018-05-16 2022-01-07 北京邮电大学 一种辅助卫星定位方法、装置及电子设备
CN111158034A (zh) * 2020-01-15 2020-05-15 东方红卫星移动通信有限公司 一种基于低轨卫星多重覆盖场景下的快速定位方法

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6898526B2 (en) * 2001-06-20 2005-05-24 International Business Machines Corporation Method and apparatus for enhanced safety in hunting environments
CN100531006C (zh) * 2006-06-19 2009-08-19 南京中网通信有限公司 车载卫星通信天线自动寻星装置
CN102998685A (zh) * 2011-09-15 2013-03-27 北京自动化控制设备研究所 一种惯性/卫星导航***伪距/伪距率紧组合方法
CN103472459A (zh) * 2013-08-29 2013-12-25 镇江青思网络科技有限公司 一种基于gps伪距差分的车辆协作定位方法
CN103744096B (zh) * 2013-12-23 2016-05-18 北京邮电大学 一种多信息融合的定位方法和装置
CN103941270B (zh) * 2014-02-28 2016-10-05 北京邮电大学 一种多***融合定位的方法及装置
CN105628024B (zh) * 2015-12-29 2018-09-04 中国电子科技集团公司第二十六研究所 基于多传感器融合的单人定位导航器和定位导航方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
GNSS与惯性及多传感器组合导航***原理;格鲁夫;《GNSS与惯性及多传感器组合导航***原理》;20150331;正文第86-87页、第609页 *

Also Published As

Publication number Publication date
CN107144866A (zh) 2017-09-08

Similar Documents

Publication Publication Date Title
CN109709591B (zh) 一种面向智能终端的gnss高精度定位方法
CN106842268B (zh) 双gnss接收机载波相位双差整周模糊度浮点解向量估计方法
CN106255065B (zh) 智能手机室内外无缝定位***及其方法
CN106168672B (zh) 一种gnss多模单频rtk周跳探测方法及装置
CN106873009B (zh) 利用非组合ppp辅助的长基线模糊度解算方法
WO2015099194A1 (ja) 衛星測位システム、測位端末、測位方法、及び記録媒体
CN105116423B (zh) Araim地面监测站完好性监测方法和装置
CN105974440B (zh) 一种获取观测噪声的方法和装置
KR102188880B1 (ko) 단말, 기준국 및 위치 측위 방법
CN110988955B (zh) 一种导航定位的方法及装置
CN110988934B (zh) 多模式接收机星基增强技术装置及处理方法
CN108802781A (zh) 整周模糊度的获取方法
CN110907971B (zh) 高空设备的卫星定位方法、装置、计算机设备和存储介质
CN107144866B (zh) 一种基于数字罗盘协同卫星定位的方法及***
CN114779301B (zh) 一种基于广播星历的卫星导航实时精密单点定位方法
CN113176596B (zh) 气压高程约束定位方法
Wu et al. Sensing real-time water vapor over oceans with low-cost GNSS receivers
WO2022039879A1 (en) Multi-frequency real-time kinematic (rtk) measurements for global navigation satellite system (gnss) receivers
TW202208881A (zh) 超長基線即時動態
CN107167829A (zh) 一种基于mems压力传感器协同卫星定位的方法及***
CN117055323A (zh) 基于北斗/伽利略***融合的星基精密授时方法及***
CN103389502B (zh) 基于多个地面基站高精度确定载体加速度的方法
CN115902968A (zh) 基于北斗三号geo播发增强信息的ppp终端定位方法
CN105699997B (zh) 一种使用glonass单频信号进行差分定位的方法
CN114994724A (zh) 一种gnss伪距差分定位性能评估方法及***

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
TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20191224

Address after: 510000 Room 308, building 7, Liyin building, Lijiang Garden, Luopu street, Panyu District, Guangzhou City, Guangdong Province

Applicant after: Jiang Junyi

Address before: Panyu District city in Guangdong province Guangzhou Shilou town 511400 Gen Kai Road No. 63 Building No. 1 Chong Kai 210-31

Applicant before: Guangzhou zhongshuo cloud space information technology Co. Ltd.

TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20210201

Address after: 17F, weibaisheng building, 126 Longcheng Avenue, Longcheng street, Longgang District, Shenzhen, Guangdong 518000

Applicant after: Shenzhen Zhongming hi tech Information Industry Co.,Ltd.

Address before: 510000 Room 308, block 7, Liyin building, Lijiang Garden, Luopu street, Panyu District, Guangzhou City, Guangdong Province

Applicant before: Jiang Junyi

GR01 Patent grant
GR01 Patent grant