卫星导航能够向各类用户和运动平台实时提供准确、连续的
位置、速度和时间信 息。全球卫星导航定位系统(GNSS,Global Navigation Satellite System)是第 二代卫星导航定位系统,具有全能性(陆地、海洋、航空和航天)、全球性、全天候、 连续性和实时性的特点。目前世界上已经存在的两大全球卫星导航定位系统是美国的 GPS系统和俄罗斯的GLONASS系统,正在设计建设阶段的有欧洲的Galileo系统 和中国的BD2系统。
由于利用两个卫星
导航系统的
星座组合,会给同一历元时刻提供更多的可见 星,改善卫星的几何分布结构,所以双系统组合卫星导航接收机的定位
精度会有一定 的改善,可用性和可靠性会有一定的提高。双系统卫星导航定位方程如下式描述:
ρi=Di+Cdtj(i=1,2,…,n,j=A,B)
i为可见星星号;j为第i颗卫星所属的系统编号;ρi为伪距观测值;Di为接收机 与可见星间的真实距离;dtj为接收机与卫
星系统j间的参考时间偏差;C为光速。
对于上述方程组的一般求解方法是,将非线性方程组在初始估值附近线性化,利 用方向余弦矩阵进行
迭代求解。但是无论是单系统还是双系统组合定位应用中,在接 收机位置初始估计值离真值过远的情况(如深空自主导航冷启动)下则不能保证可靠 地定位。目前常用的卫星导航定位方法如下:
单系统伪距方程的直接求解定位方法主要有以下几种:
Bancroft法:利用了四维空间内的Lorentz内积对导航方程进行
变形,给出了 关于Lorentz内积
的二次方程,z为由接收机坐标与参考时间偏差构成的 四维向量,再利用与z的线性关系得到接收机位置坐标及参考时间偏差;
Krause法:构造了一个由可见卫星构成的参考测量平面,以及垂直于该平面的 辅助向量,推导了星站向量与参考时间偏差的线性关系,利用星站向量与卫星坐标向 量的几何关系求解接收机三维坐标;
Abels法:将坐标原点移到了参考观测卫星,推导了该坐标系中关于接收机原点 距的一元二次方程,及接收机原点距与位置坐标间的线性方程组,进而得到接收机位 置坐标。
基于方向余弦矩阵的双系统组合卫星定位方法(以后称为传统方法):
在利用双系统卫星进行定位时,要求至少有五颗来自两个系统的可见星。显然, 五个伪距观测量中,两个系统的伪距观测值共存的组合有两种:一种是,四个伪距观 测值属于同一系统,剩余一个属于另外一个系统,以下用(1,4)表示;另外一种 组合是,三个伪距观测值属于同一系统,剩余两个属于另外一个系统,以下用(2, 3)表示。(1,4)组合的情况可以先利用属于同一系统的四个伪距观测值在单一系 统内求解,再利用余下一个伪距观测值求取另一系统的时间偏差。对于(2,3)组 合的情况,属于同一系统的伪距观测值数量不足以实现单独求解,可以不失一般性的 设第一颗卫星1,第二颗卫星2和第三颗卫星3属于系统一,第四颗卫星4和第五 颗卫星5属于系统二,用户接收机为6,接收机与卫星间的位置关系如图1所示,考 虑到卫星钟差可以根据星历进行改正,电离层、对流层的折射影响也可以利用模型进 行修正,伪距观测方程如下式描述:
ρ i = D i + Cd t A i = 1,2,3 ρ j = D j + C dt B j = 4,5 - - - ( 1 )
其中,ρi、ρj为来自两个导航系统的伪距观测值; D i = ( X i - X u ) T ( X i - X u ) (i=1,2...5),Xi为卫星坐标向量,Xu为接收机坐标向量;dtA、dtB为接收机与卫星 系统一、系统二的参考时间偏差;C为光速。
设(x0,y0,z0)表示接收机坐标的初始估计值,将(1)式在这一点处泰勒展开, 并忽略二次项可以得到:
ρ i = ρ i 0 - l i Δx - m i Δy - n i Δz + Cd t A i = 1,2,3 ρ j = ρ j 0 - l j Δx - m j Δy - n j Δz + C dt B j = 4,5 - - - ( 2 )
其中: ρ i 0 = ( x i - x 0 ) 2 + ( y i - y 0 ) 2 + ( z i - z 0 ) 2 (i=1,2,...,5);l、m、n为从(x0,y0,z0) 到观测卫星的方向余弦;Δx=xr-x0,Δy=yr-y0,Δz=zr-z0。
整理并写作矩阵的形式如下:
Er=A*δT+v (3)
其中:Er=[e1,e2,…,e5],ei=ρi-ρi0 i=1,2,...,5
A = l 1 m 1 n 1 - 1 0 l 2 m 2 n 2 - 1 0 l 3 m 3 n 3 - 1 0 l 4 m 4 n 4 0 - 1 l 5 m 5 n 5 0 - 1
δT=[δx,δy,δz,CδtA,CδtB]
v=[v1,v2,…,v5]
δT的最小二乘估计为:δT=(ATA)-1AT·Er (4)
以上提到的定位方法中,单系统卫星定位直接求解定位方法只考虑了接收机与一 个系统的参考时间偏差,因此无法直接应用于双系统定位求解;基于方向余弦矩阵的 双系统组合卫星定位方法,在接收机位置初始估计值离真值过远的情况(如深空自主 导航冷启动)下则不能保证可靠地定位。
本发明的目的:是提供
一种双系统组合卫星导航接收机冷启动初始定位方法,在 缺少接收机起始位置估计值的情况下,该方法可以在近地及深空空间对接收机进行可 靠的定位,特别是在深空空间应用时,传统方法将无法保证接收机可靠的定位,而本 发明提供的方法仍能够有效定位。
本发明的一种双系统组合卫星导航接收机冷启动初始定位方法,通过下列步骤实 现:
第一步、根据守时时钟给出参考星站距离初值估计,并根据伪距观测值及卫星星 历数据构造两个参考星站距离与接收机空间位置关系的线性矩阵方程;
第二步、构造关于两个参考星站距离的非线性方程组,并计算非线性方程组各阶 系数;
第三步、利用
人工神经网络对关于两个参考星站距离的非线性方程组求解,得到 参考星站距离的精确估值;
第四步、利用参考星站距离与接收机空间位置关系及伪距观测方程(1)求解接 收机三维位置坐标及接收机时间系统偏差,实现接收机定位及参考时间系统同步。
本发明提出的定位方法的优点在于可以同时适用于近地及深空空间双系统组合 卫星导航接收机的初始定位,尤其是在深空条件下,如果缺少对接收机冷启动初始位 置的估计,传统定位方法由于初值选取的盲目性,导致无法可靠定位,而本发明提供 的方法将导航定位问题首先转换为对两个参考星站距离的估算问题,而参考星站距离 可以通过伪距观测进行初始估计,因此避免了迭代初值选取的盲目性,进而保证了导 航定位的可靠性。
附图说明
图1接收机与卫星间的位置关系图。
图2本发明提出的双系统组合卫星导航接收机冷启动初始定位方法
流程图。
图3a传统方法定位误差整体仿真分析图。
图3b本发明提出方法定位误差整体仿真分析图。
图3c几何衰减因子(PDOP)变化过程图。
图4本发明提出的方法与传统方法整体对比仿真分析图的局部放大图(传统方 法定位发散前结果)。
图5a传统方法定位误差仿真分析局部放大图(传统方法发散后结果)。
图5b本发明提出方法的定位误差仿真分析局部放大图(传统方法发散后结 果)。
下面结合附图和
实施例对本发明作进一步的详细说明。
本发明提供的一种双系统组合卫星导航接收机冷启动初始定位方法,是将选自两 个导航系统的五颗卫星作为观测卫星,并在两系统内分别选取一颗卫星作为参考观测 卫星,以参考观测卫星的伪距观测值作为参考伪距观测值,其他伪距观测值与其做差, 以消除接收机与两个系统间的参考时间偏差对导航定位的影响,并将参考观测卫星与 接收机间的真实距离(以下称为参考星站距离)作为待求变量,构造关于两个参考星 站距离的非线性方程组,以及参考星站距离与接收机空间位置关系的线性矩阵方程, 通过求解非线性方程组得到参考星站距离,再利用参考星站距离与接收机空间位置关 系的线性矩阵方程实现接收机冷启动时的初始导航定位,并利用伪距观测方程(1) 求出接收机与两个系统间的参考时间偏差;同时,本发明根据人工神经网络方法大规 模并行处理、分布式存储的特点,将其应用于非线性方程组的求解,人工神经网络的 求解在本质上仍是一个迭代求解的过程,与基于方向余弦的迭代方法一样,若迭代初 值选取不合理,则仍存在收敛到异定位解的情况。但不同的是,本发明提出的方法中 迭代求解的变量为参考星站距离D1、D4,根据伪距观测方程(1)可知D1和D4分别 为伪距观测值ρ1和ρ4中的一部分,因此可以将伪距观测值ρ1和ρ4作为D1和D4的 初始估计值, 这样便解决了待求变量初始估值选择的盲目性问题。
本发明的一种双系统组合卫星导航接收机冷启动初始定位方法的实施流程如图 2所示,现以一次仿真为例来具体说明本发明定位方法的实现过程:
步骤一、根据守时时钟给出参考星站距离初值估计,并根据伪距观测值及卫星星 历数据构造两个参考星站距离与接收机空间位置关系的线性矩阵方程。
接收机与卫星间的位置关系如图1所示。在接收机关机或掉电的情况下,守时 时钟可以由
备用电池供电继续维持接收机6时间参考系统的连续性。当接收机6再 次开机或上电后,经过初始的捕获
跟踪及通道分配后,接收机可以同时跟踪并观测到 系统一和系统二中卫星。根据两个系统的卫星历书及星历,选取五颗可见卫星作为导 航定位解算的观测卫星,五颗卫星中三颗属于系统一,另外两颗属于系统二,不失一 般性地,假设从系统一中选取第一颗卫星1、第二颗卫星2和第三颗卫星3,系统二 中选取第四颗卫星4和第五颗卫星5作为定位观测卫星,基带相关器处理单元根据 守时时钟获取接收机6历元观测时间,给出所选观测卫星的伪距观测值(单位m):
ρ1=3.9690 17643e7;ρ2=4.114500055e7;ρ3=3.627377695e7;
ρ4=2.5505 29409e7;ρ5=2.482211095e7。
这样选取的伪距观测误差主要由接收机6守时精度决定,可以根据不同的任务 需求选择不同精度的守时时钟,表1给出了接收机晶振
稳定性与守时精度的关系:
表1 接收机晶振稳定性与守时精度的关系
晶振 稳定性 守时精度(s) 日 月 年 10-8 10-9 10-10 8.6e-4 8.6e-5 8.6e-6 2.59e-2 2.59e-3 2.59e-4 3.15e-1 3.15e-2 3.15e-3
根据卫星星历求取所选五颗观测卫星的地心距ri(i=1,2,...,5),并假设两个系统与 接收机时间系统的偏差dtA、dtB分别为3.3333e-7秒和-3.3333e-7秒,分别在两个 系统的伪距观测值中各选取一个观测值作为参考伪距观测值,以取ρ1和ρ4为例,其 他伪距观测值与其做差,得到相应的伪距观测差值di(i=2,3,5):
d 2 = ρ 2 - ρ 1 = D 2 - D 1 d 3 = ρ 3 - ρ 1 = D 3 - D 1 d 5 = ρ 5 - ρ 4 = D 5 - D 4 - - - ( 5 ) 将伪距观测值ρi(i=1,2,...,5)带入(5)式,得到:
d 2 = ρ 2 - ρ 1 = 1.4548 e + 006 d 3 = ρ 3 - ρ 1 = - 3.4164 e + 006 d 5 = ρ 5 - ρ 4 = - 6.8318 e + 005 由于所观测卫星属于两个相互独立的系统,因此两个系统所采用的地理参考坐标 系一般是不同的,因此需要对星历解算得到的当前所选观测卫星的位置进行不同坐标 系的转换,具体方法很容易由相关文献获得,此处给出转换后的五颗卫星位置坐标向 量(单位m):
X1=(2.187364335e7, 3.604664862e7, -7.124889241e3)T;
X2=(-2.76887924e7, 2.144288154e7, -2.348086037e7)T;
X3=(-1.68209497e7, 3.659509670e7, 1.2476848433e7)T;
X4=(-1.970516582e7,-1.066068835e7,1.416265536e7)T;
X5=(1.5421521698e7,2.3836992984e6,2.143404165e7)T;
将(5)式中D1、D4移项到等号左边,两边取平方后可得:
D 2 2 = d 2 2 + D 1 2 + 2 d 2 D 1 D 3 2 = d 3 2 + D 1 2 + 2 d 3 D 1 D 5 2 = d 5 2 + D 4 2 + 2 d 5 D 4 - - - ( 6 ) 根据地心7、接收机6和观测卫星的几何位置关系还可以得到如下关系式:
D 2 2 = r 2 2 + r u 2 - 2 X 2 T X u D 3 2 = r 3 2 + r u 2 - 2 X 3 T X u D 5 2 = r 5 2 + r u 2 - 2 X 5 T X u - - - ( 7 ) 式(6)减式(7)后得:
d 2 2 + D 1 2 - r 2 2 - r u 2 + 2 d 2 D 1 + 2 X 2 T X u = 0 d 3 2 + D 1 2 - r 3 2 - r u 2 + 2 d 3 D 1 + 2 X 3 T X u = 0 d 5 2 + D 4 2 - r 5 2 - r u 2 + 2 d 5 D 4 + 2 X 5 T X u = 0 - - - ( 8 ) 根据两个参考星站距离D1、D4的几何关系可得如下方程:
D 1 2 = r 1 2 + r u 2 - 2 X 1 T X u D 4 2 = r 4 2 + r u 2 - 2 X 4 T X u - - - ( 9 ) 其中
r u = X u T X u , 为接收机6地心距,Xu为接收机位置向量,将(9)式带入(8) 式整理后可得:
A+B1D1+B2D4+CXu=0 (10)
其中,
A = d 2 2 - r 2 2 + r 1 2 d 3 2 - r 3 2 + r 1 2 d 5 2 - r 5 2 + r 4 2 B 1 = 2 d 2 2 d 3 0 B 2 = 0 0 2 d 5 C = 2 ( X 2 T - X 1 T ) 2 ( X 3 T - X 1 T ) 2 ( X 5 T - X 4 T ) 如(10)式中C为非奇异,则可得参考星站距离D1、D4与接收机6空间位置坐标 关系的线性矩阵方程:
Xu=-C-1(A+B1D1+B2D4) (11)
其中D1、D4为未知变量。将伪距观测差值di(i=2,3,5)、五颗卫星地心距ri (i=1,2,...,5)和坐标向量Xi(i=1,2,...,5)的数值代入系数矩阵A、B1、B2、C, 得到:
A = d 2 2 - r 2 2 + r 1 2 d 3 2 - r 3 2 + r 1 2 d 5 2 - r 5 2 + r 4 2 = 0.2117 1.1672 0.0068 × 1e13 ; B 1 = 2 d 2 2 d 3 0 = 2.9096 - 6.8328 0 × 1e6 B 2 = 0 0 2 d 5 × 1e6 ; C = 2 ( X 2 T - X 1 T ) 2 ( X 3 T - X 1 T ) 2 ( X 5 T - X 4 T ) - 9.9125 - 2.9208 - 4.6947 - 7.7389 0.1097 2.4968 7.0253 2.6089 1.4543 × 1e7 步骤二、构造关于两个参考星站距离的非线性方程组,并计算非线性方程组各阶 系数。
将(11)式带入(9)式可得关于两个参考星站距离D1、D4的非线性方程组:
O 1 D 1 2 + P 1 D 4 2 + Q 1 D 1 + R 1 D 4 + S 1 D 1 D 4 + V 1 = 0 O 2 D 1 2 + P 2 D 4 2 + Q 2 D 1 + R 2 D 4 + S 2 D 1 D 4 + V 2 = 0 - - - ( 12 ) 其中:
O 1 = B 1 T C - T C - 1 B 1 - 1 ; P 1 = B 2 T C - T C - 1 B 2 ; Q 1 = 2 ( A T C - T C - 1 B 1 + X 1 T C - 1 B 1 ) ; R 1 = 2 ( A T C - T C - 1 B 2 + X 1 T C - 1 B 2 ) ; S 1 = 2 B 1 T C - T C - 1 B 2 ; V 1 = r 1 2 + A T C - T C - 1 A + 2 X 1 T C - 1 A O 2 = B 1 T C - T C - 1 B 1 ; P 2 = B 2 T C - T C - 1 B 2 - 1 ; Q 2 = 2 ( A T C - T C - 1 B 1 + X 4 T C - 1 B 1 ) ; R 2 = 2 ( A T C - T C - 1 B 2 + X 4 T C - 1 B 2 ) ; S 2 = 2 B 1 T C - T C - 1 B 2 ; V 2 = r 4 2 + A T C - T C - 1 A + 2 X 4 T C - 1 A 利用步骤一中给出的系数矩阵A,B1,B2,C具体数值及参考观测第一颗卫星1、 参考观测第四颗卫星4的坐标向量X1、X4具体数值,求取关于两个参考星站距离的 非线性方程组中各阶系数:
O 1 = B 1 T C - T C - 1 B 1 - 1 = - 0.9788 ; P 1 = B 2 T C - T C - 1 B 2 = 0.0136 ; Q 1 = 2 ( A T C - T C - 1 B 1 + X 1 T C - 1 B 1 ) = - 2.0278e6 ; R 1 = 2 ( A T C - T C - 1 B 2 + X 1 T C - 1 B 2 ) = - 7.3418e6 ; S 1 = 2 B 1 T C - T C - 1 B 2 = 0.0026 ; V 1 = r 1 2 + A T C - T C - 1 A + 2 X 1 T C - 1 A = 1.7982e15 O 2 = B 1 T C - T C - 1 B 1 = 0.0212 ; P 2 = B 2 T C - T C - 1 B 2 - 1 = - 0.9864 ; Q 2 = 2 ( A T C - T C - 1 B 1 + X 4 T C - 1 B 1 ) = - 4.2880e6 ; R 2 = 2 ( A T C - T C - 1 B 2 + X 4 T C - 1 B 2 ) = 2.9363e6 ; S 2 = 2 B 1 T C - T C - 1 B 2 = 0.0026 ; V 2 = r 4 2 + A T C - T C - 1 A + 2 X 4 T C - 1 A = 7.0097e14 步骤三、利用人工神经网络对关于两个参考星站距离的非线性方程组求解,得到 参考星站距离的精确估值。以参考卫星的伪距观测值ρ1和ρ4作为两个参考星站距离 的初始估计值,应用人工神经网络对关于两个参考星站距离的非线性方程组求解,得 到参考星站距离的精确估值,其步骤如下:
a)建立如下人工神经网络模型:
dY dt = - F ′ ( Y ) T F ( Y ) 其中:F(Y)=[f1(Y),f2(Y)]T,且有
f 1 ( Y ) = O 1 D 1 2 + P 1 D 4 2 + Q 1 D 1 + R 1 D 4 + S 1 D 1 D 4 + V 1 f 2 ( Y ) = O 2 D 1 2 + P 2 D 4 2 + Q 2 D 1 + R 2 D 4 + S 2 D 1 D 4 + V 2 , Y=[D1,D2]T
F ′ ( Y ) = ∂ f 1 ∂ D 1 ∂ f 1 ∂ D 2 ∂ f 2 ∂ D 1 ∂ f 2 ∂ D 2 = 2 O 1 D 1 + Q 1 + S 1 D 4 2 P 1 D 4 + R 1 + S 1 D 1 2 O 2 D 1 + Q 2 + S 2 D 4 2 P 2 D 4 + R 2 + S 2 D 1 b)初始化,令t=0,e=(1,1),Y(0)=[D1(0)、D4(0)];
c)计算
能量函数E(Y)的梯度,即E(Y)=F′(Y)TF(Y);
d)进行网络状态更新,Y(t+Δt)=Y-ΔtE(Y);
e)计算u=‖F(Y(t+Δt))‖2;
f)若u<ε1,则停,令非线性方程组的根Y*≈Y(t+Δt);否则,计算 v=‖E(Y(t+Δt))‖2,转入步骤(g);
g)若v<ε2,则令Z=Y(t+Δt)-Y(0),转入步骤(h);否则,令 Y=Y(t+Δt),E(Y)=E(Y(t+Δt)),t=t+Δt,转入步骤(d);
h)若‖Z‖2<ε3,则令Y=Y(t+Δt)-he,转入步骤(e);否则,令 Y=Y(t+Δt)+hZ/‖Z‖2,转入步骤(i);
i)令Y(0)=Y,t=t+Δt,转入步骤(c)。
直到收敛精度满足要求,停止迭代求解,得到参考星站距离的精确估值:
D1=3.9690e7;D4=2.5505e7
步骤四、利用参考星站距离与接收机空间位置关系及伪距观测方程(1)求解接 收机三维位置坐标及接收机时间系统偏差,实现接收机定位及参考时间系统同步。
将步骤三中求解的参考星站距离的精确估值代入步骤一中求得的线性矩阵方程 Xu=-C-1(A+B1D1+B2D4),得到接收机6三维位置坐标:
Xu=-C-1(A+B1D1+B2D4)=[-2.0245832,4.6018815483,3.9167398587]T×1.0e6 与接收机6仿真设定值做差,其中
X u ‾ = [ - 2.0246001473,4.6018680649,3.9167069593 ] T × 1.0e6 , 得定位误差(单 位m)为:
Err X u = X u - X u ‾ = [ 16.8482 , - 86.5166,32.8994 ] T 将求取的接收机6三维位置坐标Xu带入相应的伪距观测方程(1)便可以得到 接收机6时间系统偏差(单位s):
tA=(ρ1-D1)/C=3.6563e-7;
tB=(ρ4-D4)/C=-3.5513e-7;
与参考时间偏差比较后的时间同步误差为:
Err t A = t A - 3.3333 e - 7 = 0.323 e - 7 Err t B = t B - ( - 3.3333 e - 7 ) = - 0.218 e - 7 以同样地方法进行多次历元的定位仿真,可以得到接收机位置由近地向深空空间 变化过程中的一系列定位仿真结果,其与传统定位方法的定位仿真结果对比效果如图 3a、图3b、图3c、图4、图5a图5b所示。图3a是传统方法定位误差的整体仿真 分析图,可以看到接收机6远离地心7一定距离后,传统定位方法便无法正确定位, 定位误差在107m量级;而本发明提供的方法在接收机6远离地心7一定距离后仍 然能够准确的实现初始定位,定位误差在±200m以内,如图3b所示;对比图3c可 知,本发明提出方法的定位误差仅受几何衰减因子PDOP的影响,PDOP值变化越 大,定位误差的方差就越大。图4为传统方法发散前与本发明提出的定位方法的定 位误差仿真分析结果的局部放大图,从该图中可以看出,传统方法与本发明提供的方 法的定位误差在近地空间得到了相同的定位结果,二者均可以实现对接收机的可靠定 位。图5a和图5b分别给出了传统方法发散前与本发明提出的方法定位误差仿真分 析结果的局部放大图,从图5a中可以看出传统方法的定位误差在发散后达到107m 量级,即定位失败,而本发明提出的方法的定位误差在传统方法发散后仍在±200m以 内(如图5b),可以保证接收机6可靠的定位,因此在深空空间,缺少接收机6初 始位置估计值的前提下,本发明提出的方法仍能保证接收机6冷启动成功。