一种高架道路车载辅助导航算法及应用的制作方法

本发明涉及车载导航领域，尤其涉及一种高架道路车载辅助导航算法及应用。

背景技术：

目前大部分的车载导航采用gps导航技术，还有部分采用北斗导航技术，这两种导航技术的原理都是通过卫星信号对车辆进行定位，然后与地图信息系统进行比对从而规划导航路线。

在车辆行驶过程中，当遇到如图1所示的地面、高架并行道路时，现有的导航算法无法进行高架或地面道路的有效识别，必须等到地图信息系统中判断出高架与地面出现轨迹分岔时才能进行重新规划新的路线。在实际应用中，由于gps或北斗导航的精度误差，特别是在多个高架路口集中的路段，目前的导航算法无法进行快速、实时有效的规划，从而导致车载导航频繁的重新规划而耽搁行车效率。

如图1所示高架入口图，由于地面道路和高架道路并行，车辆在行驶过程中如果误上高架，由于导航精度的限制，传统的导航算法必须在高架道路与地面道路分岔时才能重新进行规划，如果在此行驶时段中遇到高架分流口或出入口，导航在此时将处于失效状态。因此，为了有效的提高导航准确率和避免交通拥挤，需要一种准确的判断高架道路与地面道路的方法。

技术实现要素：

本发明目的是：解决现有技术中存在的无法进行高架或地面道路的有效识别、多个高架路口集中的路段无法进行快速、实时有效的规划等主要问题，准确的判断高架道路与地面道路，有效的提高导航准确率和避免交通拥挤。

本发明的技术方案是：

一种高架道路车载辅助导航算法，其特征在于：通过加速度传感器采集车辆重力方向实时加速度信号分量，结合地图信息系统，采用限定时窗内高架预判算法，所述高架预判算法的流程为：

(1)g方向加速度分量采集，利用加速度传感器测出重力g方向的加速度分量；

(2)倾角换算，分段计时，利用加速度测量倾角的原理，测出车辆行驶过程中的倾角α，同时对加速度信号达到一定阈值h时开始计时t，加速度信号小于阈值h时计时结束；阈值h是可以根据路面情况实现自动调节，在算法中阈值h以一个向量组[h]出现。向量组[h]的初始值由大量经验数据组成，必须进行高架路面上行下行的大量实测才能得到；高架预判算法在运行过程中，根据实际行驶过程中的实测加速度数据进行调节阈值h，并且得到满足阈值h条件下的t；其中h＝[h1,h2,h3...,hn]，t＝[t1，t2，t3...tn]；

(3)高架预判算法，所述高架预判算法的核心是对满足h条件下的分段时间t进行判定；分段时间t也是一个向量组，判定过程中t必须首先设置一个经验值，经验值源于大量的实际路况实测数据，然后利用此经验值设置阈值t＝[t1，t2，t3...tn]；当实测满足阈值h的时间数据t与阈值t进行比较时，符合阈值t的条件下，即满足以下公式判定是高架道路；

(4)匹配地图信息，根据实测得到满足阈值的数据倾角α、时间t后，将所述数据与地图信息进行匹配，如在地图信息上出现高架并行道路，则判定为高架道路入口或出口；同时，根据倾角α的正负信息，可以判定是高架上行或下行；如果与地图信息不匹配，则重新返回到第一步进行重力方向加速度分量采集，重复(1)至(4)的算法过程；

(5)高架道路判定及规划行驶方案，当高架预判算法判定高架道路成功后，高架预判算法将重新对导航规划进行实际道路规划。

优选的，在步骤(2)中利用加速度测量倾角的原理，测出车辆行驶过程中的倾角α的公式为：

其中ax＝gsinα，ax是x轴方向加速度分量，ay为y轴方向加速度分量，az为z轴方向加速度分量，axg代表重力方向加速度分量。

一种高架道路车载辅助导航算法的应用，采用三轴加速度传感器，利用重力方向加速度与行驶方向加速度组合计算车辆在重力方向的加速度分量来得到车辆行驶过程中的倾角状态。

优选的，采用二轴加速度传感器，利用行驶方向加速度测量重力方向的加速度分量来得到车辆行驶过程中的倾角状态。

本发明的优点：

1、本发明所述的高架道路车载辅助导航算法及应用硬件实现成本低。

2、本发明所述的高架道路车载辅助导航算法及应用提高导航准确度，方便、迅捷进行实时规划路径；

