CN106990424B - 一种双天线gps测姿方法 - Google Patents

一种双天线gps测姿方法 Download PDF

Info

Publication number
CN106990424B
CN106990424B CN201710421258.2A CN201710421258A CN106990424B CN 106990424 B CN106990424 B CN 106990424B CN 201710421258 A CN201710421258 A CN 201710421258A CN 106990424 B CN106990424 B CN 106990424B
Authority
CN
China
Prior art keywords
antenna
difference
satellite
receiver
coordinates
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
Application number
CN201710421258.2A
Other languages
English (en)
Other versions
CN106990424A (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.)
Chongqing Huamu Network Technology Co ltd
Original Assignee
Chongqing Chongyou Huice Communication 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 Chongqing Chongyou Huice Communication Technology Co ltd filed Critical Chongqing Chongyou Huice Communication Technology Co ltd
Priority to CN201710421258.2A priority Critical patent/CN106990424B/zh
Publication of CN106990424A publication Critical patent/CN106990424A/zh
Application granted granted Critical
Publication of CN106990424B publication Critical patent/CN106990424B/zh
Expired - Fee Related 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/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/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/53—Determining attitude
    • G01S19/54—Determining attitude using carrier phase measurements; using long or short baseline interferometry
    • G01S19/55—Carrier phase ambiguity resolution; Floating ambiguity; LAMBDA [Least-squares AMBiguity Decorrelation Adjustment] method

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

为解决现有技术存在的测姿数据精度较低和花费较长的搜索时间等问题，本发明提出一种双天线GPS测姿方法，在测姿载体上呈几何分布设置两个GPS信号接收天线且对应设置两台接收机，采用GPS系统3R定位法确定天线Ⅰ的位置坐标，将天线Ⅰ的位置坐标定为概略坐标并对其进行修正，确定整周模糊度的值，然后，解算天线Ⅱ的位置坐标，最后，根据定位出的天线Ⅰ的位置坐标和天线Ⅱ的位置坐标确定测姿载体的偏航角和俯仰角，即进行测姿载体的姿态角解算。本发明的有益技术效果对天线Ⅰ的位置坐标进行了修正，提高了定位精度；采用波长对整周模糊度的搜索区间进行限制，降低了整周模糊度的搜索范围和时间复杂度，从而提高了测姿的精确度和及时性。

Description

