[发明专利]一种多激光扫描器的激光导引AGV导航定位方法及装置

说明书

技术领域

本发明涉及激光导航定位领域，属于自动导引运输车(AGV)在采用激光导航定位时所涉及的导航定位方法领域，具体为一种多激光扫描器的激光导引AGV导航定位方法及装置。

背景技术

激光导引AGV(Automated Guided Vehicle)广泛应用于工业、军事、烟草、智能停车库中的自动化搬运系统中，它是通过激光扫描扫描器并结合导航定位算法实现对AGV的定位。激光扫描器以设定的扫描频率和分辨率连续发射激光束到周围环境，并接受物体反射回的激光束，依据光的飞行时间计算出激光器到物体的距离，并将数据输出到AGV的车载控制计算机，AGV的车载控制计算机通过导航定位算法实时计算出AGV的位姿(x，y，theta)。目前激光导引AGV均采用单一的激光扫描器，并将激光扫描器通过高高的支柱安装于AGV的最高处，使激光扫描器处于距地面约2m高的位置，可避免行人、物体和AGV本身对激光器的遮挡，但是这限制了激光导引AGV在高度空间受限场合中的应用。对需要钻入托盘或运载货物下面的潜入式AGV、无激光器安装支柱的扁平化AGV或高度受限的AGV中，激光扫描器需安装在AGV的前后端面或左右侧面，这将受到AGV本身的遮挡，影响激光雷达的视野范围，这严重制约了激光导引AGV朝着扁平化、潜入式结构方式的发展，约束了激光导引AGV在高度受限场合的应用。

发明内容

针对上述现有技术中存在的问题和不足，本发明旨在提供一种多激光扫描器的激光导引AGV导航定位方法及装置，通过在AGV的前后端面或侧面安装多个激光扫描器扩大视野，通过将多个扫描器的数据进行融合，从而完成对AGV位姿的实时计算，解决了激光扫描器因安装高度或障碍物等受限进行导航的场合的应用的问题，使得AGV导航定位能够用于扁平化、潜入式结构应用领域，本发明的算法实时性强、易于实现工程应用，具有稳定和精准的导航定位能力。

具体的，本发明是这样实现的：一种多激光扫描器的激光导引AGV导航定位方法，包括步骤：

S01：AGV车体上安装有两个激光扫描器，两个激光扫描器分别对扫描区域A1和扫描区域A2的原始激光扫描数据进行采集，并对采集数据进行滤波及数据预处理；

S02：对S01中滤波和数据预处理后的数据进行特征提取，获取激光扫描数据的特征数据；

S03：对S02中获取的特征数据提取点、直线段或圆弧中的一种或几种特征数据，并对所提取点、直线段或圆弧特征数据分别进行关联匹配，获得关联匹配数据；

S04：从AGV车体上的控制器中获取行车数据；

S05：对激光扫描数据进行数据融合，所述数据融合是根据关联匹配数据和行车数据对多个激光扫描器的数据进行叠加、拼接的融合运算处理，数据融合运算处理后获得一组融合数据；

S06：判断AGV车载控制器中是否存有已建立的电子地图：若电子地图已建立则进入步骤S08导航模式，否则进入步骤S07建图模式；

S07：所述建图模式，是根据步骤S05中获取的融合数据建立AGV对环境特征的电子地图，并保存在AGV车载控制器，然后进入步骤S08；

S08：导航模式，AGV车载控制器进行实时计算AGV的位置和姿态数据，同时探测AGV前进方向的障碍物，并将计算结果和障碍检测结果发送给AGV车载控制器，完成对AGV的导航。

进一步的，步骤S02中所述特征数据包括自然轮廓特征数据或人工地标特征数据或两者的混合数据。

进一步的，所述自然轮廓特征数据包括特征点数据、直线段数据、圆弧数据；所述人工地标包括平面或圆柱形反射胶贴；

进一步的，步骤S04中所述的行车数据指：行走编码器数据、转向编码器数据、陀螺仪数据。

进一步的，步骤S05中所述融合运算处理的处理过程由“昆船AGV激光导航算法V1.0”进行数据融合运算处理。

一种多激光扫描器的激光导引AGV导航定位装置，包括AGV车体、置于AGV车体上的车载控制器，驱动AGV车体移动的驱动装置，其特征在于于AGV车体上安装有至少两个激光扫描器：AGV车体前端安装有第一激光扫描器，第一激光扫描器的扫描区域A1，于AGV车体后端安装有第二激光扫描器，第二激光扫描器的扫描区域A2。

进一步的，所述第一激光扫描器和第二激光扫描器可分别安装于AGV车体的正前端和正后端，二者沿AGV车体中线安装布置，且二者均安装于同一安装平面A上。