[发明专利]一种基于地图匹配的车载捷联惯导行进间精对准方法

权利要求书

1.一种基于地图匹配的车载捷联惯导行进间精对准方法，其特征在于，包括以下步骤：

步骤一、车辆在出发点进行快速粗对准；

步骤二、车辆行驶同时进行地图匹配，得到用于航位推算的定位点；

步骤三、车辆行驶一段时间后，检查地图定位数据是否有效，若无效，则返回步骤二；若有效，则进入步骤四；

步骤四、以地图匹配获得的定位点作为路标点开始航位推算；

步骤五、利用航位推算轨迹相似性原理进行航向误差角的迭代估计，迭代修正航向角。

2.根据权利要求1所述的对准方法，其特征在于，所述快速粗对准依靠捷联惯导测量的重力加速度g和地球自转角速度ω_ie，直接估算出从载体坐标系到导航坐标系的变换矩阵

3.根据权利要求1所述的对准方法，其特征在于，步骤二中，所述地图匹配分为两个独立的过程：寻找车辆当前行驶的道路和将定位点投影到车辆行驶的道路上。

4.根据权利要求3所述的对准方法，其特征在于，所述将定位点投影到车辆行驶的道路上，包括：

1)预处理：对定位原始数据进行数据平滑和粗差剔除；

2)路段搜索：采用迭代多分辨率移动相关法在地图数据库中搜索到与行车轨迹段对应的路段；

3)曲线投影：采用最小二乘法来辨识出捷联惯导定位轨迹曲线与数字地图曲线之间的一个旋转参数、一个尺度参数和两个平移参数，使得变换后两曲线间对应点的距离平方和最小；

4)定位修正：引入数字地图定位点和捷联惯导定位点进行组合导航卡尔曼滤波的融合补偿方法，对存在的垂直道路的横向误差进行定位修正。

5.根据权利要求1所述的对准方法，其特征在于，步骤三中，所述车辆行驶时间为6到10分钟。

6.根据权利要求1所述的对准方法，其特征在于，步骤四中，所述航位推算由捷联惯导和里程计组成的航位推算系统来完成，推算过程包括位置更新和姿态更新；将所述捷联惯导提供的姿态、航向信息和所述里程计提供的速度或者里程信息相结合，进行车辆相对于起始点相对位置的推算。

7.根据权利要求1所述的对准方法，其特征在于，步骤五中，所述迭代估计包括以下步骤：

1)以公式和公式进行δψ与δK_D的初步估计，并以此修正初始时刻的航向角ψ与里程计刻度系数K_D；所述δψ为航向误差角，δK_D为里程计刻度系数误差，所述为起始点到路标点的矢量水平投影，为航位推算矢量水平投影，N为初步估计选取位置点的个数，i＝1,…,N；

2)再次调取存储的N个位置点处的角速度、比力和速度信息，重新进行捷联解算与航位推算，以新推算航位位置结果再次估计航向误差角δψ与里程计刻度系数误差δK_D，修正航向角ψ与里程计刻度系数K_D；

3)通过连续的迭代计算，将误差带来的影响消除至最小。