一种牵引车与挂车的定位方法、系统、存储介质及车辆

    公开(公告)号:CN114859319A

    公开(公告)日:2022-08-05

    申请号:CN202210460585.X

    申请日:2022-04-28

    IPC分类号: G01S7/48

    摘要: 本发明公开了一种牵引车与挂车的定位方法、系统、存储介质及车辆,包括以下步骤:在半挂车前表面固定有标识板底座,标识板底座上设置有标识板,采集半挂车与牵引车脱挂状态下的点云数据,建立最小包围盒,对点云数据进行计算,得到标识板第一次中心坐标;根据得到的标识板第一次中心坐标设定小邻域搜索,对小邻域搜索得到的点云数据进行平面方程拟合,计算挂车前表面法向量;根据得到的标识板第一次中心坐标设定大邻域搜索,将大邻域搜索得到的点云数据分类排序,筛选平面上的点云数据及其所在线束;对应标识板底座的宽度,查找各线束的边界点,筛选位于平面上的线束,计算得到标识板第二次中心坐标。以此实现牵引车与挂车相对位置的快速精准确定。