专利号：2022105336297

一种基于工业相机和多线激光雷达的半挂车定位方法及系统，涉及牵引车与半挂车定位技术领域，用以解决现有定位方法对于小型码头上牵引车与半挂车相对位置的确定精确度不高的问题。本发明的技术要点包括：设置二维码、工业相机与激光雷达的位置，利用工业相机检测二维码，提取中心坐标；利用激光雷达采集点云，在指定半径范围内查询，由搜索出的点云拟合二维码平面方程，得到半挂车前表面法向量及夹角；创建K‑D树，指定半径范围查询，得到大邻域点云并分类排序，筛选出与二维码同平面的点云并确定其所在线束；对应二维码底座的宽度，查找各线束的边界点，筛选位于平面上的线束，计算得到二维码中心坐标。本发明可进一步应用于车辆定位领域。