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

摘要

基于双目视觉的集卡定位与引导的方法，包括对工业相机进行标定，并建立以两台工业相机的中点为世界坐标原点的三维坐标系；计算得到定位标识线在x‑y平面的中点坐标；监测车道上是否有集卡进入视场；识别集卡目标特征；在引导电子看板上的十字线；计算集卡目标特征的中心点到定位标识线中心点在x‑y平面上的距离并在引导电子看板上显示；计算十字线中与集卡前进方向垂直的直线与定位标识线的夹角，并在引导电子看板中显示；集卡司机根据引导电子看板显示的距离以及夹角移动车辆，完成集卡定位与引导。使用本发明方法的系统，由安装支架、两台工业相机、引导电子看板、定位标识线和工控机构成。

主权项

一种基于双目视觉的集卡定位与引导的方法，包括如下步骤：步骤1：对工业相机进行标定，并建立以两台工业相机的中点为世界坐标原点的三维坐标系，其中x轴与y轴构成的坐标平面与地面平行，同时建立x‑y平面坐标到引导电子看板平面坐标的映射；步骤2：两台工业相机分别拍摄定位标识线，基于双目视觉的三维重建技术计算得到定位标识线在x‑y平面的中点坐标；步骤3：利用其中一台工业相机按一定的帧频拍摄引导车道的图像，并以帧差法监测车道上是否有集卡进入视场；步骤4：确认有集卡进入视场后，两台工业相机按相同帧频同时拍摄集卡图像，以帧差法实时识别并跟踪集卡，通过机器学习算法自动、实时识别集卡目标特征，基于双目视觉的三维重建技术计算并建立集卡目标特征在x‑y平面的坐标；所述集卡目标特征识别过程为：当集卡未装载集装箱时，识别集卡车头的两个锁头，将其中心点的连线作为集卡目标特征；当集卡已经装载集装箱时，识别集卡上面的集装箱上靠近车头的两个锁孔，将其中心点的连线作为集卡目标特征；步骤5：在引导电子看板中绘制定位标识线的图形，同时根据步骤4中计算得到的集卡目标特征的坐标绘制并刷新集卡图像在引导电子看板上的十字线，该十字线的一条线与集卡前进方向一致，另一条线与前进方向垂直；步骤6：计算集卡目标特征的中心点到定位标识线中心点在x‑y平面上的距离并在引导电子看板上显示；步骤7：计算十字线中与集卡前进方向垂直的直线与定位标识线的夹角，并在引导电子看板中显示；步骤8：集卡司机根据引导电子看板显示的距离以及夹角移动车辆，当距离小于20mm且夹角小于0.25度时，完成集卡定位与引导。