Page 17 - 《武汉大学学报(信息科学版)》2025年第10期
P. 17

1952                            武 汉 大 学 学 报  (信 息 科 学 版)                       2025 年 10 月

                3.2 TDCP 解算精度及其对车辆航向角的影响                         弯、观测条件恶劣等因素,无法进行安装角估计,
                     分析                                          导致图 3 中出现结果不连续情况。
                     一些文献采用多普勒测速结果来计算车辆                              从 图 3 中 可 以 看 出 :(1)在 直 线 行 驶 路 段 ,
                航 向 角 ,并 将 车 辆 速 度 作 为 安 装 角 估 计 的 观 测           TDCP 解算航向角的稳定性和准确性优于多普
                量 [12-14] ,而本文提出利用 TDCP 计算得到的历元                  勒测速得到的航向角,可以将车辆 v 系的航向角
                间位置变化量来初始化大安装角,并构建安装角                            误差控制在±4°以内,由此大安装角的初始化误
                的观测方程。重点分析 TDCP 解算得到的历元                          差 主 要 取 决 于 组 合 导 航 的 姿 态 角 的 估 计 精 度 。
                间位置变化量以及车辆航向角的精度,并与多普                           (2)TDCP 在 E、N、天(up,U)3 个方向的解算精度
                勒测速的相关结果进行对比分析,实验中分别以                            均优于多普勒测速,使用 TDCP 计算得出的历元
                北云高精度组合导航解算出的车辆航向角、历元                            间位置变化量参与安装角滤波解算能提高安装
                间位置变化量和车辆瞬时速度作为参考真值,计                            角 估 计 精 度 。 由 此 可 知 ,直 线 行 驶 时 可 以 通 过
                算得到车辆直线行驶且满足安装角估计条件下                             TDCP 得到车辆航向角、准确的历元间位置变化
                的各项差值,结果见图 3,精度统计如表 1 所示。                        量来构建安装角的观测方程,有利于提高安装角
                在整个实验过程中,因为存在静止、低速行驶、转                           估计的精度和可靠性。


































                                     图 3 TDCP 与多普勒测速的历元间位置变化量、航向角计算误差
                        Fig. 3 Compute Errors of Inter-Epoch Position Variation and Heading Angles Calculated by TDCP and
                                                       Velocity of Doppler

                 表 1 TDCP 与多普勒测速的历元间位置变化量、航向角                    3.3 安装角估计结果及其分析
                                 计算误差统计                              经过安装角估计的初始化与滤波处理后,得
                    Table 1 Errors Statistics of Inter-Epoch Position
                                                                 到两组轨迹的智能手机安装角的航向角和俯仰
                  Variation and Heading Angles Calculated by TDCP and
                                                                 角结果(见图 4),子图中竖虚线左边为安装角初
                               Velocity of Doppler
                                                                 始化计算结果,右边为安装角滤波估计结果。每
                                    航向角        解算误差/m
                 实验场景     解算方式                                   组实验开始前,智能手机重新安置固定,实验过
                                   误差/(°)    E     N     U
                                                                 程中保持不变,从估计结果来看,两组实验的安
                           TDCP     0.789   0.074  0.081  0.226
                  轨迹一                                            装角存在一定的差异。与§3.2 类似,在整个实验
                         多普勒测速      1.961   0.331  0.288  0.713
                                                                 过程中存在无法进行安装角估计路段,如果整个
                           TDCP     0.830   0.086  0.084  0.206
                  轨迹二                                            导航过程中智能手机安置保持不变,则安装角相
                         多普勒测速      2.113   0.317  0.305  0.760
                                                                 对 稳 定 ,估 计 中 断 不 会 影 响 组 合 导 航 的 精 度 与
   12   13   14   15   16   17   18   19   20   21   22