[发明专利]一种基于双目视觉的集卡定位与引导的方法及其系统

说明书

技术领域

本发明涉及一种集卡定位与引导的方法及其系统，尤其是一种利用双目视觉技术针对集卡前往码头或集装箱堆场时的定位与引导的方法及其系统。

背景技术

目前，在码头或堆场的集装箱操作中，为提高工作效率，通常需要集装箱卡车(简称集卡)按既定车道进入到场地的指定位置之后，起重机才开动大车至集卡上方，放下吊具进行抓箱或放箱，在这个过程中，集卡是否进入到场地的指定位置通常需要额外的人员进行指挥，使整个集装箱的抓放操作效率变得低下。

为解决上述问题，国内外许多企业、学者提出了不同的方案，其中与本发明最近的技术方案包括：发明专利(公开号：CN101096262A，名称：集装箱起重机的集卡车对位系统和方法)利用摄像机拍摄集装箱卡车图像并与起重机吊具轮廓比对完成粗定位，然后利用激光扫描集装箱卡车进行精确定位，该方案效率低、成本高；发明专利(公开号：CN103324198A，名称：一种基于计算机视觉技术的集卡定位自动引导系统及其使用方法)与本发明的技术方案最接近，其不同点在于：(1)该发明技术方案中需提前将集卡上的目标特征及其理论位置预先设定在主控机内，如果一辆未知集卡进入工作场所，则无法识别，因此其工作效率较低，而本发明技术方案中将目标特征确定为未装载集装箱时集卡车头的两个锁头中心点的连线或装载集装箱时集卡上面的集装箱上靠近车头的两个锁孔中心点的连线，该目标特征无需预先设定，而是通过机器学习算法自动、实时识别；(2)该发明技术方案中，需要司机将集卡开到固定的贝位上才能进行后续定位，而本发明技术方案中可通过帧差法自动检测集卡是否进入工作场所，其自动化程度及工作效率明显提高；(3)该发明技术方案中，利用摄像设备摄取现场图像并通过图像处理软件获取目标特征的实时位置，该方法给出的方案并不明确，同时因目标特征距离地面存在一定的高度，该方法无法得到其准确的物理位置，而本发明技术方案中利用计算机视觉的三维重建技术获得其物理位置将更准确且方法更加明确；(4)该发明技术方案中，其标识物固定在吊具上，在每次定位引导过程中均需识别一次，而本发明技术方案中，标识物为固定喷涂在地面上，整个系统只需一次标定即可，效率更高。

发明内容

本发明要克服现有集卡定位与引导技术方案的不足，提供一种基于双目视觉的集卡定位与引导的方法及其系统。

本发明的技术方案为：

一种基于双目视觉的集卡定位与引导的方法，包括如下步骤：

步骤1：对工业相机进行标定，并建立以两台工业相机的中点为世界坐标原点的三维坐标系，其中x轴与y轴构成的坐标平面与地面平行，同时建立x-y平面坐标到引导电子看板平面坐标的映射；

步骤2：两台工业相机分别拍摄定位标识线，基于双目视觉的三维重建技术计算得到定位标识线在x-y平面的中点坐标；

步骤3：利用其中一台工业相机按一定的帧频拍摄引导车道的图像，并以帧差法监测车道上是否有集卡进入视场；

步骤4：确认有集卡进入视场后，两台工业相机按相同帧频同时拍摄集卡图像，以帧差法实时识别并跟踪集卡，通过机器学习算法自动、实时识别集卡目标特征，基于双目视觉的三维重建技术计算并建立集卡目标特征在x-y平面的坐标；所述集卡目标特征识别过程为：当集卡未装载集装箱时，识别集卡车头的两个锁头，将其中心点的连线作为集卡目标特征；当集卡已经装载集装箱时，识别集卡上面的集装箱上靠近车头的两个锁孔，将其中心点的连线作为集卡目标特征；

步骤5：在引导电子看板中绘制定位标识线的图形，同时根据步骤4中计算得到的集卡目标特征的坐标绘制并刷新集卡图像在引导电子看板上的十字线，该十字线的一条线与集卡前进方向一致，另一条线与前进方向垂直；

步骤6：计算集卡目标特征的中心点到定位标识线中心点在x-y平面上的距离并在引导电子看板上显示；

步骤7：计算十字线中与集卡前进方向垂直的直线与定位标识线的夹角，并在引导电子看板中显示；

步骤8：集卡司机根据引导电子看板显示的距离以及夹角移动车辆，当距离小于20mm且夹角小于0.25度时，完成集卡定位与引导；

作为优选，所述一种集卡定位与引导系统的工作步骤中步骤5在电子看板中绘制图形的频率、步骤6在电子看板中显示距离的频率和步骤7在电子看板中显示夹角的频率与步骤4的图像采集频率相同。