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

第 50 卷第 10 期       王甫红等:智能手机 GNSS/MEMS IMU 车载组合导航的安装角估计算法                            1953






















                                                图 4 安装角初始化与滤波估计结果
                                   Fig. 4 Results of the Mounting Angle Initialization and Filter Estimation

                性能。                                                 安装角真值难以通过测量准确获得,如果安
                    从安装角估计结果可以看出:(1)实验中智                        装角估计正确,将组合导航得到的 n 系速度投影
                能 手 机 横 向 倾 斜 安 置 ,安 装 角 中 的 航 向 角 达 到          到 车 辆 v 系 ,其 侧 向 与 垂 向 速 度 分 量 将 接 近 于
                90°,属于大安装角估计。(2)两组轨迹的安装角初                       0 [13] 。 利 用 这 一 特 性 对 安 装 角 估 计 精 度 进 行 评
                始化所需要的时间差异较大,轨迹一需要约 80 s,                       估,分别将组合导航的 n 系速度投影到 IMU b 系
                轨迹二需要约 35 s,主要与组合导航启动阶段的                        和车辆 v 系,如图 5 所示。可以看出:(1)投影到

                车辆运动速度、转弯、观测条件和姿态角收敛速                           车辆 v 系的速度集中在前向、侧向与垂向的速度
                度相关,轨迹一受到武汉大学校园内的严重遮挡                           大多在±0.2 m/s 内波动。这说明本文算法估计
                环 境 影 响 ,需 要 较 长 的 时 间 才 能 初 始 化 成 功 。          出的安装角准确度较高,可以有效将车辆速度改
               (3)安装角滤波估计收敛后,安装角的估计值波                           正到前向。(2)车辆侧向与垂向速度偶尔会有接
                动小于 2°,因为安装角与姿态角存在耦合关系,安                        近 1 m/s 的波动,两个方向速度产生波动的时间

                装角的波动与姿态角估计精度存在一定的关系,                           一致。这些波动主要集中在角度较大的转弯处,
                另外智能手机与车体之间并非固定连接,车辆震                           因为手机置于车辆前端,投影到 v 系计算时没有
                动也有可能会导致安装角产生微小的变化。                             考虑 NHC 杆臂影响。































                                             图 5 车辆 v 系与 IMU b 系的行驶速度投影
                               Fig. 5 Projection of Driving Velocity in the Vehicle v-Frame and the IMU b-Frame
   13   14   15   16   17   18   19   20   21   22   23