一种列车自动驾驶感知方法和系统与流程
本发明属于轨道交通技术领域,具体涉及一种列车自动驾驶感知方法和系统。
背景技术:
铁路运输为钢铁、煤炭等各领域提供了重要的货物运送保障,是一种重要的运输方式。列车的高效、安全运行直接影响着各个行业的发展,而在铁路运输过程中铁路线会有侵入物或障碍物出现的现象,影响了铁路运输的安全性和高效性。为避免重大事故的发生,需要对列车前方侵入物或障碍物进行检测。列车运行前方轨道上侵入物或障碍物的检测具有距离长、岔道多和区域复杂的难点。
传统的入侵物或障碍物检测手段是在列车运行时采用瞭望员进行侵入物或障碍物的发现和报警,但这样的方式检测具有可靠性低、报警不及时,也不符合铁路运输无人化的发展要求。
相对于传统的检测方式,现今铁路线路入侵物或障碍物检测采用铁路轨道识别方式,轨道识别方式的识别区域限定在两根铁轨区域内,识别方式通常采用相机采集图像,运用图像处理方法对轨道进行提取。这样的检测方式对于多路岔道时,无法确定出列车行进方向的轨道区域,且相机成像受天气和光线的影响,造成区域限界不稳定、成像不高或无法成像的问题。
此外,列车运行前方侵入物或障碍物识别目前采用平面分割及聚类算法,将限界内的点云进行高度筛选及聚类分割,这样只能判断侵入物或障碍物的有无及大小,难以进行侵入物的分类,并且由于点云属于三维空间数据,不具备拓扑关系,处理速度相对较慢。
技术实现要素:
为解决上述技术问题,本发明提供一种列车自动驾驶感知方法和系统,具有界限区域稳定获取、线路定位精度高和障碍物识别计算速度快的优点。
一种列车自动驾驶感知方法,包括如下步骤,
步骤一:采集铁路线数据点构建高精度地图并存入车载主机;
步骤二:车载主机启动列车上的激光雷达设备;
步骤三:车载主机校正列车的初始位置与高精度地图的初始位置相一致;
步骤四:车载主机在高精度地图中提取列车前方的多个数据点作为界限区域中心点集,并根据界限区域中心点集绘制列车前方轨道在地图中的平面区域;所述界限区域中心点集为列车运行前方待感知区域的中心数据点集合;
步骤五:激光雷达开始进行数据采集,将采集数据形成激光雷达点云数据,车载主机将采集的激光雷达点云数据与轨道平面区域在水平面内做交集得到第二点云数据集;
步骤六:将第二点云数据集进行深度图像转换并采用轮廓匹配算法进行障碍物识别分类,并将分类结果发送到外部车控系统。
步骤一中,构建高精度地图包括如下步骤:
a1):将采集的铁路线数据点根据列车联锁信号,划分为不同的线路数据点子集,所述线路数据点子集为轨道线路中各岔道上的数据点,所述列车联锁信号包括信号机编号和岔道号;
a2):设置线路数据点子集各数据点之间的距离,所述数据点之间的距离满足列车速度传感器每输出两个脉冲信号,列车驶过地图上的一个数据点;
a3):将设置好的各线路数据点子集进行存储。
步骤一中,所述铁路线数据点为先验数据,所述先验数据利用rtk差分系统和imu惯性测量单元进行采集,所述先验数据包含信标位置编号、经纬度、海拔高度、航向角、俯仰角和横滚角,所述信标位置编号与铁路轨道上间隔设置的磁钢位置相对应。
步骤三中,车载主机校正列车的初始位置和地图初始位置相一致包括如下步骤:
b1):车载主机检测列车联锁信号中是否接收有轨道中任一磁钢输出的脉冲信号;若有,则转入步骤b2),否则,继续检测;所述磁钢为间隔设置在轨道上的列车传感设备,所述磁钢均按一定次序进行编号,且所述磁钢在列车车轮经过时输出脉冲信号;
b2):车载主机根据磁钢所在轨道的线路确定当前列车所在的岔道号,并根据岔道号读取高精度地图中与所述岔道号所对应的线路数据点子集;
b3):车载主机获取所述磁钢的编号,并根据所述磁钢的编号在线路数据点子集中确定与磁钢编号对应的信标位置,完成校正。
步骤四中,在高精度地图中提取列车前方多个数据点的方法为,以列车运行时任意时刻的位置在高精度地图中对应的位置点为基准点,以列车运行方向为方向,在高精度地图中提取前方多个数据点;提取的数据点数量由激光雷达的覆盖范围决定。
步骤四中,根据界限区域中心点集绘制列车前方轨道在地图中的平面区域包括如下步骤:
c1):对界限区域中心点集进行坐标转换,将世界坐标系数据点位置转化为激光雷达坐标系位置,得到转换后的数据点集;
c2):对转换后的数据点集进行线性拟合,以拟合后的线段为中心线,以轨道宽度为轮廓线,进行列车前方轨道在地图中平面区域的绘制。
步骤六中,将第二点云数据集进行深度转换包括如下步骤:
d1):将第二点云数据集进行平面分割得到分割后的点云数据集;
d2):将分割后的点云数据集向垂直面内做投影,转换为32位深度图像;
d3):对32位深度图像进行图像灰度开方运算,以填补图像中的数据空洞。
步骤六中,采用轮廓匹配算法进行障碍物的分类识别包括如下步骤:
e1):分别以行人图像数据、行人多种形态图像数据、行人多种动作图像数据、车辆图像数据和不同车辆图像数据为样本模板,提取模板的亚像素轮廓,并将提供的亚像素轮廓存入模板库;
e2):将激光雷达实时获取的第二点云数据与模板库的数据进行识别和分类。
一种列车自动驾驶感知系统,所述系统包括站防联锁信号系统、磁钢定位装置、速度传感器、激光雷达和车载主机,所述激光雷达、速度传感器和站防联锁信号系统均与车载主机通信连接,磁钢定位装置与站防联锁信号系统通信连接。
所述速度传感器为轮轴脉冲转速传感器,所述轮轴脉冲转速传感器与列车车轮同轴安装。
本发明公开了一种列车自动感知方法和系统,采用列车联锁信号、有源磁钢和高精度地图进行列车的精准定位,列车经过轨道上的有源磁钢时,有源磁钢发出脉冲信号至列车联锁信号,根据列车联锁信号从而确定列车在轨道上的位置,并根据有源磁钢的位置信息从高精度地图中调取相应的线路子数据集,车速传感器检测列车车轮转速,速度传感器每发出2个脉冲,列车经过地图上的一个数据点,实现了列车位置与地图数据的精准匹配,定位的精度高、可靠性强。
根据激光雷达的覆盖范围,根据列车运行方向在地图中提取一定量的数据点构成界限区域点集,将界限区域点集与激光雷达采集的数据在水平方向上做交集并进行平面分割得到界限分割后的点云,进行深度图像转换,将三维空间的点云进行平面投影形成深度图像,将复杂三位空间点云处理,转化为简单的二维图像处理,减少了计算量,提高计算精度。
附图说明
图1是列车自动驾驶感知方法流程图。
图2是轨道上磁钢位置示意图。
具体实施方式
下面将结合本发明中的附图,对本发明实施例中的技术方案进行清楚、完整地描述。显然,所描述的实施例仅仅是本发明一部分实施,而不是全部的实施,基于本发明的实施例,本领域普通技术人员在没有做、出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。
如图1所示,一种列车自动驾驶感知方法,包括如下步骤,
步骤一:采集铁路线数据点构建高精度地图并存入车载主机;
步骤二:车载主机启动列车上的激光雷达设备;
步骤三:车载主机校正列车的初始位置与高精度地图的初始位置相一致;
步骤四:车载主机在高精度地图中提取列车前方的多个数据点作为界限区域中心点集,并根据界限区域中心点集绘制列车前方轨道在地图中的平面区域;所述界限区域中心点集为列车运行前方待感知区域的中心数据点集合;
步骤五:激光雷达开始进行数据采集,将采集数据形成激光雷达点云数据,车载主机将采集的激光雷达点云数据与轨道平面区域在水平面内做交集得到第二点云数据集;
步骤六:将第二点云数据集进行深度图像转换并采用轮廓匹配算法进行障碍物识别分类,并将分类结果发送到外部车控系统。
步骤一中,构建高精度地图包括如下步骤:
a1):将采集的铁路线数据点根据列车联锁信号,划分为不同的线路数据点子集,所述线路数据点子集为轨道线路中各岔道上的数据点,所述列车联锁信号包括信号机编号和岔道号;
a2):设置线路数据点子集各数据点之间的距离,所述数据点之间的距离满足列车速度传感器每输出两个脉冲信号,列车驶过地图上的一个数据点;
a3):将设置好的各线路数据点子集进行存储。
所述列车自动驾驶感知方法中优选为速度传感器发出1个脉冲,列车行进5cm,速度传感器每发出2个脉冲,列车行进10cm,此时会经过地图上的一个数据点,高精度地图中各铁路线路数据点之间的距离优选设置为10cm。
步骤一中,所述铁路线数据点为先验数据,所述先验数据利用rtk差分系统和imu惯性测量单元进行采集,所述先验数据包含信标位置编号、经纬度、海拔高度、航向角、俯仰角和横滚角,所述信标位置编号与铁路轨道上间隔设置的磁钢1位置相对应,如图2所示。
步骤三中,车载主机校正列车的初始位置和地图初始位置相一致包括如下步骤:
b1):车载主机检测列车联锁信号中是否接收有轨道中任一磁钢1输出的脉冲信号;若有,则转入步骤b2),否则,继续检测;所述磁钢1为间隔设置在轨道上的列车传感设备,所述磁钢1均按一定次序进行编号,且所述磁钢1在列车车轮经过时输出脉冲信号;
b2):车载主机根据磁钢1所在轨道的线路确定当前列车所在的岔道号,并根据岔道号读取高精度地图中与所述岔道号所对应的线路数据点子集;
b3):车载主机获取所述磁钢1的编号,并根据所述磁钢1的编号在线路数据点子集中确定与磁钢1编号对应的信标位置,完成校正。
步骤四中,在高精度地图中提取列车前方多个数据点的方法为,以列车运行时任意时刻的位置在高精度地图中对应的位置点为基准点,以列车运行方向为方向,在高精度地图中提取前方多个数据点;提取的数据点数量由激光雷达的覆盖范围决定。
所述自动驾驶感知系统中的激光雷达的垂直视场角为8度,水平视场角为50度,水平分辨率为0.1度,垂直分辨率为0.08度,激光雷达的覆盖范围为10-110米,优选雷达的覆盖范围为110米,由于地图中每个数据点之间的距离为10cm,所以本方法中优选在高精度地图中提取前方1100个数据点作为界限区域中心点集,这样界限区域中心点集与激光雷达的最大覆盖区域相一致。
步骤四中,根据界限区域中心点集绘制列车前方轨道在地图中的平面区域包括如下步骤:
c1):对界限区域中心点集进行坐标转换,将世界坐标系数据点位置转化为激光雷达坐标系位置,得到转换后的数据点集;
c2):对转换后的数据点集进行线性拟合,以拟合后的线段为中心线,以轨道宽度为轮廓线,进行列车前方轨道在地图中平面区域的绘制。
步骤六中,将第二点云数据集进行深度转换包括如下步骤:
d1):将第二点云数据集进行平面分割得到分割后的点云数据集;
d2):将分割后的点云数据集向垂直面内做投影,转换为32位深度图像;
d3):对32位深度图像进行图像灰度开方运算,以填补图像中的数据空洞。
步骤六中,采用轮廓匹配算法进行障碍物的分类识别包括如下步骤:
e1):分别以行人图像数据、行人多种形态图像数据、行人多种动作图像数据、车辆图像数据和不同车辆图像数据为样本模板,提取模板的亚像素轮廓,并将提供的亚像素轮廓存入模板库;
e2):将激光雷达实时获取的第二点云数据与模板库的数据进行识别和分类。
一种列车自动驾驶感知系统,包括站防联锁信号系统、磁钢定位装置、速度传感器、激光雷达和车载主机,所述激光雷达、速度传感器和站防联锁信号系统均与车载主机通信连接,磁钢定位装置与站防联锁信号系统通信连接。
所述速度传感器为轮轴脉冲转速传感器,所述轮轴脉冲转速传感器与列车车轮同轴安装。
所述列车自动驾驶感知系统的工作过程如下:
所述磁钢定位装置为有源磁钢,当列车车轮接近有源磁钢是,有源磁钢输出正脉冲信号,到列车车轮从接近位置远离有源磁钢时,有源磁钢输出电压为0v。
所述列车自动驾驶感知系统的工作过程如下:
列车经过有源磁钢时,有源磁钢输出脉冲信号至站防联锁信号系统,根据站防联锁信号确定列车的位置,并根据站防联锁信号调取此时列车位置所在的地图的线路数据点子集。由于列车速度传感器每输出两个脉冲,列车前进10cm,与地图数据中的数据点之间的距离相一致,即列车在轨道上运行位置与地图中所在数据点的位置实时相一致。
以列车在地图数据点的位置为基准点,以列车运行方向为方向,提取1100个数据点构成界限区域中心点集,将界限中心点集进行坐标转换,将转换后的界限中心点集进行线性拟合,以拟合后的线段为中心线,以轨道宽度为轮廓线,绘制列车运行前方在地图中的平面区域。
将激光雷达采集到的点云数据在水平方向上与地图平面区域做交集,得到第二点云数据集,将第二点云数据集进行平面分割并在垂直方向上进行投影转换为32位深度图像,将转换后的深度图像采用轮廓匹配算法进行障碍物识别分类,并将分类结果发送到外部车控系统,实现障碍物或入侵物的感知。
本发明方案所公开的技术手段不仅限于上述实施方式所公开的技术手段,还包括由以上技术特征任意组合所组成的技术方案。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也视为本发明的保护范围。
起点商标作为专业知识产权交易平台,可以帮助大家解决很多问题,如果大家想要了解更多知产交易信息请点击 【在线咨询】或添加微信 【19522093243】与客服一对一沟通,为大家解决相关问题。
此文章来源于网络,如有侵权,请联系删除