一种双天线GPS测姿方法
技术领域
本发明涉及利用卫星导航系统对载体进行姿态解算的方法，具体涉及到一种双天线GPS测姿方法。
背景技术
为了满足不同应用平台对姿态信息的需求，目前已有大量的姿态测量设备问世。例如，用于空间载体姿态测量的星敏感器、地平跟踪器、太阳敏感器和地磁仪等；用于为陆上或水下载体提供航向的磁罗盘、电磁罗盘；用于为各种飞行器、陆上运输设备、舰船、潜器、空间载体提供姿态信息的惯性器件等等。然而，在对姿态角及姿态变化率进行测量的过程中，上述各种姿态测量设备均存在一定的问题。光学和红外线仪器主要用于低动态和静态平台监测，例如星敏感器可以同时得到多颗观测星的视赤经、赤纬以及对应在像平面的位置信息，解算出载体在惯性系中的三轴姿态，并且可靠性高，隐蔽性好，精度不随时间变化。但星敏感器易受天气、地形或者其它客观因素的影响，不能实时地给出姿态或方位值。目前，高精度的实时姿态测量系统大都采用由陀螺和加速度计组成的惯性系统来实现，这种系统是自主导航系统，不受外界干扰，具有良好的隐蔽性和较强的高频动态测量能力，但其结构复杂、价格昂贵，当工作时间较长时惯性器件误差会随时间积累而引起测姿精度的降低。
GPS在全球范围内的三维精确定位、测时、测速和测定姿态的能力，使其成为先进的导航系统，受到了各国军方的重视，在卫星导航应用技术上投入了大量研究资源，以期提高武器装备的信息含量。GPS测姿系统只需要利用低成本的接收机即可以提供较高精度的姿态信息，以此来取代造价昂贵的传统测姿设备，同时还可以完成运载体的定位和授时，并且受环境的影响小，能够长时间进行高精度测姿任务，这使得GPS姿态测量成为近几年研究的热点之一。利用GPS载波相位观测量进行定向和定姿的研究为GPS开辟了又一个新的应用领域。
基于GPS双天线测姿系统具有传统的姿态系统所没有的优点，不仅能提供载体的位置、航向、速度等基本信息，而且能提供载体的偏航角和俯仰角。但是，在现有技术GPS双天线测姿方法中，没有对GPS定位数据进行修正，也没有对整周模糊度进行限制，以此得到的测姿数据精度相对较低，并且，整周模糊度的搜索范围较大，需要花费较长的搜索时间。显然，现有技术GPS双天线测姿方法存在着测姿数据精度相对较低和花费较长的整周模糊度搜索时间等问题。
发明内容
为解决现有技术GPS双天线测姿方法存在的测姿数据精度相对较低和花费较长的整周模糊度搜索时间等问题，本发明提出一种双天线GPS测姿方法。
本发明双天线GPS测姿方法，在测姿载体上呈几何分布设置两个GPS信号接收天线且对应设置两台接收机，采用GPS系统3R定位法确定天线Ⅰ的位置坐标，将天线Ⅰ的位置坐标定为概略坐标并对其进行修正，确定整周模糊度的值，然后，解算天线Ⅱ的位置坐标，最后，根据定位出的天线Ⅰ的位置坐标和天线Ⅱ的位置坐标确定测姿载体的偏航角和俯仰角，即进行测姿载体的姿态角解算。
进一步的，本发明双天线GPS测姿方法，包括以下步骤：
S1、在测姿载体上呈几何分布设置两个GPS信号接收天线且对应设置两台接收机，即天线Ⅰ和天线Ⅱ，接收机Ⅰ和接收机Ⅱ；
S2、利用GPS系统3R定位法确定天线Ⅰ的位置坐标；
S3、将天线Ⅰ的位置坐标设定为概略坐标，根据伪距线性误差方程对天线Ⅰ的位置坐标进行修正；
S4、根据天线Ⅰ与天线Ⅱ之间的基线长度与载波波长的关系确定整周模糊度搜索范围，再进一步确定整周模糊度的值；
S5、将修正后的天线Ⅰ的位置坐标作为天线Ⅱ位置坐标的概略坐标，根据双差，最小二乘法定位出天线Ⅱ的位置坐标；
S6、根据定位出的天线Ⅰ的位置坐标和天线Ⅱ位置坐标确定测姿载体的偏航角和俯仰角，即进行测姿载体的姿态角解算。
进一步的，所述步骤S2中利用GPS系统3R定位法确定天线Ⅰ的位置坐标，包括，通过空间中三颗卫星为原点以各自到接收机Ⅰ的距离为半径得到三个球面的相交点，确定天线Ⅰ位置坐标在空间中的位置；设天线Ⅰ利用到达时间分别测定GPS系统中的三颗卫星S1、S2和S3到天线Ⅰ位置的分别距离为P1、P2和P3；天线Ⅰ的接收机Ⅰ利用导航电文计算得到S1、S2和S3三颗卫星的位置分别为(x1,y1,z1),(x2,y2,z2)和(x3,y3,z3)；根据距离交汇法求解天线Ⅰ三维坐标的观测方程为：
Figure GDA0002353841190000021
Figure GDA0002353841190000022
Figure GDA0002353841190000023
其中，(x,y,z)为天线Ⅰ的坐标位置；根据上式解算出的天线Ⅰ位置坐标为(x1,y1,z1)。
进一步的，所述步骤S3中，将天线Ⅰ的位置坐标设定为概略坐标，根据伪距线性误差方程对天线Ⅰ的位置坐标进行修正，包括，
将步骤S2解算出的天线Ⅰ的位置坐标(x1,y1,z1)设定为概略坐标(x’1,y’1,z’1)，设概略位置与真实位置之间的偏移记为(Δx,Δy,Δz)，可得伪距定位线性误差方程为：
Figure GDA0002353841190000031
其中，
Figure GDA0002353841190000032
为卫星到接收机Ⅰ概略位置的距离；(xi,yi,zi)表示卫星坐标；伪距定位线性误差方程中共四个未知量，当同时观测到四颗以上的卫星时，建立四个伪距定位线性误差方程，联立方程组，便可以解算出(Δx,Δy,Δz)，完成对天线1的坐标修正，其方程组为：
Figure GDA0002353841190000033
解算该方程组得到修正后的天线Ⅰ的位置坐标(x1',y'1,z'1)。
进一步的，所述步骤S4中，根据天线Ⅰ与天线Ⅱ之间的基线长度与载波波长的关系确定整周模糊度搜索范围，再进一步确定整周模糊度的值，包括，设在时刻t，接收机Ⅰ和接收机Ⅱ同步观测到卫星j，得到两个载波观测方程；
Figure GDA0002353841190000034
Figure GDA0002353841190000035
Figure GDA0002353841190000036
式中，
Figure GDA0002353841190000037
是接收机Ⅰ和接收机Ⅱ与卫星j的载波观测差值，
Figure GDA0002353841190000038
是接收机Ⅰ和接收机Ⅱ与卫星j的伪距差值，Δt12(t)是两接收机的钟差，
Figure GDA0002353841190000039
为两接收机与卫星j的整周模糊度差值；单差后可以消除卫星的钟差、大部分的对流层和电离层误差，
Figure GDA00023538411900000310
剩余的只是接收机的钟差和未消除的多路径误差；
再让接收机Ⅰ和接收机Ⅱ同时观测卫星k，将再次得到的单差方程与上面的公式进行作差，得到的双差方程如下公式：
Figure GDA00023538411900000311
式中，
Figure GDA0002353841190000041
表示双差运算，
Figure GDA0002353841190000042
表示载波双差观测值的小数部分,
Figure GDA0002353841190000043
为天线Ⅰ和天线Ⅱ到卫星j和卫星k之间真实距离的双差值，
Figure GDA0002353841190000044
为双差整周模糊度，
Figure GDA0002353841190000045
为双差载波相位观测噪声；在短基线定向中
Figure GDA0002353841190000046
可以表示为：
Figure GDA0002353841190000047
b为天线Ⅰ和天线Ⅱ所构成的基线矢量，Sj和Sk分别是接收机到卫星j和k的单位矢量，其中，卫星k为参考卫星；
由此得到：
Figure GDA0002353841190000048
由于天线Ⅰ和天线Ⅱ之间的基线长度小于载波波长的1/2，
Figure GDA0002353841190000049
得出：
Figure GDA00023538411900000410
Figure GDA00023538411900000411
Figure GDA00023538411900000412
Figure GDA00023538411900000413
Figure GDA00023538411900000414
Figure GDA00023538411900000415
对
Figure GDA00023538411900000416
进行取整，使得整周模糊度的搜索范围大大降低，将上面取整得到的整数值分别带入式中，求得基线长度最接近实际基线长度的整周模糊度值，该值即为整周模糊度的值。
进一步的，所述步骤S5中，将修正后的天线Ⅰ的位置坐标作为天线Ⅱ位置坐标的概略坐标，根据双差，最小二乘法定位出天线Ⅱ的位置坐标，包括，设接收机Ⅰ为基准站，天线Ⅰ为主天线，接收机Ⅱ为流动站，天线Ⅱ为从天线，将修正后的天线Ⅰ的位置坐标(x’1,y’1,z’1)作为天线Ⅱ的概略坐标，设天线Ⅱ的概略坐标为(x’2,y’2,z’2)，其中，(x’2,y’2,z’2)＝(x’1,y’1,z’1)，真实坐标为(x2,y2,z2)，概略坐标与真实坐标的偏移记为(ΔX’,ΔY’,ΔZ’)；将天线Ⅱ与卫星j和k之间的距离
Figure GDA00023538411900000417
和
Figure GDA00023538411900000418
分别线性化：
Figure GDA00023538411900000419
Figure GDA0002353841190000051
式中，
Figure GDA0002353841190000052
为卫星j到接收机Ⅱ概略位置的距离；
Figure GDA0002353841190000053
为卫星k到接收机Ⅱ概略位置的距离；因为基线长度远远小于天线与卫星的距离，因此，选用天线Ⅰ的坐标作为天线Ⅱ的概略坐标，式中(x’2,y’2,z’2)为天线Ⅱ的概略坐标，即为步骤S3中求出的天线Ⅰ的修正后位置坐标(x’1,y’1,z’1)，
Figure GDA0002353841190000054
和
Figure GDA0002353841190000055
分别为概略坐标到卫星j和k的计算距离；
令
Figure GDA0002353841190000056
式中，l,m,n表示天线Ⅱ指向卫星的方向余弦参数；
整理得到：
Figure GDA0002353841190000057
所以得出
Figure GDA0002353841190000058
Figure GDA0002353841190000059
其中，(Δx,Δy,Δz)为天线Ⅰ概略位置与真实位置之间的偏移，
Figure GDA00023538411900000510
两台接收机共同观测的卫星数目为n，确定其中一颗卫星作为进行双差观测的基本量，可以得到(n-1)个双差方程，将这些双差方程联立得到一个矩阵方程Y＝HX-λN+V，其中，H为观测矩阵，由天线指向卫星的余弦参数双差值构成；X为天线Ⅱ坐标修正量X＝(Δx’,Δy’,Δz’)；N为两天线对于各卫星的双差整周模糊度向量；Y为已知向量，由天线Ⅰ的位置坐标及天线Ⅱ的位置坐标到卫星的距离双差值和载波观测双差值构成；在步骤S4中已经确定双差整周模糊度的值，利用最小二乘方法，可以计算X，X＝(HTH)-1HTY，因此，可以解得天线Ⅱ的位置坐标修正量，确定出天线Ⅱ的位置坐标。
进一步的，所述步骤S6中，根据定位出的天线Ⅰ的位置坐标和天线Ⅱ位置坐标确定测姿载体的偏航角和俯仰角，即进行姿态解算，包括，设天线Ⅰ为点A，天线Ⅱ为点B，天线Ⅱ与天线Ⅱ组成向量
Figure GDA00023538411900000511
设偏航角为
Figure GDA00023538411900000512
俯仰角为θ，则：
Δx＝x2-x1
Δy＝y2-y1
Δz＝z2-z1
Figure GDA0002353841190000061
Figure GDA0002353841190000062
式中，(x1,y1,z1)为天线Ⅰ的位置坐标，(x2,y2,z2)为天线Ⅱ的位置坐标；由上述公式可以解算出偏航角
Figure GDA0002353841190000063
俯仰角θ，从而完成测姿载体的姿态角解算。
本发明双天线GPS测姿方法的有益技术效果是先对天线Ⅰ的位置坐标进行了修正，在一定程度上提高了定位精度；其次，在整周模糊度值的确定上，采用波长对整周模糊度的搜索区间进行限制，降低了整周模糊度的搜索范围和时间复杂度；在此基础上完成测姿载体的姿态角解算，从而提高了测姿的精确度和及时性。
附图说明
附图1为测姿载体的三维姿态示意图；
附图2为测姿载体的姿态角示意图。
下面结合附图对本发明双天线GPS测姿方法作进一步的说明。
具体实施方式
显而易见地，下面描述中的附图仅仅是本发明的一些实施例，应当理解，此处所描述的优选实施例仅用于说明和解释本发明，并不用于限定本发明。
附图1为测姿载体的三维姿态示意图，附图2为测姿载体的姿态角示意图。由图可知，本发明双天线GPS测姿方法，在测姿载体上呈几何分布设置两个GPS信号接收天线且对应设置两台接收机，采用GPS系统3R定位法确定天线Ⅰ的位置坐标，将天线Ⅰ的位置坐标定为概略坐标并对其进行修正，确定整周模糊度的值，然后，解算天线Ⅱ的位置坐标，最后，根据定位出的天线Ⅰ的位置坐标和天线Ⅱ的位置坐标确定测姿载体的偏航角和俯仰角，即进行测姿载体的姿态角解算。
本发明双天线GPS测姿方法，包括以下步骤：
S1、在测姿载体上呈几何分布设置两个GPS信号接收天线且对应设置两台接收机，即天线Ⅰ和天线Ⅱ，接收机Ⅰ和接收机Ⅱ；
S2、利用GPS系统3R定位法确定天线Ⅰ的位置坐标；
S3、将天线Ⅰ的位置坐标设定为概略坐标，根据伪距线性误差方程对天线Ⅰ的位置坐标进行修正；
S4、根据天线Ⅰ与天线Ⅱ之间的基线长度与载波波长的关系确定整周模糊度搜索范围，再进一步确定整周模糊度的值；
S5、将修正后的天线Ⅰ的位置坐标作为天线Ⅱ位置坐标的概略坐标，根据双差，最小二乘法定位出天线Ⅱ的位置坐标；
S6、根据定位出的天线Ⅰ的位置坐标和天线Ⅱ位置坐标确定测姿载体的偏航角和俯仰角，即进行测姿载体的姿态角解算。
作为优选，所述步骤S2中利用GPS系统3R定位法确定天线Ⅰ的位置坐标，包括，通过空间中三颗卫星为原点以各自到接收机Ⅰ的距离为半径得到三个球面的相交点，确定天线Ⅰ位置坐标在空间中的位置；设天线Ⅰ利用到达时间分别测定GPS系统中的三颗卫星S1、S2和S3到天线Ⅰ位置的分别距离为P1、P2和P3；天线Ⅰ的接收机Ⅰ利用导航电文计算得到S1、S2和S3三颗卫星的位置分别为(x1,y1,z1),(x2,y2,z2)和(x3,y3,z3)；根据距离交汇法求解天线Ⅰ三维坐标的观测方程为：
Figure GDA0002353841190000071
Figure GDA0002353841190000072
Figure GDA0002353841190000073
其中，(x,y,z)为天线Ⅰ的坐标位置；根据上式解算出的天线Ⅰ位置坐标为(x1,y1,z1)。
作为优选，所述步骤S3中，将天线Ⅰ的位置坐标设定为概略坐标，根据伪距线性误差方程对天线Ⅰ的位置坐标进行修正，包括，
将步骤S2解算出的天线Ⅰ的位置坐标(x1,y1,z1)设定为概略坐标(x’1,y’1,z’1)，设概略位置与真实位置之间的偏移记为(Δx,Δy,Δz)，可得伪距定位线性误差方程为：
Figure GDA0002353841190000074
其中，
Figure GDA0002353841190000075
为卫星到接收机Ⅰ概略位置的距离；(xi,yi,zi)表示卫星坐标；伪距定位线性误差方程中共四个未知量，当同时观测到四颗以上的卫星时，建立四个伪距定位线性误差方程，联立方程组，便可以解算出(Δx,Δy,Δz)，完成对天线1的坐标修正，其方程组为：
Figure GDA0002353841190000076
解算该方程组得到修正后的天线Ⅰ的位置坐标(x’1,y’1,z’1)。
作为优选，所述步骤S4中，根据天线Ⅰ与天线Ⅱ之间的基线长度与载波波长的关系确定整周模糊度搜索范围，再进一步确定整周模糊度的值，包括，设在时刻t，接收机Ⅰ和接收机Ⅱ同步观测到卫星j，得到两个载波观测方程；
Figure GDA0002353841190000081
Figure GDA0002353841190000082
Figure GDA0002353841190000083
式中，
Figure GDA0002353841190000084
是接收机Ⅰ和接收机Ⅱ与卫星j的载波观测差值，
Figure GDA0002353841190000085
是接收机Ⅰ和接收机Ⅱ与卫星j的伪距差值，Δt12(t)是两接收机的钟差，
Figure GDA0002353841190000086
为两接收机与卫星j的整周模糊度差值；单差后可以消除卫星的钟差、大部分的对流层和电离层误差，
Figure GDA0002353841190000087
剩余的只是接收机的钟差和未消除的多路径误差；
再让接收机Ⅰ和接收机Ⅱ同时观测卫星k，将再次得到的单差方程与上面的公式进行作差，得到的双差方程如下公式：
Figure GDA0002353841190000088
式中，
Figure GDA0002353841190000089
表示双差运算，
Figure GDA00023538411900000810
表示载波双差观测值的小数部分,
Figure GDA00023538411900000811
为天线Ⅰ和天线Ⅱ到卫星j和卫星k之间真实距离的双差值，
Figure GDA00023538411900000812
为双差整周模糊度，
Figure GDA00023538411900000813
为双差载波相位观测噪声；在短基线定向中
Figure GDA00023538411900000814
可以表示为：
Figure GDA00023538411900000815
b为天线Ⅰ和天线Ⅱ所构成的基线矢量，Sj和Sk分别是接收机到卫星j和k的单位矢量，其中，卫星k为参考卫星；
由此得到：
Figure GDA00023538411900000816
由于天线Ⅰ和天线Ⅱ之间的基线长度小于载波波长的1/2，
Figure GDA00023538411900000817
得出：
Figure GDA00023538411900000818
Figure GDA00023538411900000819
Figure GDA00023538411900000820
Figure GDA00023538411900000821
Figure GDA0002353841190000091
Figure GDA0002353841190000092
对
Figure GDA0002353841190000093
进行取整，使得整周模糊度的搜索范围大大降低，将上面取整得到的整数值分别带入式中，求得基线长度最接近实际基线长度的整周模糊度值，该值即为整周模糊度的值。
作为优选，所述步骤S5中，将修正后的天线Ⅰ的位置坐标作为天线Ⅱ位置坐标的概略坐标，根据双差，最小二乘法定位出天线Ⅱ的位置坐标，包括，设接收机Ⅰ为基准站，天线Ⅰ为主天线，接收机Ⅱ为流动站，天线Ⅱ为从天线，将修正后的天线Ⅰ的位置坐标(x’1,y’1,z’1)作为天线Ⅱ的概略坐标，设天线Ⅱ的概略坐标为(x’2,y’2,z’2)，其中，(x’2,y’2,z’2)＝(x’1,y’1,z’1)，真实坐标为(x2,y2,z2)，概略坐标与真实坐标的偏移记为(ΔX’,ΔY’,ΔZ’)；将天线Ⅱ与卫星j和k之间的距离
Figure GDA0002353841190000094
和
Figure GDA0002353841190000095
分别线性化：
Figure GDA0002353841190000096
Figure GDA0002353841190000097
式中，
Figure GDA0002353841190000098
为卫星j到接收机Ⅱ概略位置的距离；
Figure GDA0002353841190000099
为卫星k到接收机Ⅱ概略位置的距离；因为基线长度远远小于天线与卫星的距离，因此，选用天线Ⅰ的坐标作为天线Ⅱ的概略坐标，式中(x’2,y’2,z’2)为天线Ⅱ的概略坐标，即为步骤S3中求出的天线Ⅰ的修正后位置坐标(x’1,y’1,z’1)，
Figure GDA00023538411900000910
和
Figure GDA00023538411900000911
分别为概略坐标到卫星j和k的计算距离；
令
Figure GDA00023538411900000912
式中，l,m,n表示天线Ⅱ指向卫星的方向余弦参数；
整理得到：
Figure GDA00023538411900000913
所以得出
Figure GDA00023538411900000914
Figure GDA00023538411900000915
其中，(Δx,Δy,Δz)为天线Ⅰ概略位置与真实位置之间的偏移，
Figure GDA00023538411900000916
两台接收机共同观测的卫星数目为n，确定其中一颗卫星作为进行双差观测的基本量，可以得到(n-1)个双差方程，将这些双差方程联立得到一个矩阵方程Y＝HX-λN+V，其中，H为观测矩阵，由天线指向卫星的余弦参数双差值构成；X为天线Ⅱ坐标修正量X＝(Δx’,Δy’,Δz’)；N为两天线对于各卫星的双差整周模糊度向量；Y为已知向量，由天线Ⅰ的位置坐标及天线Ⅱ的位置坐标到卫星的距离双差值和载波观测双差值构成；在步骤S4中已经确定双差整周模糊度的值，利用最小二乘方法，可以计算X，X＝(HTH)-1HTY，因此，可以解得天线Ⅱ的位置坐标修正量，确定出天线Ⅱ的位置坐标。
作为优选，所述步骤S6中，根据定位出的天线Ⅰ的位置坐标和天线Ⅱ位置坐标确定测姿载体的偏航角和俯仰角，即进行姿态解算，包括，设天线Ⅰ为点A，天线Ⅱ为点B，天线Ⅱ与天线Ⅱ组成向量
Figure GDA0002353841190000101
设偏航角为
Figure GDA0002353841190000102
俯仰角为θ，则：
Δx＝x2-x1
Δy＝y2-y1
Δz＝z2-z1
Figure GDA0002353841190000103
Figure GDA0002353841190000104
式中，(x1,y1,z1)为天线Ⅰ的位置坐标，(x2,y2,z2)为天线Ⅱ的位置坐标；由上述公式可以解算出偏航角
Figure GDA0002353841190000105
俯仰角θ，从而完成测姿载体的姿态角解算。
显然，本发明双天线GPS测姿方法的有益技术效果是先对天线Ⅰ的位置坐标进行了修正，在一定程度上提高了定位精度；其次，在整周模糊度值的确定上，采用波长对整周模糊度的搜索区间进行限制，降低了整周模糊度的搜索范围和时间复杂度；在此基础上完成测姿载体的姿态角解算，从而提高了测姿的精确度和及时性。

Claims (5)

1.一种双天线GPS测姿方法，其特征在于，在测姿载体上呈几何分布设置两个GPS信号接收天线且对应设置两台接收机，采用GPS系统3R定位法确定天线Ⅰ的位置坐标，将天线Ⅰ的位置坐标定为概略坐标并对其进行修正，确定整周模糊度的值，然后，解算天线Ⅱ的位置坐标，最后，根据定位出的天线Ⅰ的位置坐标和天线Ⅱ的位置坐标确定测姿载体的偏航角和俯仰角，即进行测姿载体的姿态角解算；包括以下步骤：
S1、在测姿载体上呈几何分布设置两个GPS信号接收天线且对应设置两台接收机，即天线Ⅰ和天线Ⅱ，接收机Ⅰ和接收机Ⅱ；
S2、利用GPS系统3R定位法确定天线Ⅰ的位置坐标；
S3、将天线Ⅰ的位置坐标设定为概略坐标，根据伪距线性误差方程对天线Ⅰ的位置坐标进行修正；
S4、根据天线Ⅰ与天线Ⅱ之间的基线长度与载波波长的关系确定整周模糊度搜索范围，再进一步确定整周模糊度的值；
S5、将修正后的天线Ⅰ的位置坐标作为天线Ⅱ位置坐标的概略坐标，根据双差，最小二乘法定位出天线Ⅱ的位置坐标；
S6、根据定位出的天线Ⅰ的位置坐标和天线Ⅱ位置坐标确定测姿载体的偏航角和俯仰角，即进行测姿载体的姿态角解算；
其中，所述步骤S4中，根据天线Ⅰ与天线Ⅱ之间的基线长度与载波波长的关系确定整周模糊度搜索范围，再进一步确定整周模糊度的值，包括，设在时刻t，接收机Ⅰ和接收机Ⅱ同步观测到卫星j，得到两个载波观测方程；
Figure FDA0002447591220000011
Figure FDA0002447591220000012
Figure FDA0002447591220000013
式中，
Figure FDA0002447591220000014
是接收机Ⅰ和接收机Ⅱ与卫星j的载波观测差值，
Figure FDA0002447591220000015
是接收机Ⅰ和接收机Ⅱ与卫星j的伪距差值，Δt12(t)是两接收机的钟差，
Figure FDA0002447591220000016
为两接收机与卫星j的整周模糊度差值；单差后可以消除卫星的钟差、大部分的对流层和电离层误差，
Figure FDA0002447591220000017
剩余的只是接收机的钟差和未消除的多路径误差；
再让接收机Ⅰ和接收机Ⅱ同时观测卫星k，将再次得到的单差方程与上面的公式进行作差，得到的双差方程如下公式：
Figure FDA0002447591220000021
式中，
Figure FDA0002447591220000022
表示双差运算，
Figure FDA0002447591220000023
表示载波双差观测值的小数部分,
Figure FDA0002447591220000024
为天线Ⅰ和天线Ⅱ到卫星j和卫星k之间真实距离的双差值，
Figure FDA0002447591220000025
为双差整周模糊度，
Figure FDA0002447591220000026
为双差载波相位观测噪声；在短基线定向中
Figure FDA0002447591220000027
可以表示为：
Figure FDA0002447591220000028
Figure FDA0002447591220000029
为天线Ⅰ和天线Ⅱ所构成的基线矢量，
Figure FDA00024475912200000210
和
Figure FDA00024475912200000211
分别是接收机到卫星j和k的单位矢量，其中，卫星k为参考卫星；
由此得到：
Figure FDA00024475912200000212
由于天线Ⅰ和天线Ⅱ之间的基线长度小于载波波长的1/2，
Figure FDA00024475912200000213
得出：
Figure FDA00024475912200000214
Figure FDA00024475912200000215
Figure FDA00024475912200000216
Figure FDA00024475912200000217
对
Figure FDA00024475912200000220
进行取整，使得整周模糊度的搜索范围大大降低，将上面取整得到的整数值分别带入式中，求得基线长度最接近实际基线长度的整周模糊度值，该值即为整周模糊度的值。
2.根据权利要求1所述双天线GPS测姿方法，其特征在于，所述步骤S2中利用GPS系统3R定位法确定天线Ⅰ的位置坐标，包括，通过空间中三颗卫星为原点以各自到接收机Ⅰ的距离为半径得到三个球面的相交点，确定天线Ⅰ位置坐标在空间中的位置；设天线Ⅰ利用到达时间分别测定GPS系统中的三颗卫星S1、S2和S3到天线Ⅰ位置的分别距离为P1、P2和P3；天线Ⅰ的接收机Ⅰ利用导航电文计算得到S1、S2和S3三颗卫星的位置分别为(x1,y1,z1),(x2,y2,z2)和(x3,y3,z3)；根据距离交汇法求解天线Ⅰ三维坐标的观测方程为：
Figure FDA0002447591220000031
Figure FDA0002447591220000032
Figure FDA0002447591220000033
其中，(x,y,z)为天线Ⅰ的坐标位置；根据上式解算出的天线Ⅰ位置坐标为(x1,y1,z1)。
3.根据权利要求1所述双天线GPS测姿方法，其特征在于，所述步骤S3中，将天线Ⅰ的位置坐标设定为概略坐标，根据伪距线性误差方程对天线Ⅰ的位置坐标进行修正，包括，
将步骤S2解算出的天线Ⅰ的位置坐标(x1,y1,z1)设定为概略坐标(x’1,y’1,z’1)，设概略位置与真实位置之间的偏移记为(Δx,Δy,Δz)，可得伪距定位线性误差方程为：
Figure FDA0002447591220000034
其中，
Figure FDA0002447591220000035
为卫星到接收机Ⅰ概略位置的距离；(xi,yi,zi)表示卫星坐标；伪距定位线性误差方程中共四个未知量，当同时观测到四颗以上的卫星时，建立四个伪距定位线性误差方程，联立方程组，便可以解算出(Δx,Δy,Δz)，完成对天线1的坐标修正，其方程组为：
Figure FDA0002447591220000036
解算该方程组得到修正后的天线Ⅰ的位置坐标(x′1,y′1,z′1)。
4.根据权利要求1所述双天线GPS测姿方法，其特征在于，所述步骤S5中，将修正后的天线Ⅰ的位置坐标作为天线Ⅱ位置坐标的概略坐标，根据双差，最小二乘法定位出天线Ⅱ的位置坐标，包括，设接收机Ⅰ为基准站，天线Ⅰ为主天线，接收机Ⅱ为流动站，天线Ⅱ为从天线，将修正后的天线Ⅰ的位置坐标(x’1,y’1,z’1)作为天线Ⅱ的概略坐标，设天线Ⅱ的概略坐标为(x’2,y’2,z’2)，其中，(x’2,y’2,z’2)＝(x’1,y’1,z’1)，真实坐标为(x2,y2,z2)，概略坐标与真实坐标的偏移记为(Δx’,Δy’,Δz’)；将天线Ⅱ与卫星j和k之间的距离
Figure FDA0002447591220000041
和
Figure FDA0002447591220000042
分别线性化：
Figure FDA0002447591220000043
Figure FDA0002447591220000044
式中，
Figure FDA0002447591220000045
为卫星j到接收机Ⅱ概略位置的距离；
Figure FDA0002447591220000046
为卫星k到接收机Ⅱ概略位置的距离；因为基线长度远远小于天线与卫星的距离，因此，选用天线Ⅰ的坐标作为天线Ⅱ的概略坐标，式中(x’2,y’2,z’2)为天线Ⅱ的概略坐标，即为步骤S3中求出的天线Ⅰ的修正后位置坐标(x′1,y′1,z′1)；
Figure FDA0002447591220000047
和
Figure FDA0002447591220000048
分别为概略坐标到卫星j和k的计算距离；
令
Figure FDA0002447591220000049
式中，l,m,n表示天线Ⅱ指向卫星的方向余弦参数；
整理得到：
Figure FDA00024475912200000410
所以得出
Figure FDA00024475912200000411
Figure FDA00024475912200000412
其中，(Δx,Δy,Δz)为天线Ⅰ概略位置与真实位置之间的偏移，
Figure FDA0002447591220000051
两台接收机共同观测的卫星数目为n，确定其中一颗卫星作为进行双差观测的基本量，可以得到(n-1)个双差方程，将这些双差方程联立得到一个矩阵方程Y＝HX-λN+V，其中，H为观测矩阵，由天线指向卫星的余弦参数双差值构成；X为天线Ⅱ坐标修正量X＝(Δx’,Δy’,Δz’)；N为两天线对于各卫星的双差整周模糊度向量；Y为已知向量，由天线Ⅰ的位置坐标及天线Ⅱ的位置坐标到卫星的距离双差值和载波观测双差值构成；在步骤S4中已经确定双差整周模糊度的值，利用最小二乘方法，可以计算X，X＝(HTH)-1HTY，因此，可以解得天线Ⅱ的位置坐标修正量，确定出天线Ⅱ的位置坐标。
5.根据权利要求1所述双天线GPS测姿方法，其特征在于，所述步骤S6中，根据定位出的天线Ⅰ的位置坐标和天线Ⅱ位置坐标确定测姿载体的偏航角和俯仰角，即进行姿态解算，包括，设天线Ⅰ为点A，天线Ⅱ为点B，天线Ⅱ与天线Ⅱ组成向量
Figure FDA0002447591220000052
设偏航角为
Figure FDA0002447591220000053
俯仰角为θ，则：
Δx＝x2-x1
Δy＝y2-y1
Δz＝z2-z1
Figure FDA0002447591220000054
Figure FDA0002447591220000055
式中，(x1,y1,z1)为天线Ⅰ的位置坐标，(x2,y2,z2)为天线Ⅱ的位置坐标；由上述公式可以解算出偏航角
Figure FDA0002447591220000056
俯仰角θ，从而完成测姿载体的姿态角解算。
CN201710421258.2A 2017-06-07 2017-06-07 一种双天线gps测姿方法 Expired - Fee Related CN106990424B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710421258.2A CN106990424B (zh) 2017-06-07 2017-06-07 一种双天线gps测姿方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710421258.2A CN106990424B (zh) 2017-06-07 2017-06-07 一种双天线gps测姿方法

Publications (2)

Publication Number Publication Date
CN106990424A CN106990424A (zh) 2017-07-28
CN106990424B true CN106990424B (zh) 2020-07-28

Family

ID=59421936

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710421258.2A Expired - Fee Related CN106990424B (zh) 2017-06-07 2017-06-07 一种双天线gps测姿方法

Country Status (1)

Country Link
CN (1) CN106990424B (zh)

Families Citing this family (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107703526B (zh) * 2016-08-08 2020-04-03 清华大学 基线测向方法、装置和系统
CN108181630B (zh) * 2017-11-30 2020-11-03 东南大学 一种北斗双天线旋转快速定向方法
CN108051835B (zh) * 2018-01-12 2024-02-09 武汉桓参工程科技有限公司 一种基于双天线的倾斜测量装置及测量与放样方法
CN108535750A (zh) * 2018-03-26 2018-09-14 广州中海达卫星导航技术股份有限公司 无人机定向导航方法、gnss接收机装置、gnss接收机系统
US10996345B2 (en) * 2018-06-11 2021-05-04 Honeywell International Inc. Signal fault detection for global navigation satellite system using multiple antennas
CN108845345B (zh) * 2018-06-12 2022-04-12 中国矿业大学 利用gnss测速原理的双天线定向测姿的方法
CN111157944B (zh) * 2018-11-07 2022-12-06 千寻位置网络有限公司 基于双天线的测距装置、移动载体
CN109613585A (zh) * 2018-12-14 2019-04-12 中国科学院国家授时中心 一种对基站天线超短基线gnss双天线实时测向的方法
CN110793518B (zh) * 2019-11-11 2021-05-11 中国地质大学（北京） 一种海上平台的定位定姿方法及系统
CN111121769B (zh) * 2019-12-30 2021-11-16 中国人民解放军93209部队 机械扫描便携式合作目标对空监视设备及自主校北方法
CN113551669B (zh) * 2021-07-23 2024-04-02 山东泉清通信有限责任公司 基于短基线的组合导航定位方法及装置
CN113970774B (zh) * 2021-12-22 2022-04-01 广东汇天航空航天科技有限公司 一种导航系统的模糊度固定方法和装置
CN114339993B (zh) * 2022-03-16 2022-06-28 北京瑞迪时空信息技术有限公司 基于天线距离约束的陆基定位方法、装置、设备和介质
CN117075166B (zh) * 2023-10-17 2023-12-15 智慧司南(天津)科技发展有限公司 一种船用卫星罗经艏向平滑方法

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102565834A (zh) * 2011-11-30 2012-07-11 重庆九洲星熠导航设备有限公司 一种单频gps测向系统及其测向定位方法
CN102998690A (zh) * 2012-11-26 2013-03-27 哈尔滨工程大学 一种基于gps载波双差方程的姿态角直接求解方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102565834A (zh) * 2011-11-30 2012-07-11 重庆九洲星熠导航设备有限公司 一种单频gps测向系统及其测向定位方法
CN102998690A (zh) * 2012-11-26 2013-03-27 哈尔滨工程大学 一种基于gps载波双差方程的姿态角直接求解方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
基于GPS双天线的定向研究;刘永彪;《中国优秀硕士学位论文全文数据库基础科学辑》;20120615(第6期);A008-77 *
基于双天线的GPS测姿系统研究;赵文晔;《中国优秀硕士学位论文全文数据库基础科学辑》;20111215(第S1期);A008-96 *

Also Published As

Publication number Publication date
CN106990424A (zh) 2017-07-28

Similar Documents

Publication Publication Date Title
CN106990424B (zh) 一种双天线gps测姿方法
CN109556632B (zh) 一种基于卡尔曼滤波的ins/gnss/偏振/地磁组合导航对准方法
CN107272039B (zh) 一种基于双天线gps的定位测姿方法
CN102230971B (zh) Gps多天线测姿方法
CN109556631B (zh) 一种基于最小二乘的ins/gnss/偏振/地磁组合导航系统对准方法
CN103399326B (zh) 一种gnss动态测量精度检验系统及方法
CN109613585A (zh) 一种对基站天线超短基线gnss双天线实时测向的方法
CN102998690B (zh) 一种基于gps载波双差方程的姿态角直接求解方法
US10514469B2 (en) Attitude angle calculating device, method of calculating attitude angle, and attitude angle calculating program
Han et al. Single-epoch ambiguity resolution for real-time GPS attitude determination with the aid of one-dimensional optical fiber gyro
CN106842271B (zh) 导航定位方法及装置
CN106500731A (zh) 一种基于恒星模拟系统的船载经纬仪的标校方法
CN105372692B (zh) 一种北斗测姿接收机的快速整周模糊度方法
CN108205151B (zh) 一种低成本gps单天线姿态测量方法
CN102607563B (zh) 利用背景天文信息对于航天器进行相对导航的系统
Giorgi Attitude determination
CN109471102B (zh) 一种惯组误差修正方法
CN114353835B (zh) 惯性轨道测量仪动态校准系统、方法及其应用
CN111174786B (zh) 一种ins/sar组合导航的几何精度因子计算方法
CN110646817A (zh) 计算定位误差的方法和高精度定位方法
Qian Generic multisensor integration strategy and innovative error analysis for integrated navigation
CN110988796B (zh) 一种基于频偏机会信号的定位方法及系统
Kramlikh et al. Estimating the Inertial Characteristics of a Nanosatellite Using a Radio Compass Based on GNSS Technology
CN118067153A (zh) 一种组合导航装置测量误差的估计方法、装置及存储介质
Dmitriev et al. Study of Methods of Mutual High-Precision Navigation Based on the Use of Goniometric GNSS Receivers

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
CB02 Change of applicant information

Address after: 401220 No. 6 Xinmin Road, Xinshi Street, Changshou District, Chongqing

Applicant after: CHONGQING CHONGYOU 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 CHONGYOU HUICE COMMUNICATION TECHNOLOGY CO.,LTD.

GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20210423

Address after: 401121 No.5 Huangshan Avenue, gaoxinyuan, North New District, Yubei District, Chongqing

Patentee after: Chongqing Huamu Network Technology Co.,Ltd.

Address before: 401220 No. 6 Xinmin Road, Xinshi Street, Changshou District, Chongqing

Patentee before: CHONGQING CHONGYOU HUICE COMMUNICATION TECHNOLOGY Co.,Ltd.

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: 20200728