CN107272039A - 一种基于双天线gps的定位测姿方法 - Google Patents
一种基于双天线gps的定位测姿方法 Download PDFInfo
- Publication number
- CN107272039A CN107272039A CN201710421244.0A CN201710421244A CN107272039A CN 107272039 A CN107272039 A CN 107272039A CN 201710421244 A CN201710421244 A CN 201710421244A CN 107272039 A CN107272039 A CN 107272039A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- msubsup
- vector
- receiver
- 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
- G01S19/43—Determining position using carrier phase measurements, e.g. kinematic positioning; using long or short baseline interferometry
- G01S19/44—Carrier phase ambiguity resolution; Floating ambiguity; LAMBDA [Least-squares AMBiguity Decorrelation Adjustment] method
-
- 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/03—Cooperating elements; Interaction or communication between different cooperating elements or between cooperating elements and receivers
- G01S19/04—Cooperating elements; Interaction or communication between different cooperating elements or between cooperating elements and receivers providing carrier phase data
Abstract
本发明基于双天线GPS的定位测姿方法,在刚性载体上呈几何分布设置两个GPS信号接收天线且对应设置两台接收机,使得两个GPS信号接收天线构成了一个二维基线向量;利用两个GPS信号接收天线的真实坐标值求得基线向量b A,B;利用整周单差模糊度求得基线向量 A,B;如果基线向量b A,B和 A,B乘积的平方根值与基线向量真实长度的差的绝对值小于阈值e1,则采用基线向量b A,B的坐标计算出刚性载体的二维坐标航向角α与俯仰角β,即完成刚性载体的定位测姿。本发明的有益技术效果是通过两种不同方法求解基线向量确定姿态,通过设计程序语言验证算法的可行性,保证了求解整周模糊度的快速性与准确性,有效提高了载体定位测姿的准确性和及时性。
Description
技术领域
本发明涉及利用GPS卫星导航系统对载体进行姿态解算的方法,具体涉及到一种基于双天线GPS的定位测姿方法。
背景技术
GPS它不仅具有全球性、全天候和连续的精密三维定位能力,而且能实时地对载体的速度、姿态进行测量以及精密授时。GPS姿态测量技术是近年来卫星导航应用领域的热点之一,随着GPS接收机研制成本的降低,以及载波相位技术的日渐提高,基于GPS载波相位载体姿态测量技术的方法可以较好的克服传统测量手段的缺点,同时可以实现安装在载体上的GPS天线间的精确相对定位。利用这些精确相对定位的数据,可以很方便的计算载体的姿态或航向;同时还可以完成运载体的定位和授时,并且受环境的影响小,能够长时间进行高精度测姿任务,这使得GPS姿态测量成为近几年研究的热点之一。利用GPS载波相位观测量进行定向和定姿的研究为GPS开辟了又一个新的应用领域。
发明内容
为充分利用GPS定位系统对载体进行定位测姿,提高载体定位测姿的准确性和及时性,本发明提出一种基于双天线GPS的定位测姿方法。
本发明基于双天线GPS的定位测姿方法,在刚性载体上呈几何分布设置两个GPS信号接收天线且对应设置两台接收机,使得两个GPS信号接收天线构成了一个二维基线向量;利用两个GPS信号接收天线的真实坐标值求得基线向量bA,B;利用整周单差模糊度求得基线向量如果基线向量bA,B和乘积的平方根值与基线向量真实长度的差的绝对值小于阈值ε1,则采用基线向量bA,B的坐标计算出刚性载体的二维坐标航向角α与俯仰角β,即完成刚性载体的定位测姿;否则,重新求得基线向量bAB和直至满足两者乘积的平方根值与基线向量真实长度的差的绝对值小于阈值ε1;所述基线向量真实长度是指两个GPS信号接收天线构成的二维基线向量的长度的绝对值,可直接测量得到;所述阈值ε1为基线向量真实长度的2%~5%。
进一步的,所述利用两个GPS信号接收天线的真实坐标值求得基线向量bA,B,包括以下步骤:
S201、设接收机A的坐标为(X1、Y1、Z1)且直接采用单点定位结果,接收机B的坐标为(X2、Y2、Z2)且为待求量,接收机A与接收机B的距离很近,直接将已知的接收机A的坐标当做接收机B的概略坐标,(Δx、Δy、Δz)为接收机B的修正量;
S202、设有接收机A和接收机B于t时刻同时观测到两颗卫星,于是双差载波相位观测方程为:
为简化运算,将式(2)简化为下式(3):
式(1)、(2)和(3)中,表示双差运算,为表示载波双差观测值的小数部分,为距离的双差,为双差整周模糊度,为双差载波相位观测噪声,表示对流层误差,为电离层误差;
S203、设有效卫星的个数为n,其中一颗作为双差观测的基本量,可得到n-1个双差方程,对式(3)进行线性化处理,其双差模式下的观测方程都可以用下面的线性方程概括:
Y=HX+λN+V (4)
式(4)中,H为观测矩阵,即天线指向卫星的余弦参数差值,X为接收机Ⅱ的坐标修正量;Y为已知向量,由接收机Ⅰ及接收机Ⅱ概略坐标到卫星的距离双差和载波观测双差值构成;λ为载波波长,N为双差整周模糊度向量,V为观测误差噪声向量;
S204、利用正余弦函数对2π整数倍的不敏感性,对航向角α、俯仰角β和整周模糊度定义自适应度函数F(β,α),且分别对搜索结果获得的浮点解的适应性进行评价,假设卫星的数量为n,将有n-1个双差整周模糊度,适应度函数定义为;
式(5)中,F(β,α)为定义的适应度函数,为双差整周模糊度浮点解;
正确姿态角的适应度函数取值最大值为1,在误差很小的情况下,对于正确的姿态角α、β,浮点解应为整数或十分接近整数,适应度函数值十分接近于1;以此为原则将合适的浮点解四舍五入即可得到整周模糊度值;
S205、在确定整周模糊度值后,利用最小二乘估计方法得到天线Ⅱ真实坐标的修正值X:
X=(HT·H)-1HT·Y (6)
式(6)中,X为天线Ⅱ真实坐标的修正值,H表示观测矩阵,Y为已知向量,由接收机Ⅰ及接收机Ⅱ概略坐标到卫星的距离双差和载波观测双差值构成;
S206、根据天线Ⅱ真实坐标的修正值X,求得天线Ⅱ的真实坐标;利用两天线的真实坐标值解算出基线向量的值bA,B。
进一步的,所述利用整周单差模糊度求得基线向量包括以下步骤:
在短基线定向中,整周单差模糊度求解公式如下:
式(7)中,bA,B为基线向量,Sj和SK分别是接收机到卫星j和k的单位矢量,所以只需要确定整周单差
由于基线的长度不超过载波波长的1/2,即:
式(8)、(9)中,Sj表示接收机到卫星j的单位矢量,bAB为基线向量;
将不等式(8)、(9)代入到式(7)中,得到:
对式(10)取整运算:
故有:
由式(12)可以看出,当同时观测到三颗卫星时,由取整法可以获得三个通过三个即可求得基线向量
进一步的,所述基线向量bA,B和乘积的平方根值与基线向量真实长度的差的绝对值小于阈值ε1如下式所示:
式(13)中,bA,B和分别为利用两天线的真实坐标值解算出的基线向量的值和利用整周单差模糊度求得的基线向量的值,L为事先测量确定的基线向量真实长度的绝对值,ε1为阈值,取值为基线向量真实长度的2%~5%。
进一步的,所述采用基线向量bA,B的坐标计算出刚性载体的二维坐标航向角α与俯仰角β,即完成刚性载体的定位测姿,包括:
设基线向量bA,B坐标为(x12,y12,z12),则载体的二维坐标航向角α与俯仰角β分别为:
进一步的,本发明基于双天线GPS的定位测姿方法,包括以下步骤:
S1、在刚性载体上呈几何分布设置两个GPS信号接收天线且对应设置两台接收机,使得两个GPS信号接收天线构成了一个二维基线向量;
S2、利用两个GPS信号接收天线的真实坐标值求得基线向量bA,B,包括:
S201、设接收机A的坐标为(X1、Y1、Z1)且直接采用单点定位结果,接收机B的坐标为(X2、Y2、Z2)且为待求量,接收机A与接收机B的距离很近,直接将已知的接收机A的坐标当做接收机B的概略坐标,(Δx、Δy、Δz)为接收机B的修正量;
S202、设有接收机A和接收机B于t时刻同时观测到两颗卫星,于是双差载波相位观测方程为:
为简化运算,将式(2)简化为下式(3):
式(1)、(2)和(3)中,表示双差运算,为表示载波双差观测值的小数部分,为距离的双差,为双差整周模糊度,为双差载波相位观测噪声,表示对流层误差,为电离层误差;
S203、设有效卫星的个数为n,其中一颗作为双差观测的基本量,可得到n-1个双差方程,对式(3)进行线性化处理,其双差模式下的观测方程都可以用下面的线性方程概括:
Y=HX+λN+V (4)
式(4)中,H为观测矩阵,即天线指向卫星的余弦参数差值,X为接收机Ⅱ的坐标修正量;Y为已知向量,由接收机Ⅰ及接收机Ⅱ概略坐标到卫星的距离双差和载波观测双差值构成;λ为载波波长,N为双差整周模糊度向量,V为观测误差噪声向量;
S204、利用正余弦函数对2π整数倍的不敏感性,对航向角α、俯仰角β和整周模糊度定义自适应度函数F(β,α),且分别对搜索结果获得的浮点解的适应性进行评价,假设卫星的数量为n,将有n-1个双差整周模糊度,适应度函数定义为;
式(5)中,F(β,α)为定义的适应度函数,为双差整周模糊度浮点解;
正确姿态角的适应度函数取值最大值为1,在误差很小的情况下,对于正确的姿态角α、β,浮点解应为整数或十分接近整数,适应度函数值十分接近于1;以此为原则将合适的浮点解四舍五入即可得到整周模糊度值;
S205、在确定整周模糊度值后,利用最小二乘估计方法得到天线Ⅱ真实坐标的修正值X:
X=(HT·H)-1HT·Y (6)
式(6)中,X为天线Ⅱ真实坐标的修正值,H表示观测矩阵,Y为已知向量,由接收机Ⅰ及接收机Ⅱ概略坐标到卫星的距离双差和载波观测双差值构成;
S206、根据天线Ⅱ真实坐标的修正值X,求得天线Ⅱ的真实坐标;利用两天线的真实坐标值解算出基线向量的值bA,B;
S3、利用整周单差模糊度求得基线向量包括:
在短基线定向中,整周单差模糊度求解公式如下:
式(7)中,bA,B为基线向量,Sj和SK分别是接收机到卫星j和k的单位矢量,所以只需要确定整周单差
由于基线的长度不超过载波波长的1/2,即:
式(8)、(9)中,Sj表示接收机到卫星j的单位矢量,bAB为基线向量;
将不等式(8)、(9)代入到式(7)中,得到:
对式(10)取整运算:
故有:
由式(12)可以看出,当同时观测到三颗卫星时,由取整法可以获得三个通过三个即可求得基线向量
S4、采用下式计算基线向量bA,B和乘积的平方根值与基线向量真实长度的差的绝对值并与阈值ε1相比较:
式(13)中,bA,B和分别为利用两天线的真实坐标值解算出的基线向量的值和利用整周单差模糊度求得的基线向量的值,L为事先测量确定的基线向量真实长度的绝对值,ε1为阈值,取值为基线向量真实长度的2%~5%;
如果式(13)成立,则顺序执行步骤S5;否则,返回执行步骤S2,直至式(13)成立;
S5、采用基线向量bA,B的坐标计算出刚性载体的二维坐标航向角α与俯仰角β,即完成刚性载体的定位测姿,包括:
设基线向量bA,B坐标为(x12,y12,z12),则载体的二维坐标航向角α与俯仰角β分别为;
本发明基于双天线GPS的定位测姿方法的有益技术效果是提出了一种求解整周模糊度问题的算法,通过两种不同方法求解基线向量确定姿态,通过设计程序语言验证算法的可行性,保证了求解整周模糊度的快速性与准确性,有效提高了载体定位测姿的准确性和及时性。
附图说明
附图1为本发明基于双天线GPS的定位测姿方法的系统框架图。
附图2为本发明基于双天线GPS的定位测姿方法的算法框架图。
下面结合附图对本发明基于双天线GPS的定位测姿方法作进一步的说明。
具体实施方式
为了更清楚地说明本发明实施例的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。以下结合附图对本发明的优选实施例进行说明,应当理解,此处所描述的优选实施例仅用于说明和解释本发明,并不用于限定本发明。
附图1为本发明基于双天线GPS的定位测姿方法的系统框架图,附图2为本发明基于双天线GPS的定位测姿方法的算法框架图。由图可知,本发明基于双天线GPS的定位测姿方法,在刚性载体上呈几何分布设置两个GPS信号接收天线且对应设置两台接收机,使得两个GPS信号接收天线构成了一个二维基线向量;利用两个GPS信号接收天线的真实坐标值求得基线向量bA,B;利用整周单差模糊度求得基线向量如果基线向量bA,B和乘积的平方根值与基线向量真实长度的差的绝对值小于阈值ε1,则采用基线向量bA,B的坐标计算出刚性载体的二维坐标航向角α与俯仰角β,即完成刚性载体的定位测姿;否则,重新求得基线向量bA,B和直至满足两者乘积的平方根值与基线向量真实长度的差的绝对值小于阈值ε1;所述基线向量真实长度是指两个GPS信号接收天线构成的二维基线向量的长度的绝对值,可直接测量得到;所述阈值ε1为基线向量真实长度的2%~5%。
可见,发明基于双天线GPS的定位测姿方法充分利用GPS定位系统对载体进行定位测姿,提出了一种求解整周模糊度问题的算法,通过两种不同方法求解基线向量确定姿态,通过设计程序语言验证算法的可行性,保证了求解整周模糊度的快速性与准确性,有效提高了载体定位测姿的准确性和及时性。
作为优选,所述利用两个GPS信号接收天线的真实坐标值求得基线向量bA,B,包括以下步骤:
S201、设接收机A的坐标为(X1、Y1、Z1)且直接采用单点定位结果,接收机B的坐标为(X2、Y2、Z2)且为待求量,接收机A与接收机B的距离很近,直接将已知的接收机A的坐标当做接收机B的概略坐标,(Δx、Δy、Δz)为接收机B的修正量;
S202、设有接收机A和接收机B于t时刻同时观测到两颗卫星,于是双差载波相位观测方程为:
为简化运算,将式(2)简化为下式(3):
式(1)、(2)和(3)中,表示双差运算,为表示载波双差观测值的小数部分,为距离的双差,为双差整周模糊度,为双差载波相位观测噪声,表示对流层误差,为电离层误差;
S203、设有效卫星的个数为n,其中一颗作为双差观测的基本量,可得到n-1个双差方程,对式(3)进行线性化处理,其双差模式下的观测方程都可以用下面的线性方程概括:
Y=HX+λN+V (4)
式(4)中,H为观测矩阵,即天线指向卫星的余弦参数差值,X为接收机Ⅱ的坐标修正量;Y为已知向量,由接收机Ⅰ及接收机Ⅱ概略坐标到卫星的距离双差和载波观测双差值构成;λ为载波波长,N为双差整周模糊度向量,V为观测误差噪声向量;
S204、利用正余弦函数对2π整数倍的不敏感性,对航向角α、俯仰角β和整周模糊度定义自适应度函数F(β,α),且分别对搜索结果获得的浮点解的适应性进行评价,假设卫星的数量为n,将有n-1个双差整周模糊度,适应度函数定义为;
式(5)中,F(β,α)为定义的适应度函数,为双差整周模糊度浮点解;
正确姿态角的适应度函数取值最大值为1,在误差很小的情况下,对于正确的姿态角α、β,浮点解应为整数或十分接近整数,适应度函数值十分接近于1;以此为原则将合适的浮点解四舍五入即可得到整周模糊度值;
S205、在确定整周模糊度值后,利用最小二乘估计方法得到天线Ⅱ真实坐标的修正值X:
X=(HT·H)-1HT·Y (6)
式(6)中,X为天线Ⅱ真实坐标的修正值,H表示观测矩阵,Y为已知向量,由接收机Ⅰ及接收机Ⅱ概略坐标到卫星的距离双差和载波观测双差值构成;
S206、根据天线Ⅱ真实坐标的修正值X,求得天线Ⅱ的真实坐标;利用两天线的真实坐标值解算出基线向量的值bA,B。
并且,所述利用整周单差模糊度求得基线向量包括以下步骤:
在短基线定向中,整周单差模糊度求解公式如下:
式(7)中,bA,B为基线向量,Sj和SK分别是接收机到卫星j和k的单位矢量,所以只需要确定整周单差
由于基线的长度不超过载波波长的1/2,即:
式(8)、(9)中,Sj表示接收机到卫星j的单位矢量,bAB为基线向量;
将不等式(8)、(9)代入到式(7)中,得到:
对式(10)取整运算:
故有:
由式(12)可以看出,当同时观测到三颗卫星时,由取整法可以获得三个通过三个即可求得基线向量
同时,所述基线向量bA,B和乘积的平方根值与基线向量真实长度的差的绝对值小于阈值ε1如下式所示:
式(13)中,bA,B和分别为利用两天线的真实坐标值解算出的基线向量的值和利用整周单差模糊度求得的基线向量的值,L为事先测量确定的基线向量真实长度的绝对值,ε1为阈值,取值为基线向量真实长度的2%~5%。
由此,所述采用基线向量bA,B的坐标计算出刚性载体的二维坐标航向角α与俯仰角β,即完成刚性载体的定位测姿,包括:
设基线向量bA,B坐标为(x12,y12,z12),则载体的二维坐标航向角α与俯仰角β分别为:
可见,本发明基于双天线GPS的定位测姿方法,提出了一种求解整周模糊度问题的算法,通过两种不同方法求解基线向量确定姿态,通过设计程序语言验证算法的可行性,保证了求解整周模糊度的快速性与准确性。有效的解决了整周模糊度搜索空间范围太大,模糊度搜索消耗时间长,搜索效率低下导致成功率不高、原始的双差整周模糊度相关性极高、周跳、实时性等现实问题。其基本算法思想为:假设接收机A为基准站,利用载波相位双差方程求解整周模糊度,进而求出接收机B的位置坐标,通过两天线坐标位置方向向量之间的关系,求解出载体的二维姿态信息。
附图2为本发明基于双天线GPS的定位测姿方法的算法框架图,由图可知,本发明基于双天线GPS的定位测姿方法,包括以下步骤:
S1、在刚性载体上呈几何分布设置两个GPS信号接收天线且对应设置两台接收机,使得两个GPS信号接收天线构成了一个二维基线向量;
S2、利用两个GPS信号接收天线的真实坐标值求得基线向量bA,B,包括:
S201、设接收机A的坐标为(X1、Y1、Z1)且直接采用单点定位结果,接收机B的坐标为(X2、Y2、Z2)且为待求量,接收机A与接收机B的距离很近,直接将已知的接收机A的坐标当做接收机B的概略坐标,(Δx、Δy、Δz)为接收机B的修正量;
S202、设有接收机A和接收机B于t时刻同时观测到两颗卫星,于是双差载波相位观测方程为:
为简化运算,将式(2)简化为下式(3):
式(1)、(2)和(3)中,表示双差运算,为表示载波双差观测值的小数部分,为距离的双差,为双差整周模糊度,为双差载波相位观测噪声,表示对流层误差,为电离层误差;
S203、设有效卫星的个数为n,其中一颗作为双差观测的基本量,可得到n-1个双差方程,对式(3)进行线性化处理,其双差模式下的观测方程都可以用下面的线性方程概括:
Y=HX+λN+V (4)
式(4)中,H为观测矩阵,即天线指向卫星的余弦参数差值,X为接收机Ⅱ的坐标修正量;Y为已知向量,由接收机Ⅰ及接收机Ⅱ概略坐标到卫星的距离双差和载波观测双差值构成;λ为载波波长,N为双差整周模糊度向量,V为观测误差噪声向量;
S204、利用正余弦函数对2π整数倍的不敏感性,对航向角α、俯仰角β和整周模糊度定义自适应度函数F(β,α),且分别对搜索结果获得的浮点解的适应性进行评价,假设卫星的数量为n,将有n-1个双差整周模糊度,适应度函数定义为;
式(5)中,F(β,α)为定义的适应度函数,为双差整周模糊度浮点解;
正确姿态角的适应度函数取值最大值为1,在误差很小的情况下,对于正确的姿态角α、β,浮点解应为整数或十分接近整数,适应度函数值十分接近于1;以此为原则将合适的浮点解四舍五入即可得到整周模糊度值;
S205、在确定整周模糊度值后,利用最小二乘估计方法得到天线Ⅱ真实坐标的修正值X:
X=(HT·H)-1HT·Y (6)
式(6)中,X为天线Ⅱ真实坐标的修正值,H表示观测矩阵,Y为已知向量,由接收机Ⅰ及接收机Ⅱ概略坐标到卫星的距离双差和载波观测双差值构成;
S206、根据天线Ⅱ真实坐标的修正值X,求得天线Ⅱ的真实坐标;利用两天线的真实坐标值解算出基线向量的值bA,B;
S3、利用整周单差模糊度求得基线向量包括:
在短基线定向中,整周单差模糊度求解公式如下:
式(7)中,bA,B为基线向量,Sj和SK分别是接收机到卫星j和k的单位矢量,所以只需要确定整周单差
由于基线的长度不超过载波波长的1/2,即:
式(8)、(9)中,Sj表示接收机到卫星j的单位矢量,bAB为基线向量;
将不等式(8)、(9)代入到式(7)中,得到:
对式(10)取整运算:
故有:
由式(12)可以看出,当同时观测到三颗卫星时,由取整法可以获得三个通过三个即可求得基线向量
S4、采用下式计算基线向量bA,B和乘积的平方根值与基线向量真实长度的差的绝对值并与阈值ε1相比较:
式(13)中,bA,B和分别为利用两天线的真实坐标值解算出的基线向量的值和利用整周单差模糊度求得的基线向量的值,L为事先测量确定的基线向量真实长度的绝对值,ε1为阈值,取值为基线向量真实长度的2%~5%;
如果式(13)成立,则顺序执行步骤S5;否则,返回执行步骤S2,直至式(13)成立;
S5、采用基线向量bA,B的坐标计算出刚性载体的二维坐标航向角α与俯仰角β,即完成刚性载体的定位测姿,包括:
设基线向量bA,B坐标为(x12,y12,z12),则载体的二维坐标航向角α与俯仰角β分别为;
显然,本发明基于双天线GPS的定位测姿方法的有益技术效果是提出了一种求解整周模糊度问题的算法,通过两种不同方法求解基线向量确定姿态,通过设计程序语言验证算法的可行性,保证了求解整周模糊度的快速性与准确性,有效提高了载体定位测姿的准确性和及时性。
Claims (6)
1.一种基于双天线GPS的定位测姿方法,其特征在于,在刚性载体上呈几何分布设置两个GPS信号接收天线且对应设置两台接收机,使得两个GPS信号接收天线构成了一个二维基线向量;利用两个GPS信号接收天线的真实坐标值求得基线向量bA,B;利用整周单差模糊度求得基线向量如果基线向量bA,B和乘积的平方根值与基线向量真实长度的差的绝对值小于阈值ε1,则采用基线向量bA,B的坐标计算出刚性载体的二维坐标航向角α与俯仰角β,即完成刚性载体的定位测姿;否则,重新求得基线向量bA,B和直至满足两者乘积的平方根值与基线向量真实长度的差的绝对值小于阈值ε1;所述基线向量真实长度是指两个GPS信号接收天线构成的二维基线向量的长度的绝对值,可直接测量得到;所述阈值ε1为基线向量真实长度的2%~5%。
2.根据权利要求1所述基于双天线GPS的定位测姿方法,其特征在于,所述利用两个GPS信号接收天线的真实坐标值求得基线向量bA,B,包括以下步骤:
S201、设接收机A的坐标为(X1、Y1、Z1)且直接采用单点定位结果,接收机B的坐标为(X2、Y2、Z2)且为待求量,接收机A与接收机B的距离很近,直接将已知的接收机A的坐标当做接收机B的概略坐标,(Δx、Δy、Δz)为接收机B的修正量;
S202、设有接收机A和接收机B于t时刻同时观测到两颗卫星,于是双差载波相位观测方程为:
<mrow>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mo>=</mo>
<mfrac>
<mi>f</mi>
<mi>c</mi>
</mfrac>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mi>&rho;</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mi>N</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mo>+</mo>
<mfrac>
<mi>f</mi>
<mi>c</mi>
</mfrac>
<mrow>
<mo>(</mo>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msub>
<mi>d</mi>
<mrow>
<mi>t</mi>
<mi>r</mi>
<mi>o</mi>
<mi>p</mi>
</mrow>
</msub>
<mo>-</mo>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msub>
<mi>d</mi>
<mrow>
<mi>i</mi>
<mi>o</mi>
<mi>n</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msub>
<mi>&epsiv;</mi>
<mi>&phi;</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>&lambda;</mi>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mo>=</mo>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mi>&rho;</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>&lambda;</mi>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mi>N</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msub>
<mi>d</mi>
<mrow>
<mi>t</mi>
<mi>r</mi>
<mi>o</mi>
<mi>p</mi>
</mrow>
</msub>
<mo>-</mo>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msub>
<mi>d</mi>
<mrow>
<mi>i</mi>
<mi>o</mi>
<mi>n</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>&lambda;</mi>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msub>
<mi>&epsiv;</mi>
<mi>&phi;</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
为简化运算,将式(2)简化为下式(3):
<mrow>
<mi>&lambda;</mi>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mo>=</mo>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mi>&rho;</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>&lambda;</mi>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mi>N</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mo>+</mo>
<mo>+</mo>
<mi>&lambda;</mi>
<mo>&dtri;</mo>
<msub>
<mi>&epsiv;</mi>
<mi>&phi;</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
式(1)、(2)和(3)中,表示双差运算,为表示载波双差观测值的小数部分,为距离的双差,为双差整周模糊度,为双差载波相位观测噪声,表示对流层误差,为电离层误差;
S203、设有效卫星的个数为n,其中一颗作为双差观测的基本量,可得到n-1个双差方程,对式(3)进行线性化处理,其双差模式下的观测方程都可以用下面的线性方程概括:
Y=HX+λN+V (4)
式(4)中,H为观测矩阵,即天线指向卫星的余弦参数差值,X为接收机Ⅱ的坐标修正量;Y为已知向量,由接收机Ⅰ及接收机Ⅱ概略坐标到卫星的距离双差和载波观测双差值构成;λ为载波波长,N为双差整周模糊度向量,V为观测误差噪声向量;
S204、利用正余弦函数对2π整数倍的不敏感性,对航向角α、俯仰角β和整周模糊度定义自适应度函数F(β,α),且分别对搜索结果获得的浮点解的适应性进行评价,假设卫星的数量为n,将有n-1个双差整周模糊度,适应度函数定义为;
<mrow>
<mi>F</mi>
<mrow>
<mo>(</mo>
<mi>&beta;</mi>
<mo>,</mo>
<mi>&alpha;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mi>n</mi>
</mfrac>
<msubsup>
<mi>&Sigma;</mi>
<mrow>
<mi>k</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mi>&pi;</mi>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mover>
<mi>N</mi>
<mo>~</mo>
</mover>
<mi>B</mi>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
式(5)中,F(β,α)为定义的适应度函数,为双差整周模糊度浮点解;
正确姿态角的适应度函数取值最大值为1,在误差很小的情况下,对于正确的姿态角α、β,浮点解应为整数或十分接近整数,适应度函数值十分接近于1;以此为原则将合适的浮点解四舍五入即可得到整周模糊度值;
S205、在确定整周模糊度值后,利用最小二乘估计方法得到天线Ⅱ真实坐标的修正值X:
X=(HT·H)-1HT·Y (6)
式(6)中,X为天线Ⅱ真实坐标的修正值,H表示观测矩阵,Y为已知向量,由接收机Ⅰ及接收机Ⅱ概略坐标到卫星的距离双差和载波观测双差值构成;
S206、根据天线Ⅱ真实坐标的修正值X,求得天线Ⅱ的真实坐标;利用两天线的真实坐标值解算出基线向量的值bA,B。
3.根据权利要求1所述基于双天线GPS的定位测姿方法,其特征在于,所述利用整周单差模糊度求得基线向量包括以下步骤:
在短基线定向中,整周单差模糊度求解公式如下:
式(7)中,bA,B为基线向量,Sj和SK分别是接收机到卫星j和k的单位矢量,所以只需要确定整周单差
由于基线的长度不超过载波波长的1/2,即:
<mrow>
<mo>|</mo>
<msup>
<mi>S</mi>
<mi>j</mi>
</msup>
<mo>&CenterDot;</mo>
<msub>
<mi>b</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
</msub>
<mo>|</mo>
<mo><</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mi>&lambda;</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mfrac>
<mn>1</mn>
<mi>&lambda;</mi>
</mfrac>
<mo>|</mo>
<msup>
<mi>S</mi>
<mi>j</mi>
</msup>
<mo>&CenterDot;</mo>
<msub>
<mi>b</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
</msub>
<mo>|</mo>
<mo><</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
式(8)、(9)中,Sj表示接收机到卫星j的单位矢量,bAB为基线向量;
将不等式(8)、(9)代入到式(7)中,得到:
对式(10)取整运算:
故有:
由式(12)可以看出,当同时观测到三颗卫星时,由取整法可以获得三个通过三个即可求得基线向量
4.根据权利要求1所述基于双天线GPS的定位测姿方法,其特征在于,所述基线向量bA,B和乘积的平方根值与基线向量真实长度的差的绝对值小于阈值ε1如下式所示:
<mrow>
<mo>|</mo>
<msqrt>
<mrow>
<msub>
<mi>b</mi>
<mrow>
<mi>A</mi>
<mo>,</mo>
<mi>B</mi>
</mrow>
</msub>
<msub>
<mover>
<mi>b</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>A</mi>
<mo>,</mo>
<mi>B</mi>
</mrow>
</msub>
</mrow>
</msqrt>
<mo>-</mo>
<mi>L</mi>
<mo>|</mo>
<mo>&le;</mo>
<msub>
<mi>&epsiv;</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>13</mn>
<mo>)</mo>
</mrow>
</mrow>
式(13)中,bA,B和分别为利用两天线的真实坐标值解算出的基线向量的值和利用整周单差模糊度求得的基线向量的值,L为事先测量确定的基线向量真实长度的绝对值,ε1为阈值,取值为基线向量真实长度的2%~5%。
5.根据权利要求1所述基于双天线GPS的定位测姿方法,其特征在于,所述采用基线向量bA,B的坐标计算出刚性载体的二维坐标航向角α与俯仰角β,即完成刚性载体的定位测姿,包括:
设基线向量bA,B坐标为(x12,y12,z12),则载体的二维坐标航向角α与俯仰角β分别为:
<mrow>
<mi>&alpha;</mi>
<mo>=</mo>
<mi>a</mi>
<mi>r</mi>
<mi>c</mi>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mfrac>
<msub>
<mi>y</mi>
<mn>12</mn>
</msub>
<msub>
<mi>x</mi>
<mn>12</mn>
</msub>
</mfrac>
</mrow>
<mrow>
<mi>&beta;</mi>
<mo>=</mo>
<mi>a</mi>
<mi>r</mi>
<mi>c</mi>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mfrac>
<msub>
<mi>z</mi>
<mn>12</mn>
</msub>
<msqrt>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>12</mn>
</msub>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>y</mi>
<mn>12</mn>
</msub>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mfrac>
<mo>.</mo>
</mrow>
6.根据权利要求1所述基于双天线GPS的定位测姿方法,其特征在于,所述基于双天线GPS的定位测姿方法,包括以下步骤:
S1、在刚性载体上呈几何分布设置两个GPS信号接收天线且对应设置两台接收机,使得两个GPS信号接收天线构成了一个二维基线向量;
S2、利用两个GPS信号接收天线的真实坐标值求得基线向量bA,B,包括:
S201、设接收机A的坐标为(X1、Y1、Z1)且直接采用单点定位结果,接收机B的坐标为(X2、Y2、Z2)且为待求量,接收机A与接收机B的距离很近,直接将已知的接收机A的坐标当做接收机B的概略坐标,(Δx、Δy、Δz)为接收机B的修正量;
S202、设有接收机A和接收机B于t时刻同时观测到两颗卫星,于是双差载波相位观测方程为:
<mrow>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mo>=</mo>
<mfrac>
<mi>f</mi>
<mi>c</mi>
</mfrac>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mi>&rho;</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mi>N</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mo>+</mo>
<mfrac>
<mi>f</mi>
<mi>c</mi>
</mfrac>
<mrow>
<mo>(</mo>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msub>
<mi>d</mi>
<mrow>
<mi>t</mi>
<mi>r</mi>
<mi>o</mi>
<mi>p</mi>
</mrow>
</msub>
<mo>-</mo>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msub>
<mi>d</mi>
<mrow>
<mi>i</mi>
<mi>o</mi>
<mi>n</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msub>
<mi>&epsiv;</mi>
<mi>&phi;</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>&lambda;</mi>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mo>=</mo>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mi>&rho;</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>&lambda;</mi>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mi>N</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msub>
<mi>d</mi>
<mrow>
<mi>t</mi>
<mi>r</mi>
<mi>o</mi>
<mi>p</mi>
</mrow>
</msub>
<mo>-</mo>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msub>
<mi>d</mi>
<mrow>
<mi>i</mi>
<mi>o</mi>
<mi>n</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>&lambda;</mi>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msub>
<mi>&epsiv;</mi>
<mi>&phi;</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
为简化运算,将式(2)简化为下式(3):
<mrow>
<mi>&lambda;</mi>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mo>=</mo>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mi>&rho;</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>&lambda;</mi>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mi>N</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mo>+</mo>
<mo>+</mo>
<mi>&lambda;</mi>
<mo>&dtri;</mo>
<msub>
<mi>&epsiv;</mi>
<mi>&phi;</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
式(1)、(2)和(3)中,表示双差运算,为表示载波双差观测值的小数部分,为距离的双差,为双差整周模糊度,为双差载波相位观测噪声,表示对流层误差,为电离层误差;
S203、设有效卫星的个数为n,其中一颗作为双差观测的基本量,可得到n-1个双差方程,对式(3)进行线性化处理,其双差模式下的观测方程都可以用下面的线性方程概括:
Y=HX+λN+V (4)
式(4)中,H为观测矩阵,即天线指向卫星的余弦参数差值,X为接收机Ⅱ的坐标修正量;Y为已知向量,由接收机Ⅰ及接收机Ⅱ概略坐标到卫星的距离双差和载波观测双差值构成;λ为载波波长,N为双差整周模糊度向量,V为观测误差噪声向量;
S204、利用正余弦函数对2π整数倍的不敏感性,对航向角α、俯仰角β和整周模糊度定义自适应度函数F(β,α),且分别对搜索结果获得的浮点解的适应性进行评价,假设卫星的数量为n,将有n-1个双差整周模糊度,适应度函数定义为;
<mrow>
<mi>F</mi>
<mrow>
<mo>(</mo>
<mi>&beta;</mi>
<mo>,</mo>
<mi>&alpha;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mi>n</mi>
</mfrac>
<msubsup>
<mi>&Sigma;</mi>
<mrow>
<mi>k</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mi>&pi;</mi>
<mi>&Delta;</mi>
<mo>&dtri;</mo>
<msubsup>
<mover>
<mi>N</mi>
<mo>~</mo>
</mover>
<mi>B</mi>
<mrow>
<mi>j</mi>
<mi>k</mi>
</mrow>
</msubsup>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
式(5)中,F(β,α)为定义的适应度函数,为双差整周模糊度浮点解;
正确姿态角的适应度函数取值最大值为1,在误差很小的情况下,对于正确的姿态角α、β,浮点解应为整数或十分接近整数,适应度函数值十分接近于1;以此为原则将合适的浮点解四舍五入即可得到整周模糊度值;
S205、在确定整周模糊度值后,利用最小二乘估计方法得到天线Ⅱ真实坐标的修正值X:
X=(HT·H)-1HT·Y (6)
式(6)中,X为天线Ⅱ真实坐标的修正值,H表示观测矩阵,Y为已知向量,由接收机Ⅰ及接收机Ⅱ概略坐标到卫星的距离双差和载波观测双差值构成;
S206、根据天线Ⅱ真实坐标的修正值X,求得天线Ⅱ的真实坐标;利用两天线的真实坐标值解算出基线向量的值bA,B;
S3、利用整周单差模糊度求得基线向量包括:
在短基线定向中,整周单差模糊度求解公式如下:
式(7)中,bA,B为基线向量,Sj和SK分别是接收机到卫星j和k的单位矢量,所以只需要确定整周单差
由于基线的长度不超过载波波长的1/2,即:
<mrow>
<mo>|</mo>
<msup>
<mi>S</mi>
<mi>j</mi>
</msup>
<mo>&CenterDot;</mo>
<msub>
<mi>b</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
</msub>
<mo>|</mo>
<mo><</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mi>&lambda;</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mfrac>
<mn>1</mn>
<mi>&lambda;</mi>
</mfrac>
<mo>|</mo>
<msup>
<mi>S</mi>
<mi>j</mi>
</msup>
<mo>&CenterDot;</mo>
<msub>
<mi>b</mi>
<mrow>
<mi>A</mi>
<mi>B</mi>
</mrow>
</msub>
<mo>|</mo>
<mo><</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
式(8)、(9)中,Sj表示接收机到卫星j的单位矢量,bAB为基线向量;
将不等式(8)、(9)代入到式(7)中,得到:
对式(10)取整运算:
故有:
由式(12)可以看出,当同时观测到三颗卫星时,由取整法可以获得三个通过三个即可求得基线向量
S4、采用下式计算基线向量bA,B和乘积的平方根值与基线向量真实长度的差的绝对值并与阈值ε1相比较:
<mrow>
<mo>|</mo>
<msqrt>
<mrow>
<msub>
<mi>b</mi>
<mrow>
<mi>A</mi>
<mo>,</mo>
<mi>B</mi>
</mrow>
</msub>
<msub>
<mover>
<mi>b</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>A</mi>
<mo>,</mo>
<mi>B</mi>
</mrow>
</msub>
</mrow>
</msqrt>
<mo>-</mo>
<mi>L</mi>
<mo>|</mo>
<mo>&le;</mo>
<msub>
<mi>&epsiv;</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>13</mn>
<mo>)</mo>
</mrow>
</mrow>
式(13)中,bA,B和分别为利用两天线的真实坐标值解算出的基线向量的值和利用整周单差模糊度求得的基线向量的值,L为事先测量确定的基线向量真实长度的绝对值,ε1为阈值,取值为基线向量真实长度的2%~5%;
如果式(13)成立,则顺序执行步骤S5;否则,返回执行步骤S2,直至式(13)成立;
S5、采用基线向量bA,B的坐标计算出刚性载体的二维坐标航向角α与俯仰角β,即完成刚性载体的定位测姿,包括:
设基线向量bA,B坐标为(x12,y12,z12),则载体的二维坐标航向角α与俯仰角β分别为;
<mrow>
<mi>&alpha;</mi>
<mo>=</mo>
<mi>a</mi>
<mi>r</mi>
<mi>c</mi>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mfrac>
<msub>
<mi>y</mi>
<mn>12</mn>
</msub>
<msub>
<mi>x</mi>
<mn>12</mn>
</msub>
</mfrac>
</mrow>
<mrow>
<mi>&beta;</mi>
<mo>=</mo>
<mi>a</mi>
<mi>r</mi>
<mi>c</mi>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mfrac>
<msub>
<mi>z</mi>
<mn>12</mn>
</msub>
<msqrt>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>12</mn>
</msub>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>y</mi>
<mn>12</mn>
</msub>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mfrac>
<mo>.</mo>
</mrow>
5
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710421244.0A CN107272039B (zh) | 2017-06-07 | 2017-06-07 | 一种基于双天线gps的定位测姿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710421244.0A CN107272039B (zh) | 2017-06-07 | 2017-06-07 | 一种基于双天线gps的定位测姿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107272039A true CN107272039A (zh) | 2017-10-20 |
CN107272039B CN107272039B (zh) | 2019-10-25 |
Family
ID=60066971
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710421244.0A Active CN107272039B (zh) | 2017-06-07 | 2017-06-07 | 一种基于双天线gps的定位测姿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107272039B (zh) |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108107459A (zh) * | 2017-12-11 | 2018-06-01 | 浙江捷尚人工智能研究发展有限公司 | 基于导航系统的机器人方位检测方法、装置及系统 |
CN108181630A (zh) * | 2017-11-30 | 2018-06-19 | 东南大学 | 一种北斗双天线旋转快速定向方法 |
CN109490932A (zh) * | 2018-12-26 | 2019-03-19 | 上海司南卫星导航技术股份有限公司 | 判断rtk定向结果可靠性的方法、oem板卡、接收机及存储介质 |
CN109613585A (zh) * | 2018-12-14 | 2019-04-12 | 中国科学院国家授时中心 | 一种对基站天线超短基线gnss双天线实时测向的方法 |
CN109669196A (zh) * | 2019-02-21 | 2019-04-23 | 哈尔滨工程大学 | 一种顾及基线形变的多天线gnss载波相位精密测姿方法 |
CN109975849A (zh) * | 2017-12-28 | 2019-07-05 | 中移物联网有限公司 | 一种基线向量的确定方法、服务器和计算机存储介质 |
CN110068847A (zh) * | 2019-04-01 | 2019-07-30 | 和芯星通科技(北京)有限公司 | 一种gnss多天线接收机定位测姿的方法和装置 |
CN110673182A (zh) * | 2019-09-29 | 2020-01-10 | 清华大学 | 一种gnss高精度快速定位方法及装置 |
CN111077554A (zh) * | 2019-12-05 | 2020-04-28 | 中国科学院西安光学精密机械研究所 | 一种基于车载经纬仪的自定位系统及方法 |
CN111221016A (zh) * | 2020-02-15 | 2020-06-02 | 江苏大学 | 一种六天线短基线gnss快速定向装置及方法 |
WO2020113391A1 (zh) * | 2018-12-03 | 2020-06-11 | 深圳市大疆创新科技有限公司 | 航向的确定方法、设备、存储介质和可移动平台 |
CN111913203A (zh) * | 2020-07-08 | 2020-11-10 | 北京航空航天大学 | 一种动态基线定位域监测方法 |
CN114339993A (zh) * | 2022-03-16 | 2022-04-12 | 北京瑞迪时空信息技术有限公司 | 基于天线距离约束的陆基定位方法、装置、设备和介质 |
CN115200614A (zh) * | 2022-09-16 | 2022-10-18 | 北京路凯智行科技有限公司 | 矿用无人驾驶车辆的导航定位系统的故障定位方法 |
CN116381754A (zh) * | 2023-03-09 | 2023-07-04 | 广州市泰粤科技股份有限公司 | 北斗差分360度大型起重吊机智能监控系统及方法 |
CN117250646A (zh) * | 2023-11-17 | 2023-12-19 | 毫厘智能科技(江苏)有限公司 | 基于芯片的测向方法及装置、芯片模组及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102565834A (zh) * | 2011-11-30 | 2012-07-11 | 重庆九洲星熠导航设备有限公司 | 一种单频gps测向系统及其测向定位方法 |
CN104297772A (zh) * | 2013-07-16 | 2015-01-21 | 成都国星通信有限公司 | 基于载波相位差分的双天线一体式定位定向系统及方法 |
CN105403904A (zh) * | 2015-11-26 | 2016-03-16 | 中国航天时代电子公司 | 一种基于天线阵列的卫星导航单频测姿方法 |
CN106289154A (zh) * | 2016-07-19 | 2017-01-04 | 中国科学院重庆绿色智能技术研究院 | 一种通信基站天线方位角监测方法 |
CN107110979A (zh) * | 2014-12-26 | 2017-08-29 | 古野电气株式会社 | 姿态角计算装置、姿态角计算方法及姿态角计算程序 |
-
2017
- 2017-06-07 CN CN201710421244.0A patent/CN107272039B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102565834A (zh) * | 2011-11-30 | 2012-07-11 | 重庆九洲星熠导航设备有限公司 | 一种单频gps测向系统及其测向定位方法 |
CN104297772A (zh) * | 2013-07-16 | 2015-01-21 | 成都国星通信有限公司 | 基于载波相位差分的双天线一体式定位定向系统及方法 |
CN107110979A (zh) * | 2014-12-26 | 2017-08-29 | 古野电气株式会社 | 姿态角计算装置、姿态角计算方法及姿态角计算程序 |
CN105403904A (zh) * | 2015-11-26 | 2016-03-16 | 中国航天时代电子公司 | 一种基于天线阵列的卫星导航单频测姿方法 |
CN106289154A (zh) * | 2016-07-19 | 2017-01-04 | 中国科学院重庆绿色智能技术研究院 | 一种通信基站天线方位角监测方法 |
Non-Patent Citations (1)
Title |
---|
王闪闪: "GPS单基线姿态测量系统研究", 《中国优秀硕士学位论文全文数据库 基础科学辑》 * |
Cited By (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108181630A (zh) * | 2017-11-30 | 2018-06-19 | 东南大学 | 一种北斗双天线旋转快速定向方法 |
CN108181630B (zh) * | 2017-11-30 | 2020-11-03 | 东南大学 | 一种北斗双天线旋转快速定向方法 |
CN108107459A (zh) * | 2017-12-11 | 2018-06-01 | 浙江捷尚人工智能研究发展有限公司 | 基于导航系统的机器人方位检测方法、装置及系统 |
CN109975849A (zh) * | 2017-12-28 | 2019-07-05 | 中移物联网有限公司 | 一种基线向量的确定方法、服务器和计算机存储介质 |
WO2020113391A1 (zh) * | 2018-12-03 | 2020-06-11 | 深圳市大疆创新科技有限公司 | 航向的确定方法、设备、存储介质和可移动平台 |
CN111295567A (zh) * | 2018-12-03 | 2020-06-16 | 深圳市大疆创新科技有限公司 | 航向的确定方法、设备、存储介质和可移动平台 |
CN109613585A (zh) * | 2018-12-14 | 2019-04-12 | 中国科学院国家授时中心 | 一种对基站天线超短基线gnss双天线实时测向的方法 |
CN109490932A (zh) * | 2018-12-26 | 2019-03-19 | 上海司南卫星导航技术股份有限公司 | 判断rtk定向结果可靠性的方法、oem板卡、接收机及存储介质 |
CN109669196A (zh) * | 2019-02-21 | 2019-04-23 | 哈尔滨工程大学 | 一种顾及基线形变的多天线gnss载波相位精密测姿方法 |
CN109669196B (zh) * | 2019-02-21 | 2022-07-12 | 哈尔滨工程大学 | 一种顾及基线形变的多天线gnss载波相位精密测姿方法 |
CN110068847A (zh) * | 2019-04-01 | 2019-07-30 | 和芯星通科技(北京)有限公司 | 一种gnss多天线接收机定位测姿的方法和装置 |
CN110673182A (zh) * | 2019-09-29 | 2020-01-10 | 清华大学 | 一种gnss高精度快速定位方法及装置 |
CN110673182B (zh) * | 2019-09-29 | 2021-07-06 | 清华大学 | 一种gnss高精度快速定位方法及装置 |
CN111077554A (zh) * | 2019-12-05 | 2020-04-28 | 中国科学院西安光学精密机械研究所 | 一种基于车载经纬仪的自定位系统及方法 |
CN111221016A (zh) * | 2020-02-15 | 2020-06-02 | 江苏大学 | 一种六天线短基线gnss快速定向装置及方法 |
CN111221016B (zh) * | 2020-02-15 | 2022-09-16 | 江苏大学 | 一种六天线短基线gnss快速定向装置及方法 |
CN111913203A (zh) * | 2020-07-08 | 2020-11-10 | 北京航空航天大学 | 一种动态基线定位域监测方法 |
CN111913203B (zh) * | 2020-07-08 | 2023-01-10 | 北京航空航天大学 | 一种动态基线定位域监测方法 |
CN114339993A (zh) * | 2022-03-16 | 2022-04-12 | 北京瑞迪时空信息技术有限公司 | 基于天线距离约束的陆基定位方法、装置、设备和介质 |
CN114339993B (zh) * | 2022-03-16 | 2022-06-28 | 北京瑞迪时空信息技术有限公司 | 基于天线距离约束的陆基定位方法、装置、设备和介质 |
CN115200614A (zh) * | 2022-09-16 | 2022-10-18 | 北京路凯智行科技有限公司 | 矿用无人驾驶车辆的导航定位系统的故障定位方法 |
CN115200614B (zh) * | 2022-09-16 | 2022-12-23 | 北京路凯智行科技有限公司 | 矿用无人驾驶车辆的导航定位系统的故障定位方法 |
CN116381754A (zh) * | 2023-03-09 | 2023-07-04 | 广州市泰粤科技股份有限公司 | 北斗差分360度大型起重吊机智能监控系统及方法 |
CN116381754B (zh) * | 2023-03-09 | 2023-09-05 | 广州市泰粤科技股份有限公司 | 北斗差分360度大型起重吊机智能监控系统及方法 |
CN117250646A (zh) * | 2023-11-17 | 2023-12-19 | 毫厘智能科技(江苏)有限公司 | 基于芯片的测向方法及装置、芯片模组及存储介质 |
CN117250646B (zh) * | 2023-11-17 | 2024-02-02 | 毫厘智能科技(江苏)有限公司 | 基于芯片的测向方法及装置、芯片模组及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN107272039B (zh) | 2019-10-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107272039A (zh) | 一种基于双天线gps的定位测姿方法 | |
CN102230971B (zh) | Gps多天线测姿方法 | |
CN107390250B (zh) | 一种基于惯性导航系统和双天线gps的定位测姿方法 | |
CN106990424B (zh) | 一种双天线gps测姿方法 | |
US7292185B2 (en) | Attitude determination exploiting geometry constraints | |
CN100535683C (zh) | 用于超短基线声学定位系统的校准方法 | |
CN105807300B (zh) | 一种用北斗双频接收机进行高精度动态单点定位的方法 | |
Han et al. | Single-epoch ambiguity resolution for real-time GPS attitude determination with the aid of one-dimensional optical fiber gyro | |
CN102565834B (zh) | 一种单频gps测向系统及其测向定位方法 | |
CN102998690B (zh) | 一种基于gps载波双差方程的姿态角直接求解方法 | |
CN107064980A (zh) | 载波相位模糊度固定方法和装置、卫星导航接收机 | |
CN104714244A (zh) | 一种基于抗差自适应Kalman滤波的多系统动态PPP解算方法 | |
CN101403790A (zh) | 单频gps接收机的精密单点定位方法 | |
CN103076618A (zh) | 一种星载测量型gnss接收机地面验证和性能评测方法 | |
CN102116867A (zh) | 一种在动态环境下探测并修复gps载波相位周跳的方法 | |
CN105158783A (zh) | 一种实时动态差分定位方法及其设备 | |
CN105510945A (zh) | 一种应用于卫导着陆外场检测的ppp定位方法 | |
CN104049269A (zh) | 一种基于激光测距和mems/gps组合导航系统的目标导航测绘方法 | |
CN107991676A (zh) | 星载单航过InSAR系统对流层误差校正方法 | |
CN103017787A (zh) | 适用于摇摆晃动基座的初始对准方法 | |
CN103926608A (zh) | 一种gnss测量装置的倾斜补偿方法 | |
CN107121689A (zh) | Glonass频间偏差单历元快速估计方法 | |
JP2008039691A (ja) | 搬送波位相式測位装置 | |
CN105372692A (zh) | 一种北斗测姿接收机的快速整周模糊度方法 | |
CN109613582A (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 | ||
CB02 | Change of applicant information |
Address after: 401220 No. 6 Xinmin Road, Xinshi Street, Changshou District, Chongqing Applicant after: Chongqing Zhongyou Huice Communication Technology Co., Ltd. Address before: 401121 Chongqing North New District Yubei District high tech Park mercury science and Technology Development Center North Wing 5 floor Applicant before: Chongqing Zhongyou Huice Communication Technology Co., Ltd. |
|
CB02 | Change of applicant information | ||
GR01 | Patent grant | ||
GR01 | Patent grant |