[发明专利]一种基于视觉与毫米波雷达融合的列车定位方法

说明书

本发明公开了一种基于视觉与毫米波雷达融合的列车定位方法，通过视觉进行图像特征提取，融合全局特征与局部特征，其中全局特征通过深度学习进行提取，局部特征通过直线检测及直线特征描述子进行提取，可以使对图像的特征提取更加充分；在进行关键位置查找时，分别进行全局特征相似度度量和局部特征相似度度量，可以使关键位置检测更精准；通过毫米波雷达进行列车车速测量，不依赖于车辆信号系统，通过毫米波雷达检测的障碍物进行反向车速推算得到列车车速。本发明利用车载传感器进行列车定位，不需依赖于路侧设备，可有效降低列车定位成本，并且，通过融合数据进行定位，可有效克服列车在隧道等环境下无法定位的难题。

技术领域

本发明涉及轨道列车无人驾驶自主环境感知及定位技术领域，尤其涉及一种基于视觉与毫米波雷达融合的列车定位方法。

背景技术

随着我国城市规模的高速发展，城市化进程的逐步加快，城镇人口和人均机动车保有量水平急速增加，交通拥堵现象日益严重。具有载客量大、运送效率高、能源消耗低的城市轨道交通已经成为缓解城市交通拥堵问题的必然选择。

列车无人驾驶系统在列车运行过程中不依赖于驾驶员，可以有效提升列车运行效率及运行安全。列车无人驾驶系统需要实时精准的列车位置，精准的列车位置信息可以为车辆调度和车速控制提供重要的保障。

现阶段主要通过在路侧安装路基设备，如应答器等，进行列车定位，该方法存在布设周期长、布设成本高的缺点。近年来，部分研究人员通过车载传感器，如通过车载北斗定位系统或车载GPS系统，进行列车实时定位，该方法在卫星信号较好时可以很好地进行列车定位，然而，当卫星信号受遮挡或缺失时，该方法无法满足实际应用需求。

发明内容

有鉴于此，本发明提供了一种基于视觉与毫米波雷达融合的列车定位方法，用以通过融合视觉图像数据与毫米波雷达数据，实现列车在包含隧道等环境线路中的自主定位。

本发明提供的一种基于视觉与毫米波雷达融合的列车定位方法，包括如下步骤：

S1：在列车车头位置处安装相机和毫米波雷达传感器，通过安装的相机和毫米波雷达传感器采集整条线路的同步数据；其中，将相机和毫米波雷达传感器采集数据的时间截最近的两帧数据作为同步数据；

S2：选取线路中的关键位置，从采集的同步数据中获取关键位置图像，对所述关键位置图像进行特征提取，建立关键位置视觉数据特征库；

S3：在列车运行过程中，利用相机实时采集图像，并对实时采集的图像进行特征提取；

S4：将实时采集的图像的特征与所述关键位置视觉数据特征库中图像的特征进行相似度度量，判断列车是否到达所述关键位置视觉数据特征库中图像对应的关键位置；若是；则对列车位置进行校准；若否，则利用毫米波雷达传感器实时测量列车的速度，对测得的速度进行积分，预测列车在两个关键位置区间内的位置。

在一种可能的实现方式中，在本发明提供的上述基于视觉与毫米波雷达融合的列车定位方法中，步骤S2，选取线路中的关键位置，从采集的同步数据中获取关键位置图像，对所述关键位置图像进行特征提取，建立关键位置视觉数据特征库，具体包括：

S21：选取线路中各站台位置为关键位置，从采集的同步数据中获取关键位置图像；

S22：对获取的每一帧关键位置图像进行全局特征提取，全局特征提取通过卷积神经网络实现；将各帧关键位置图像缩放到同一尺寸，利用一个卷积操作降低每一帧关键位置图像的特征图大小，利用反向残差网络进行特征提取，通过平均池化层得到1280维高维向量；对1280维高维向量进行L2正则化：

其中，d＝1280，表示高维向量的维度；(W₁,W₂,…W_d)为经过正则化后的高维向量，表示关键位置图像的全局特征；q＝1,2,...,d；