3、本发明所述的高架道路车载辅助导航算法支持gps、北斗等多系统导航，适配性好，通用性强。

4、本发明所述的高架道路车载辅助导航算法及应用算法简单，可移植性高，适用于导航仪、手机、pad等便携式设备。

附图说明

下面结合附图及实施例对本发明作进一步描述：

图1为高架道路与地面道路平行入口示意图。

图2为本发明所述高架道路车载辅助导航算法的空间加速度示意图。

图3为本发明所述高架道路车载辅助导航算法的流程图。

具体实施方式

下面结合附图及优选实施方式对本发明技术方案进行详细说明。

本发明公开了一种高架道路车载导航算法及应用，所述应用也就是硬件实现，通过加速度传感器采集车辆重力方向实时加速度信号分量，结合地图信息系统，发明了一种限定时窗内高架预判算法，并可以通过硬件实现。

一种高架道路车载辅助导航算法，其特征在于：通过加速度传感器采集车辆重力方向实时加速度信号分量，结合地图信息系统，采用限定时窗内高架预判算法，所述高架预判算法的流程为：(1)利用加速度传感器测出重力g方向的加速度分量；(2)利用加速度测量倾角的原理，测出车辆行驶过程中的倾角α，同时对加速度信号达到一定阈值h时开始计时t，加速度信号小于阈值h时计时结束；阈值h是可以根据路面情况实现自动调节，在算法中阈值h以一个向量组[h]出现。向量组[h]的初始值由大量经验数据组成，必须进行高架路面上行下行的大量实测才能得到；高架预判算法在运行过程中，根据实际行驶过程中的实测加速度数据进行调节阈值h，并且得到满足阈值h条件下的t；其中h＝[h1,h2,h3...,hn]，t＝[t1，t2，t3...tn]；(3)高架预判算法的核心是对满足h条件下的分段时间t进行判定；分段时间t也是一个向量组，判定过程中t必须首先设置一个经验值，经验值源于大量的实际路况实测数据，然后利用此经验值设置阈值t＝[t1，t2，t3...tn]；当实测满足阈值h的时间数据t与阈值t进行比较时，符合阈值t的条件下，即满足以下公式时，判定是高架道路；(4)根据实测得到满足阈值的数据倾角α、时间t后，将所述数据与地图信息进行匹配，如在地图信息上出现高架并行道路，则判定为高架道路入口或出口；同时，根据倾角α的正负信息，可以判定是高架上行或下行；如果与地图信息不匹配，则重新返回到第一步进行重力方向加速度分量采集，重复(1)至(4)的算法过程；(5)当高架预判算法判定高架道路成功后，算法将重新对导航规划进行实际道路规划。

由图2空间加速度示意图可以得出，ax＝gslmα。其中，ax是x轴方向加速度分量，ay为y轴方向加速度分量，az为z轴方向加速度分量，axg代表重力方向加速度分量。

空间倾斜角度的公式为：这是测量物体倾斜角度的基本原理公式。

当物体同时也有运动加速度的话，公式修正为同时满足下面两个条件【1】：

【2】

一种高架道路车载导航算法的应用，采用三轴加速度传感器，利用重力方向加速度与行驶方向加速度组合计算车辆在重力方向的加速度分量来得到车辆行驶过程中的倾角状态。其特点是精度高、可靠性好。

考虑到汽车是在地面行驶，大部分情况下处于x-z平面上运动，只有当车辆进行爬坡或者下坡时，y轴方向才会出现加速度分量。因此，在本发明中，只需要进行简化三轴加速度的测量方案，以重力方向加速度的分量axg来衡量车辆行驶过程中的倾角状态。

采用二轴加速度传感器，利用行驶方向加速度测量重力方向的加速度分量来得到车辆行驶过程中的倾角状态。其特点是低成本，与三轴加速度相比精度要低。本发明所述的高架道路车载辅助导航算法硬件实现成本低，提高导航准确度，方便、迅捷进行实时规划路径。

本发明所述的高架道路车载辅助导航算法支持gps、北斗等多系统导航，适配性好，通用性强。所述辅助导航算法简单，可移植性高，适用于导航仪、手机、pad等便携式设备。

本发明尚有多种实施方式，凡采用等同变换或者等效变换而形成的所有技术方案，均落在本发明的保护范围之内。