一种基于共时钟接收机的实时精密定姿方法
【技术领域】
[0001 ]本发明涉及卫星实时精密定姿的方法，特别涉及一种基于共时钟接收机的实时精 密定姿方法。
【背景技术】
[0002] 卫星实时精密定姿技术是一种利用移动载体上的两或多天线高精度载波相位观 测值观测值进行差分相对定位从而实现载体航向及姿态测量的相位差分定姿技术，在车辆 航向指示、飞机定姿和驾校自动监考等领域有广泛的应用前景。在进行卫星实时精密定姿 工作时，卫星信号接收机利用多个天线的卫星观测数据，首先进行同步载波相位差分相对 定位，然后将载体天线间的相对位置信息转化为载体的姿态。目前已有的用于实时卫星精 密定姿方法主要有基于线缆偏差常量补偿的单差载波相位差分定姿法(参见[l]Jiunhan Keong and Gerard Lachapelle. Heading and Pitch Determination Using GPS/ GLNOASS，2000 . [2]王永泉.长航时高动态条件下GPS/GLONASS姿态测量研究，上海交通大 学，2008 .)，这种典型的方法难以有效解决以下问题:线缆偏差因温度变化和机械力等导致 的漂移;线缆偏差漂移使得定姿精度难以提高甚至降低。
【发明内容】
[0003] 针对基于共时钟接收机采用单差相位精密定姿技术中线缆偏差因温度变化和机 械力等导致漂移而降低定姿精度的问题，本发明提出了一种基于共时钟接收机的实时精密 定姿方法。其是一种基于自回归滑动平均(ARMA)线缆偏差预报与单差载波信息实时融合滤 波定姿的方法。ARMA是时间序列分析领域的常规体系，是学习过时间序列分析的技术人员 的熟知概念。本发明首先利用ARMA模型对线缆偏差进行时间更新预报，然后根据单差载波 相位观测方程以及线缆偏差预报信息进行融合测量更新，实现在线缆偏差约束下的单差载 波相位相对定位，最后将高精度的相对位置信息转化为载体姿态。该方法突破了常规方法 要求定姿设备处于恒定温度的限制，以及解决了常规方法受制于接收机内部通道时延波动 而定姿精度难以提升甚至降低的问题，有效地提高了卫星定姿精度。
[0004] 本发明的技术方案是：
[0005] -种基于共时钟接收机的实时精密定姿方法，其特征在于，包括以下步骤：
[0006] S1:设定线缆偏差的初始值lbQ=0，方差PQ= 1;
[0007] S2:根据S1中设置的线缆偏差初始值及其方差，利用自回归滑动平均ARMA模型对 线缆偏差进行时间更新，即预报线缆偏差值及其方差；
[0008] S3:利用双差载波相位相对定位的基线矢量、天线伪距单点定位坐标及卫星坐标， 建立去单差模糊度参数的单差载波相位观测方程；
[0009] S4:根据线缆偏差预报值及其方差和去单差模糊度参数的单差载波相位观测方程 进行融合测量更新，得到滤波的线缆偏差以及两个天线的相对位置信息，然后将相对位置 信息转化为载体的航向角和俯仰角；
[0010] S5:将S4得到的滤波线缆偏差及其方差赋给S1中的线缆偏差初始值及其方差阵。
[0011] 本发明中，步骤S2中，利用ARMA模型对线缆偏差进行时间更新的具体方法是：
[0012] 利用ARMA(1，0)模型预报线缆偏差：根据线缆偏差前一时刻的值以及方差，利用 ARMA(1，0)模型进行预报；
[0013]
[0014] 式（1)中，时刻即当前时刻预报的线缆偏差值，单位为周；lb(tH)为前 一时刻线缆偏差值，单位为周；为前一时刻线缆偏差的方差，单位为周的平方；巧^为 当前时刻线缆偏差的方差，单位为周的平方;W为白噪声，单位为周;Q为ARMA(1，0)模型的噪 声，单位为周的平方。
[0015] 本发明中，步骤S3的具体方法是：
[0016] 1)建立单差载波相位观测方程：
[0017]假设移动载体或飞行器安装的卫星信号接收天线分别为A和B，根据A、B天线对于k 号卫星观测的非差载波相位观测值以和名，建立单差载波相位观测方程；
[0018] -_ 卞通…
朋…一 C2)
[0019] 式⑵中，Δ'为A、B天线对k号卫星的单差载波相位观测值，Δ' =為,单位 为周；Δρ^*Α、Β天线对k号卫星的单差几何距离，单位为米;λ为某个频点的对应波长，单 位为米；Δ/V^为六、Β天线对k号卫星的单差载波相位模糊度；lb为线缆偏差，单位为周；e为 单差载波相位观测值噪声，单位为周；
[0020] 2)建立去单差模糊度参数的单差载波相位观测方程：
[0021] 根据传统的双差载波相位相对定位的基线矢量rAB,dd、天线A伪距单点定位坐标及 卫星坐标求得单差整周模糊度。
[0022]
[0023]式(3)中，rA为A天线的伪距单点定位坐标，单位为米;rAB,dd为A、B天线间的双差载 波相位定位矢量，单位为米;rk为k号卫星的坐标，单位为米;round表示四舍五入圆整运算； 卜11表示取模运算；
[0024] 将式(3)求得单差载波相位模糊度代入单差载波相位观测方程式(2)，并以天线B 作为初始坐标进行线性化，得到k号卫星无单差模糊度参数的线性单差载波相位观测方程。 将所有可见卫星的单差载波相位观测方程按上述方法去掉模糊度参数，可得到无去单差模 糊度参数的单差载波相位观测方程，
[0025] Z= (HA)drAB+l · lb+e (4)
[0026] 式(4)中，Z为所有可见卫星单差观测方程线性化后的线性自由项，单位为周；Η为 视线矩阵;drAB为Α、Β天线间双差基线矢量的改正数，单位为米；1所有元素为1的列向量，维 数为可见卫星个数。
[0027] 线性自由项Z和视线矩阵Η的表达式为：
[0028]
[0029] 式中，k为卫星号k = l，2，···；^为天线Β到k号卫星的单位矢量。
[0030]本发明中，步骤S4的具体方法是：
[0031] 1)建立线缆偏差预报信息与单差载波信息融合测量更新方程：
[0032] 联立线缆偏差时间更新预报方程和去单差模糊度参数的单差载波相位观测方程；
[0033] 设单差载波相位的观测方差阵为C〇V(e)=R，联立单差观测方程式(4)和线缆预报 方程式(1)，得
[0034]
[0035]
[0036]
[0037] 根据最小二乘得滤波的线缆偏差及相对定位矢量改正数为
[0038]
[0039] 式中，drAB为相对定位矢量改正数，WGS84或CGCS2000直角坐标系，单位为米;Q r为 相对定位矢量改正数的方差阵;Qr, lb为相对定位矢量改正数与线缆偏差的协方差阵;Qlb为 线缆偏差滤波后的方差；
[0040] 根据双差载波相位相对定位矢量rAB,dd以及式(6)计算的相对定位矢量改正数，可 得信息融合测量更新的相对位置矢量，为
[0041] rAB = rAB,dd+drAB (7)
[0042] 2)计算移动载体的航向和俯仰角：首先将WGS84或CGCS2000坐标系的相对位置矢 量r AB变化到当地北天东坐标系巧％计算载体姿态；
[0043]
(8)
[0044] 式中，Η为航向角;E为俯仰角;be、bu和匕分别北天东坐标系《的三个对应分量。
[0045] 本发明中，步骤S5的具体方法是:根据式(6)计算的线缆偏差lb以及方差Qlb代替步 骤S1中设定的线缆偏差和方差。
[0046] 本发明的有益技术效果：
[0047] 1)解决了线缆偏差由于温度和机械力等因素漂移而无法进行常量补偿的问题，从 而提高卫星实时精密定姿精度；
[0048] 2)突破了常规方法要求定姿设备处于恒定温度的限制；
[0049] 3)解决了常规方法受制于接收机内部通道时延波动而定姿精度难以提升甚至降 低的缺陷，也降低了接收机内部通道时延稳定性设计的要求。
【附图说明】
[0050] 图1为本发明的流程图。
[0051] 图2为某次试验常规双差载波相位定姿方法和本发明的定姿结果对比图。
[0052] 图3为某次试验常规线缆常量补偿单差载波相位定姿方法和本发明的定姿结果对 比图。
【具体实施方式】
[0053]下面结合附图，对本发明作进一步的说明：
[0054]本发明一种基于共时钟接收机的实时精密定姿方法，其具体步骤如下：
[0055] 1)设置线缆偏差的初始值和方差
[0056] 如图1所示，在算法执行的第一步需要设置线缆偏差的大小及其方差。设线缆偏差 初始值lbo = 0,方差Po=l。
[0057] 2)线缆偏差时间更新
[0058]如图1所示，根据线缆偏差设定或上一时刻值及ARMA(1，0)预报模型进行线缆偏差 时间更新，得到线缆偏差预报值及预报方差。设线缆偏差ARMA(1，0)模型噪声为le-12。
[0059] 线缆偏差预报值11^为：11^ = 1130 = 0，方差预报值为?! = ?〇+〇= l+le-12。
[0060] 3)单差载波相位观测方程建立
[0061] 如图1所示，将双差载波相位相对定位的基线矢量代入含单差模糊度的单差载波 相位观测方