CN114740507A - 一种基于短基线的定位定向方法及装置 - Google Patents

一种基于短基线的定位定向方法及装置 Download PDF

Info

Publication number
CN114740507A
CN114740507A CN202210420366.9A CN202210420366A CN114740507A CN 114740507 A CN114740507 A CN 114740507A CN 202210420366 A CN202210420366 A CN 202210420366A CN 114740507 A CN114740507 A CN 114740507A
Authority
CN
China
Prior art keywords
vector
antenna
carrier phase
difference
double
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
Application number
CN202210420366.9A
Other languages
English (en)
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.)
HYDRAULIC SCIENCE RESEARCH INSTITUTE OF SICHUAN PROVINCE
Cetc Rongwei Electronic Technology Co ltd
Original Assignee
HYDRAULIC SCIENCE RESEARCH INSTITUTE OF SICHUAN PROVINCE
Cetc Rongwei Electronic Technology 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 HYDRAULIC SCIENCE RESEARCH INSTITUTE OF SICHUAN PROVINCE, Cetc Rongwei Electronic Technology Co ltd filed Critical HYDRAULIC SCIENCE RESEARCH INSTITUTE OF SICHUAN PROVINCE
Priority to CN202210420366.9A priority Critical patent/CN114740507A/zh
Publication of CN114740507A publication Critical patent/CN114740507A/zh
Pending legal-status Critical Current

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/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13—Receivers
    • G01S19/35—Constructional details or hardware or software details of the signal processing chain
    • G01S19/37—Hardware or software details of the signal processing chain
    • 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)
  • Signal Processing (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

本发明提供一种基于短基线的定位定向方法及装置，所述方法包括：双核处理器的第一核，通过第一天线获得第一伪距观测值和第一载波相位观测值，并通过第二天线获得第二伪距观测值和第二载波相位观测值；同时，第一核经过处理得到站星距的单位化视向矢量；然后写入第一核和第二核的共享地址空间；第二核从共享地址空间读取数据并建立定向GNSS数学模型，然后求解双差载波相位整周模糊度的浮点解及其协方差矩阵；根据双差载波相位整周模糊度的浮点解及其协方差矩阵，求解第一天线指向第二天线的基线向量的固定解；基于第一天线指向第二天线的基线向量的固定解，求解航向角。本发明能够提升数据处理的效率，并降低定位定向装置的成本和功耗。

Description

一种基于短基线的定位定向方法及装置
技术领域
本发明涉及定位定向技术领域，具体而言，涉及一种基于短基线的定位定向方法及装置。
背景技术
近年来，卫星导航系统的应用领域不断得到拓展，人们期望将其应用于高精度测量和定位领域，如测绘、农业、防灾救灾、航空航海等领域。定位定向方法是对高精度载波相位测量的一种应用，通过对卫星高精度的载波相位进行测量计算，可实现厘米级甚至毫米级的定位精度，也可在短基线相对定位中实现高精度的定向功能。因此，结合北斗卫星系统在全球投入应用，在定位定向方法的应用领域开展研究，是一个极具现实意义和战略价值的方向。
现有定位定向装置通常包括两个卫星定位芯片和一个处理器，两个卫星定位芯片接收卫星信号并输出定位信息和观测值给处理器，处理器单独实现定向功能，此类定位定向装置的成本和功耗都很高。
发明内容
本发明旨在提供一种基于短基线的定位定向方法及装置，以解决现有的定位定向装置的成本和功耗都很高的问题。
本发明提供的一种基于短基线的定位定向方法，包括如下步骤：
S100、定位定向装置的双核处理器的第一核，通过第一天线获得第一伪距观测值和第一载波相位观测值，并通过第二天线获得第二伪距观测值和第二载波相位观测值；同时，第一核经过处理得到站星距的单位化视向矢量；然后将第一伪距观测值和第一载波相位观测值，第二伪距观测值和第二载波相位观测值，以及站星距的单位化视向矢量写入第一核和第二核的共享地址空间；
S200、第二核从共享地址空间读取第一伪距观测值和第一载波相位观测值，第二伪距观测值和第二载波相位观测值，以及站星距的单位化视向矢量，建立定向GNSS数学模型，并求解双差载波相位整周模糊度的浮点解及其协方差矩阵；
S300、根据双差载波相位整周模糊度的浮点解及其协方差矩阵，求解第一天线指向第二天线的基线向量的固定解；
S400、基于第一天线指向第二天线的基线向量的固定解，求解航向角，得出定位定向结果。
进一步的，步骤S100包括如下子步骤：
S101、双核处理器的第一核通过捕获和跟踪第一天线的卫星信号，获得第一伪距观测值和第一载波相位观测值，并通过捕获和跟踪第二天线的卫星信号，获得第二伪距观测值和第二载波相位观测值；
S102、第一核采用单点定位方法得到第一天线的定位结果，利用卫星信号星历计算卫星位置，得到站星距的单位化视向矢量，表示为：
Figure BDA0003607310780000021
其中，符号g表示星座的标识；符号k表示卫星，频率用Li区别；
S103、第一核将第一伪距观测值和第一载波相位观测值，第二伪距观测值和第二载波相位观测值，以及站星距的单位化视向矢量写入第一核和第二核的共享地址空间。
进一步的，步骤S200包括如下子步骤：
S201、第二核从共享地址空间读取第一伪距观测值和第一载波相位观测值，第二伪距观测值和第二载波相位观测值，以及站星距的单位化视向矢量；
S202、在第二核中建立定向GNSS数学模型；
S203、利用读取的第一伪距观测值和第一载波相位观测值，第二伪距观测值和第二载波相位观测值，以及站星距的单位化视向矢量，并基于定向GNSS数学模型，建立单历元双差模型；
S204、基于单历元双差模型，采用正交投影法求解双差载波相位整周模糊度的浮点解及其协方差矩阵。
进一步的，步骤S202中，所述定向GNSS数学模型用线性观测方程的方式表述为：
E(y)＝Aa+Bb，D(y)＝Qy，a∈Zn，b∈R3
其中：y是观测向量；a是整周模糊度向量，属于n维整数向量Zn；b是当地水平坐标系下的基线向量，属于3维实数向量R3；A是整周模糊度向量a的设计矩阵；B是基线向量b的设计矩阵；Qy是观测向量y的方差协方差矩阵，反应其统计特性；E(·)代表期望算子；D(·)代表方差算子。
进一步的，步骤S203包括如下子步骤：
S2031、单差：
对于第一伪距观测值和第一载波相位观测值以及第二伪距观测值和第二载波相位观测值，假设对于GNSS星座g有mg颗可见星，在其Li频率上的原始载波相位测量方差为
Figure BDA0003607310780000031
原始伪距测量方差为
Figure BDA0003607310780000032
将这mg颗可见星的单差载波相位观测方程和单差伪距观测方程分别联立，整理成单差矩阵方程：
Figure BDA0003607310780000033
Figure BDA0003607310780000034
其中，
Figure BDA0003607310780000035
表示星座g的Li频率上的单差载波相位观测向量，单位为周；
Figure BDA0003607310780000036
表示星座g的Li频率上的单差伪距观测向量，单位为周；Eg表示星座g的所有可见星的单位化视向矢量矩阵，维数为mg×3；
Figure BDA0003607310780000037
表示星座g的Li频率上的单差载波相位观测向量的噪声；
Figure BDA0003607310780000041
表示星座g的Li频率上的单差伪距观测向量的噪声；
Figure BDA0003607310780000042
表示星座g的Li频率上的单差载波相位的整周模糊度向量；τ＝c(δtA-δtB)表示两个接收装置的钟差，单位为米；
Figure BDA0003607310780000043
表示一个列向量，其元素全部为1，维数为mg；
Figure BDA0003607310780000044
表示维数为mg的单位矩阵；
上述向量和矩阵的具体结构表示如下：
Figure BDA0003607310780000045
Figure BDA0003607310780000046
其中，
Figure BDA0003607310780000047
表示星座g的Li频率上的卫星k在第一天线的位置A与第二天线的位置B之间的单差载波相位观测量；
Figure BDA0003607310780000048
表示星座g的Li频率上的卫星k在第一天线的位置A与第二天线的位置B之间的单差伪距观测量；
Figure BDA0003607310780000049
表示星座g的Li频率上的卫星k在第一天线的位置A与第二天线的位置B之间的单差载波相位的整周模糊度；
Figure BDA00036073107800000410
表示星座g的Li频率上的卫星k在第一天线的位置A与第二天线的位置B之间的单差载波相位观测量的噪声；
Figure BDA00036073107800000411
表示星座g的Li频率上的卫星k在第一天线的位置A与第二天线的位置B之间的单差伪距观测量的噪声；卫星符号k＝1、2…mg。
S2032，双差：
指定某颗星作为参考星，用其它卫星的单差观测方程与其作差，则对于星座g的mg颗卫星得到(mg-1)个双差方程；定义双差算子：
Figure BDA0003607310780000051
在单差矩阵方程的左右同时左乘双差算子，得到双差矩阵方程：
Figure BDA0003607310780000052
Figure BDA0003607310780000053
将双差矩阵方程进一步写成如下形式：
Figure BDA0003607310780000054
该形式与步骤S202中的定向GNSS数学模型相统一，即：
Figure BDA0003607310780000055
其中：
Figure BDA0003607310780000056
Figure BDA0003607310780000057
Figure BDA0003607310780000058
Figure BDA0003607310780000059
Figure BDA00036073107800000510
其中，符号
Figure BDA00036073107800000511
表示克罗内克积运算。
进一步的，步骤S204包括：
设定
Figure BDA00036073107800000512
是投影到设计矩阵B的子空间的正交投影算子：
Figure BDA00036073107800000513
Figure BDA00036073107800000514
再定义
Figure BDA00036073107800000515
得到双差载波相位整周模糊度的浮点解及其协方差矩阵：
Figure BDA0003607310780000061
Figure BDA0003607310780000062
基于整周模糊度的浮点解，得到基线向量的条件解及其协方差矩阵：
Figure BDA0003607310780000063
Figure BDA0003607310780000064
进一步的，步骤S300中求解第一天线指向第二天线的基线向量的固定解的方法为：
基于S2中得到的双差载波相位整周模糊度的浮点解及其协方差矩阵，采用LAMBDA算法来实现整周模糊度的搜索，即，使以下目标函数最小的a作为双差整周模糊度向量的固定解
Figure BDA0003607310780000065
Figure BDA0003607310780000066
从而得到与该双差整周模糊度向量的固定解
Figure BDA0003607310780000067
对应的基线向量的固定解
Figure BDA0003607310780000068
进一步的，步骤S300包括如下子步骤：
S301、双差整周模糊度去相关；
去相关过程即对双差整周模糊度向量的浮点解进行Z变换：
Figure BDA0003607310780000069
Figure BDA00036073107800000610
其中，
Figure BDA00036073107800000611
和
Figure BDA00036073107800000612
表示Z变换后的双差整周模糊度向量的浮点解及其协方差矩阵，Z表示Z变换矩阵；
S302、离散搜索；
经过步骤S301中Z变换后，搜索空间是一个多维的超椭球体，中心在
Figure BDA00036073107800000613
χ2和
Figure BDA00036073107800000614
分别控制这个多维的超椭球体的大小和形状：
Figure BDA00036073107800000615
对
Figure BDA00036073107800000716
进行LTDL分解，然后确定搜索空间χ2，以序贯条件最小二乘搜索得到候选向量解，也即双差整周模糊度向量的浮点解
Figure BDA0003607310780000071
S303、模糊度确认；
将步骤S302中得到的候选向量
Figure BDA0003607310780000072
进行逆Z变换，并进行模糊度确认；用候选向量解
Figure BDA0003607310780000073
去修正基线向量的浮点解
Figure BDA0003607310780000074
可得：
Figure BDA0003607310780000075
最小二乘估计的残差：
Figure BDA0003607310780000076
选取候选向量解中残差最小的候选向量解作为最终的双差整周模糊度向量的固定解
Figure BDA0003607310780000077
从而双差整周模糊度向量的固定解
Figure BDA0003607310780000078
对应的基线向量的固定解
Figure BDA0003607310780000079
进一步的，步骤S400包括如下子步骤：
S401、以第一天线的位置A为坐标原点建立东北天坐标系，第二天线位于位置B处，B’为位置B在东北天坐标系的XOY平面内的投影，则基线向量
Figure BDA00036073107800000710
在XOY平面内的投影
Figure BDA00036073107800000711
与北向的夹角α称为载体的航向角，而
Figure BDA00036073107800000712
与XOY平面的夹角β称为载体的俯仰角。
S402、将第一天线与第二天线构成的基线向量即为基线向量的固定解
Figure BDA00036073107800000713
记为
Figure BDA00036073107800000714
则定向解算的航向角：
Figure BDA00036073107800000715
其中，E、N、U分别对应东、北、天三个坐标方向。从而得到了定位定向结果。
本发明还提供一种用于实现上述的基于短基线的定位定向方法的定位定向装置，所述定位定向装置包括双核处理器以及与双核处理器连接的第一天线和第二天线；所述双核处理器包括相连的第一核和第二核。
综上所述，由于采用了上述技术方案，本发明的有益效果是：
1、本申请的定位定向方法采用的定位定向装置是定位定向一体化的双分集接收装置，即通过双核处理器分别实现定位和定向功能，简化了设计结构，提升了数据处理的效率，降低了定位定向装置的成本和功耗。
2、本申请提供的基于短基线的定位定向方法适用于固定短基线场景，可兼顾定向解算成功率和定向结果的准确度；同时采用正交投影法求解浮点解，能够有效减少大矩阵求逆和分离等运算引起的精度损失，提高数据精度。
附图说明
为了更清楚地说明本发明实施例的技术方案，下面将对实施例中的附图作简单地介绍，应当理解，以下附图仅示出了本发明的某些实施例，因此不应被看作是对范围的限定，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他相关的附图。
图1为本发明实施例中的定向定位装置的结构图。
图2为本发明实施例中的定向原理的示意图。
图3为本发明实施例中的定向的基线向量的示意图。
图4为本发明实施例中的基于短基线的定位定向方法的流程图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本发明一部分实施例，而不是全部的实施例。通常在此处附图中描述和示出的本发明实施例的组件可以以各种不同的配置来布置和设计。
因此，以下对在附图中提供的本发明的实施例的详细描述并非旨在限制要求保护的本发明的范围，而是仅仅表示本发明的选定实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
实施例
本实施例要实现一种基于短基线的定位定向方法，需要采用一种定位定向装置，如图1所示，所述定位定向装置是一个双分集接收装置，包括双核处理器以及与双核处理器连接的第一天线和第二天线；所述双核处理器包括相连的第一核和第二核。其工作原理为：
双核处理器的第一核通过第一天线和第二天线接收卫星信号，如图2所示，实现对卫星信号的捕获与跟踪，能够得到定位信息、卫星位置、卫星的伪距观测值和载波相位观测值。
双核处理器的第一核与第二核通过共享地址空间实现数据共享，第二核采用第一核获得的定位信息、卫星位置、卫星的伪距观测值和载波相位观测值进行定向解算，得到由第一天线指向第二天线的基线向量。
定向的最终目的是得到方向信息，一般指基线向量的航向角，如图3所示，基线向量由第一天线的位置A指向第二天线的位置B，航向角为东北天坐标系中的角度α。
在具体应用中，定位定向装置还应包括射频模块、电源模块、时钟模块等(图中未示出)。所述射频模块处理用于将第一天线和第二天线接收到的卫星信号，转化为基带信号提供给双核处理器；所述电源模块用于为射频模块、双核处理器和时钟模块供电；所述时钟模块用于为双核处理器提供时钟信号。
在准备好定位定向装置后，如图4所示，本实施例实现的一种基于短基线的定位定向方法，包括如下步骤：
S100、定位定向装置的双核处理器的第一核，通过第一天线获得第一伪距观测值和第一载波相位观测值，并通过第二天线获得第二伪距观测值和第二载波相位观测值；同时，第一核经过处理得到站星距的单位化视向矢量；然后将第一伪距观测值和第一载波相位观测值，第二伪距观测值和第二载波相位观测值，以及站星距的单位化视向矢量写入第一核和第二核的共享地址空间；
具体地：
S101、双核处理器的第一核通过捕获和跟踪第一天线的卫星信号，获得第一伪距观测值和第一载波相位观测值，并通过捕获和跟踪第二天线的卫星信号，获得第二伪距观测值和第二载波相位观测值；
S102、第一核采用单点定位方法得到第一天线的定位结果，利用卫星信号星历计算卫星位置，得到站星距(定位定向装置到卫星)的单位化视向矢量，表示为：
Figure BDA0003607310780000101
其中，为使模型更具普遍适用性，本实施例引入星座的标识，用欧冠符号g表示星座的标识，代表GPS、BD2等卫星导航系统；符号k表示卫星，频率用Li区别；
S103、第一核将第一伪距观测值和第一载波相位观测值，第二伪距观测值和第二载波相位观测值，以及站星距的单位化视向矢量写入第一核和第二核的共享地址空间。
S200、第二核从共享地址空间读取第一伪距观测值和第一载波相位观测值，第二伪距观测值和第二载波相位观测值，以及站星距的单位化视向矢量，建立定向GNSS数学模型，并求解双差载波相位整周模糊度的浮点解及其协方差矩阵；
具体地：
S201、第二核从共享地址空间读取第一伪距观测值和第一载波相位观测值，第二伪距观测值和第二载波相位观测值，以及站星距的单位化视向矢量；
S202、在第二核中建立定向GNSS数学模型；
具体地，所述定向GNSS数学模型用线性观测方程的方式表述，对于任意频率任意星座的GNSS系统都适用，其本质是一种整数参数和实数参数的混合模型，表述为：
E(y)＝Aa+Bb，D(y)＝Qy，a∈Zn，b∈R3
其中：y是观测向量；a是整周模糊度向量，属于n维整数向量Zn；b是当地水平坐标系下的基线向量，属于3维实数向量R3；A是整周模糊度向量a的设计矩阵；B是基线向量b的设计矩阵；Qy是观测向量y的方差协方差矩阵，反应其统计特性；E(·)代表期望算子；D(·)代表方差算子。
S203、利用读取的第一伪距观测值和第一载波相位观测值，第二伪距观测值和第二载波相位观测值，以及站星距的单位化视向矢量，并基于定向GNSS数学模型，建立单历元双差模型；
具体地：
S2031、单差：
对于第一伪距观测值和第一载波相位观测值以及第二伪距观测值和第二载波相位观测值，假设对于GNSS星座g有mg颗可见星，在其Li频率上的原始载波相位测量方差为
Figure BDA0003607310780000111
原始伪距测量方差为
Figure BDA0003607310780000112
将这mg颗可见星的单差载波相位观测方程和单差伪距观测方程分别联立，整理成单差矩阵方程：
Figure BDA0003607310780000113
Figure BDA0003607310780000114
其中，
Figure BDA0003607310780000115
表示星座g的Li频率上的单差载波相位观测向量，单位为周；
Figure BDA0003607310780000116
表示星座g的Li频率上的单差伪距观测向量，单位为周；Eg表示星座g的所有可见星的单位化视向矢量矩阵，维数为mg×3；
Figure BDA0003607310780000117
表示星座g的Li频率上的单差载波相位观测向量的噪声；
Figure BDA0003607310780000118
表示星座g的Li频率上的单差伪距观测向量的噪声；
Figure BDA0003607310780000119
表示星座g的Li频率上的单差载波相位的整周模糊度向量；τ＝c(δtA-δtB)表示两个接收装置的钟差，单位为米；
Figure BDA0003607310780000121
表示一个列向量，其元素全部为1，维数为mg；
Figure BDA0003607310780000122
表示维数为mg的单位矩阵；
上述向量和矩阵的具体结构表示如下：
Figure BDA0003607310780000123
Figure BDA0003607310780000124
其中，
Figure BDA0003607310780000125
表示星座g的Li频率上的卫星k在第一天线的位置A与第二天线的位置B之间的单差载波相位观测量；
Figure BDA0003607310780000126
表示星座g的Li频率上的卫星k在第一天线的位置A与第二天线的位置B之间的单差伪距观测量；
Figure BDA0003607310780000127
表示星座g的Li频率上的卫星k在第一天线的位置A与第二天线的位置B之间的单差载波相位的整周模糊度；
Figure BDA0003607310780000128
表示星座g的Li频率上的卫星k在第一天线的位置A与第二天线的位置B之间的单差载波相位观测量的噪声；
Figure BDA0003607310780000129
表示星座g的Li频率上的卫星k在第一天线的位置A与第二天线的位置B之间的单差伪距观测量的噪声；卫星符号k＝1、2…mg。
S2032，双差：
指定某颗星作为参考星(可将参考星的单差观测方程放在矩阵方程中的第一个)，用其它卫星的单差观测方程与其作差，则对于星座g的mg颗卫星得到(mg-1)个双差方程；定义双差算子：
Figure BDA0003607310780000131
在单差矩阵方程的左右同时左乘双差算子，得到双差矩阵方程：
Figure BDA0003607310780000132
Figure BDA0003607310780000133
将双差矩阵方程进一步写成如下形式：
Figure BDA0003607310780000134
该形式与步骤S202中的定向GNSS数学模型相统一，即：
Figure BDA0003607310780000135
其中：
Figure BDA0003607310780000136
Figure BDA0003607310780000137
Figure BDA0003607310780000138
Figure BDA0003607310780000139
Figure BDA00036073107800001310
其中，符号
Figure BDA00036073107800001311
表示克罗内克积运算。
S204、基于单历元双差模型，采用正交投影法求解双差载波相位整周模糊度的浮点解及其协方差矩阵；
具体地：
设定
Figure BDA00036073107800001312
是投影到设计矩阵B的子空间的正交投影算子：
Figure BDA00036073107800001313
Figure BDA0003607310780000141
再定义
Figure BDA0003607310780000142
得到双差载波相位整周模糊度的浮点解及其协方差矩阵：
Figure BDA0003607310780000143
Figure BDA0003607310780000144
基于整周模糊度的浮点解，得到基线向量的条件解及其协方差矩阵：
Figure BDA0003607310780000145
Figure BDA0003607310780000146
S300、根据双差载波相位整周模糊度的浮点解及其协方差矩阵，求解第一天线指向第二天线的基线向量的固定解；基于S2中得到的双差载波相位整周模糊度的浮点解及其协方差矩阵，可以采用LAMBDA算法来实现整周模糊度的搜索，即，使以下目标函数最小的a作为双差整周模糊度向量的固定解
Figure BDA0003607310780000147
Figure BDA0003607310780000148
从而得到与该双差整周模糊度向量的固定解
Figure BDA0003607310780000149
对应的基线向量的固定解
Figure BDA00036073107800001410
具体地：
S301、双差整周模糊度去相关；
去相关过程即对双差整周模糊度向量的浮点解进行Z变换：
Figure BDA00036073107800001411
Figure BDA00036073107800001412
其中，
Figure BDA00036073107800001413
和
Figure BDA00036073107800001414
表示Z变换后的双差整周模糊度向量的浮点解及其协方差矩阵，Z表示Z变换矩阵；Z矩阵及其转置的作用是对搜索空间进行不同方向的挤压，使搜索空间由拉长的高维椭球变得近似于球。
S302、离散搜索；
经过步骤S301中Z变换后，搜索空间是一个多维的超椭球体，中心在
Figure BDA0003607310780000151
χ2和
Figure BDA0003607310780000152
分别控制这个多维的超椭球体的大小和形状：
Figure BDA0003607310780000153
对
Figure BDA00036073107800001518
进行LTDL分解，然后确定搜索空间χ2，以序贯条件最小二乘搜索得到候选向量解，也即双差整周模糊度向量的浮点解
Figure BDA0003607310780000154
S303、模糊度确认；
将步骤S302中得到的候选向量
Figure BDA0003607310780000155
进行逆Z变换，并进行模糊度确认；用候选向量解
Figure BDA0003607310780000156
去修正基线向量的浮点解
Figure BDA0003607310780000157
可得：
Figure BDA0003607310780000158
最小二乘估计的残差：
Figure BDA0003607310780000159
选取候选向量解中残差最小的候选向量解作为最终的双差整周模糊度向量的固定解
Figure BDA00036073107800001510
从而双差整周模糊度向量的固定解
Figure BDA00036073107800001519
对应的基线向量的固定解
Figure BDA00036073107800001511
S400、基于第一天线指向第二天线的基线向量的固定解，求解航向角，得出定位定向结果；
具体地：
S401、以第一天线的位置A为坐标原点建立东北天坐标系，如图3所示，第二天线位于位置B处，B’为位置B在东北天坐标系的XOY平面内的投影，则基线向量
Figure BDA00036073107800001512
在XOY平面内的投影
Figure BDA00036073107800001513
与北向的夹角α称为载体的航向角，而
Figure BDA00036073107800001514
与XOY平面的夹角β称为载体的俯仰角。
S402、将第一天线与第二天线构成的基线向量即为基线向量的固定解
Figure BDA00036073107800001515
记为
Figure BDA00036073107800001516
则定向解算的航向角：
Figure BDA00036073107800001517
其中，E、N、U分别对应东、北、天三个坐标方向。从而得到了定位定向结果。
以上所述仅为本发明的优选实施例而已，并不用于限制本发明，对于本领域的技术人员来说，本发明可以有各种更改和变化。凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (10)

1.一种基于短基线的定位定向方法，其特征在于，包括如下步骤：
S100、定位定向装置的双核处理器的第一核，通过第一天线获得第一伪距观测值和第一载波相位观测值，并通过第二天线获得第二伪距观测值和第二载波相位观测值；同时，第一核经过处理得到站星距的单位化视向矢量；然后将第一伪距观测值和第一载波相位观测值，第二伪距观测值和第二载波相位观测值，以及站星距的单位化视向矢量写入第一核和第二核的共享地址空间；
S200、第二核从共享地址空间读取第一伪距观测值和第一载波相位观测值，第二伪距观测值和第二载波相位观测值，以及站星距的单位化视向矢量，建立定向GNSS数学模型，并求解双差载波相位整周模糊度的浮点解及其协方差矩阵；
S300、根据双差载波相位整周模糊度的浮点解及其协方差矩阵，求解第一天线指向第二天线的基线向量的固定解；
S400、基于第一天线指向第二天线的基线向量的固定解，求解航向角，得出定位定向结果。
2.根据权利要求1所述的基于短基线的定位定向方法，其特征在于，步骤S100包括如下子步骤：
S101、双核处理器的第一核通过捕获和跟踪第一天线的卫星信号，获得第一伪距观测值和第一载波相位观测值，并通过捕获和跟踪第二天线的卫星信号，获得第二伪距观测值和第二载波相位观测值；
S102、第一核采用单点定位方法得到第一天线的定位结果，利用卫星信号星历计算卫星位置，得到站星距的单位化视向矢量，表示为：
Figure FDA0003607310770000011
其中，符号g表示星座的标识；符号k表示卫星，频率用Li区别；
S103、第一核将第一伪距观测值和第一载波相位观测值，第二伪距观测值和第二载波相位观测值，以及站星距的单位化视向矢量写入第一核和第二核的共享地址空间。
3.根据权利要求2所述的基于短基线的定位定向方法，其特征在于，步骤S200包括如下子步骤：
S201、第二核从共享地址空间读取第一伪距观测值和第一载波相位观测值，第二伪距观测值和第二载波相位观测值，以及站星距的单位化视向矢量；
S202、在第二核中建立定向GNSS数学模型；
S203、利用读取的第一伪距观测值和第一载波相位观测值，第二伪距观测值和第二载波相位观测值，以及站星距的单位化视向矢量，并基于定向GNSS数学模型，建立单历元双差模型；
S204、基于单历元双差模型，采用正交投影法求解双差载波相位整周模糊度的浮点解及其协方差矩阵。
4.根据权利要求3所述的基于短基线的定位定向方法，其特征在于，步骤S202中，所述定向GNSS数学模型用线性观测方程的方式表述为：
E(y)＝Aa+Bb，D(y)＝Qy，a∈Zn，b∈R3
其中：y是观测向量；a是整周模糊度向量，属于n维整数向量Zn；b是当地水平坐标系下的基线向量，属于3维实数向量R3；A是整周模糊度向量a的设计矩阵；B是基线向量b的设计矩阵；Qy是观测向量y的方差协方差矩阵，反应其统计特性；E(·)代表期望算子；D(·)代表方差算子。
5.根据权利要求3所述的基于短基线的定位定向方法，其特征在于，步骤S203包括如下子步骤：
S2031、单差：
对于第一伪距观测值和第一载波相位观测值以及第二伪距观测值和第二载波相位观测值，假设对于GNSS星座g有mg颗可见星，在其Li频率上的原始载波相位测量方差为
Figure FDA0003607310770000031
原始伪距测量方差为
Figure FDA0003607310770000032
将这mg颗可见星的单差载波相位观测方程和单差伪距观测方程分别联立，整理成单差矩阵方程：
Figure FDA0003607310770000033
Figure FDA0003607310770000034
其中，
Figure FDA0003607310770000035
表示星座g的Li频率上的单差载波相位观测向量，单位为周；
Figure FDA0003607310770000036
表示星座g的Li频率上的单差伪距观测向量，单位为周；Eg表示星座g的所有可见星的单位化视向矢量矩阵，维数为mg×3；
Figure FDA0003607310770000037
表示星座g的Li频率上的单差载波相位观测向量的噪声；
Figure FDA0003607310770000038
表示星座g的Li频率上的单差伪距观测向量的噪声；
Figure FDA0003607310770000039
表示星座g的Li频率上的单差载波相位的整周模糊度向量；τ＝c(δtA-δtB)表示两个接收装置的钟差，单位为米；
Figure FDA00036073107700000310
表示一个列向量，其元素全部为1，维数为mg；
Figure FDA00036073107700000311
表示维数为mg的单位矩阵；
上述向量和矩阵的具体结构表示如下：
Figure FDA00036073107700000312
Figure FDA00036073107700000313
其中，
Figure FDA00036073107700000314
表示星座g的Li频率上的卫星k在第一天线的位置A与第二天线的位置B之间的单差载波相位观测量；
Figure FDA00036073107700000315
表示星座g的Li频率上的卫星k在第一天线的位置A与第二天线的位置B之间的单差伪距观测量；
Figure FDA0003607310770000048
表示星座g的Li频率上的卫星k在第一天线的位置A与第二天线的位置B之间的单差载波相位的整周模糊度；
Figure FDA0003607310770000049
表示星座g的Li频率上的卫星k在第一天线的位置A与第二天线的位置B之间的单差载波相位观测量的噪声；
Figure FDA00036073107700000410
表示星座g的Li频率上的卫星k在第一天线的位置A与第二天线的位置B之间的单差伪距观测量的噪声；卫星符号k＝1、2…mg。
S2032，双差：
指定某颗星作为参考星，用其它卫星的单差观测方程与其作差，则对于星座g的mg颗卫星得到(mg-1)个双差方程；定义双差算子：
Figure FDA0003607310770000041
在单差矩阵方程的左右同时左乘双差算子，得到双差矩阵方程：
Figure FDA0003607310770000042
Figure FDA0003607310770000043
将双差矩阵方程进一步写成如下形式：
Figure FDA0003607310770000044
该形式与步骤S202中的定向GNSS数学模型相统一，即：
Figure FDA0003607310770000045
其中：
Figure FDA0003607310770000046
Figure FDA0003607310770000047
Figure FDA0003607310770000051
Figure FDA0003607310770000052
Figure FDA0003607310770000053
其中，符号
Figure FDA0003607310770000054
表示克罗内克积运算。
6.根据权利要求5所述的基于短基线的定位定向方法，其特征在于，步骤S204包括：
设定
Figure FDA00036073107700000515
是投影到设计矩阵B的子空间的正交投影算子：
Figure FDA0003607310770000055
Figure FDA0003607310770000056
再定义
Figure FDA0003607310770000057
得到双差载波相位整周模糊度的浮点解及其协方差矩阵：
Figure FDA0003607310770000058
Figure FDA0003607310770000059
基于整周模糊度的浮点解，得到基线向量的条件解及其协方差矩阵：
Figure FDA00036073107700000510
Figure FDA00036073107700000511
7.根据权利要求6所述的基于短基线的定位定向方法，其特征在于，步骤S300中求解第一天线指向第二天线的基线向量的固定解的方法为：
基于S2中得到的双差载波相位整周模糊度的浮点解及其协方差矩阵，采用LAMBDA算法来实现整周模糊度的搜索，即，使以下目标函数最小的a作为双差整周模糊度向量的固定解
Figure FDA00036073107700000512
Figure FDA00036073107700000513
从而得到与该双差整周模糊度向量的固定解
Figure FDA00036073107700000514
对应的基线向量的固定解
Figure FDA0003607310770000061
8.根据权利要求7所述的基于短基线的定位定向方法，其特征在于，步骤S300包括如下子步骤：
S301、双差整周模糊度去相关；
去相关过程即对双差整周模糊度向量的浮点解进行Z变换：
Figure FDA0003607310770000062
Figure FDA0003607310770000063
其中，
Figure FDA0003607310770000064
和
Figure FDA0003607310770000065
表示Z变换后的双差整周模糊度向量的浮点解及其协方差矩阵，Z表示Z变换矩阵；
S302、离散搜索；
经过步骤S301中Z变换后，搜索空间是一个多维的超椭球体，中心在
Figure FDA0003607310770000066
χ2和
Figure FDA0003607310770000067
分别控制这个多维的超椭球体的大小和形状：
Figure FDA0003607310770000068
对
Figure FDA00036073107700000611
进行LTDL分解，然后确定搜索空间χ2，以序贯条件最小二乘搜索得到候选向量解，也即双差整周模糊度向量的浮点解
Figure FDA00036073107700000612
S303、模糊度确认；
将步骤S302中得到的候选向量
Figure FDA00036073107700000613
进行逆Z变换，并进行模糊度确认；用候选向量解
Figure FDA00036073107700000615
去修正基线向量的浮点解
Figure FDA00036073107700000614
可得：
Figure FDA0003607310770000069
最小二乘估计的残差：
Figure FDA00036073107700000610
选取候选向量解中残差最小的候选向量解作为最终的双差整周模糊度向量的固定解
Figure FDA00036073107700000617
从而双差整周模糊度向量的固定解
Figure FDA00036073107700000616
对应的基线向量的固定解
Figure FDA00036073107700000618
9.根据权利要求8所述的基于短基线的定位定向方法，其特征在于，步骤S400包括如下子步骤：
S401、以第一天线的位置A为坐标原点建立东北天坐标系，第二天线位于位置B处，B’为位置B在东北天坐标系的XOY平面内的投影，则基线向量
Figure FDA0003607310770000072
在XOY平面内的投影
Figure FDA0003607310770000073
与北向的夹角α称为载体的航向角，而
Figure FDA0003607310770000074
与XOY平面的夹角β称为载体的俯仰角。
S402、将第一天线与第二天线构成的基线向量即为基线向量的固定解
Figure FDA0003607310770000075
记为
Figure FDA0003607310770000076
则定向解算的航向角：
Figure FDA0003607310770000071
其中，E、N、U分别对应东、北、天三个坐标方向，从而得到了定位定向结果。
10.一种用于实现如权利要求1-9任一项所述的基于短基线的定位定向方法的定位定向装置，其特征在于，所述定位定向装置包括双核处理器以及与双核处理器连接的第一天线和第二天线；所述双核处理器包括相连的第一核和第二核。
CN202210420366.9A 2022-04-21 2022-04-21 一种基于短基线的定位定向方法及装置 Pending CN114740507A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210420366.9A CN114740507A (zh) 2022-04-21 2022-04-21 一种基于短基线的定位定向方法及装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210420366.9A CN114740507A (zh) 2022-04-21 2022-04-21 一种基于短基线的定位定向方法及装置

Publications (1)

Publication Number Publication Date
CN114740507A true CN114740507A (zh) 2022-07-12

Family

ID=82284496

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210420366.9A Pending CN114740507A (zh) 2022-04-21 2022-04-21 一种基于短基线的定位定向方法及装置

Country Status (1)

Country Link
CN (1) CN114740507A (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116840876A (zh) * 2023-04-07 2023-10-03 北京李龚导航科技有限公司 适用于相位失真的卫星导航天线的双天线定向方法及装置
CN116953746A (zh) * 2023-09-21 2023-10-27 北京李龚导航科技有限公司 基于单台相位失真的卫星导航天线的定向方法及装置

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116840876A (zh) * 2023-04-07 2023-10-03 北京李龚导航科技有限公司 适用于相位失真的卫星导航天线的双天线定向方法及装置
CN116840876B (zh) * 2023-04-07 2024-04-05 北京李龚导航科技有限公司 适用于相位失真的卫星导航天线的双天线定向方法及装置
CN116953746A (zh) * 2023-09-21 2023-10-27 北京李龚导航科技有限公司 基于单台相位失真的卫星导航天线的定向方法及装置
CN116953746B (zh) * 2023-09-21 2023-12-22 北京李龚导航科技有限公司 基于单台相位失真的卫星导航天线的定向方法及装置

Similar Documents

Publication Publication Date Title
CN106842268B (zh) 双gnss接收机载波相位双差整周模糊度浮点解向量估计方法
Ng et al. A computation effective range-based 3D mapping aided GNSS with NLOS correction method
CN111239787B (zh) 一种集群自主协同中的gnss动态卡尔曼滤波方法
CN106990424B (zh) 一种双天线gps测姿方法
US5506588A (en) Attitude determining system for use with global positioning system, and laser range finder
EP3410144B1 (en) High-precision, real-time satellite positioning device and method thereof
CN114740507A (zh) 一种基于短基线的定位定向方法及装置
US20070075896A1 (en) Attitude determination exploiting geometry constraints
Dai et al. Real-time attitude determination for microsatellite by LAMBDA method combined with Kalman filtering
CN109541663B (zh) 一种gnss定位测姿多路径误差的纠正方法
Xue et al. Understanding GDOP minimization in GNSS positioning: Infinite solutions, finite solutions and no solution
CN110907975B (zh) 一种基于序贯最小二乘的模糊度固定方法
CN111314849B (zh) 定位方法、装置、移动终端及存储介质
CN116540285B (zh) 惯性辅助的gnss双天线定向方法、装置与电子设备
CN111399020A (zh) 一种定向测姿系统及方法
CN116879927A (zh) 基于三天线共线共钟架构的船用卫星罗经艏向测定方法
Medina et al. On the Kalman filtering formulation for RTK joint positioning and attitude quaternion determination
CN110133702B (zh) 一种基于正交变换的姿态测量方法和设备
CN113834482A (zh) 定位方法、装置、电子设备及存储介质
CN110909456B (zh) 一种建模方法、装置、终端设备及介质
Giorgi Attitude determination
CN116009044A (zh) 一种单天线船舶姿态测量方法、装置及电子设备
CN116125371A (zh) 一种卫星定向方法、装置、卫星导航芯片及存储介质
CN108919315B (zh) 多模接收机系统层几何精度因子最小值计算方法
Kumar et al. The global positioning system: Popular accuracy measures

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