[发明专利]自动化集装箱码头多自动引导车辆路径冲突消解方法

摘要

本发明公开了一种自动化集装箱码头多自动引导车辆路径冲突消解方法，包括：设定自动引导车辆路径的路径特征；将自动引导车辆的路径离散化为特征点和特征方向，特征点是从路径轨迹上取出的有限数量的点，特征方向是特征点的方向；对自动引导车辆的路径进行动态划分，将路径的特征点集按行驶顺序划分为四个子集：已过点子集、占用点子集、申请点子集和探测点子集；依据方向包围盒方法检测特征点冲突；预测路径冲突，并在可能发生路径冲突时，调整部分路径以避免路径冲突；有新的自动引导车辆路径生成时，对新生成的路径执行步骤一和步骤二；按照确定的时间间隔反复执行步骤三到步骤五，直至所有的自动引导车辆都到达终点结束行驶。

主权项

1.一种自动化集装箱码头多自动引导车辆路径冲突消解方法，其特征在于，包括：步骤1，设定自动引导车辆路径的路径特征；步骤2，将自动引导车辆的路径离散化为特征点和特征方向，特征点是从路径轨迹上取出的有限数量的点，特征方向是特征点的方向；步骤3，对自动引导车辆路径进行动态划分，将路径的特征点集按行驶顺序划分为四个子集：已过点子集、占用点子集、申请点子集和探测点子集；步骤4，依据方向包围盒方法检测特征点冲突；步骤5，预测路径冲突，并在可能发生路径冲突时，调整部分路径以避免冲突；步骤6，有新的自动导引车辆路径生成时，对新生成的路径执行步骤1和步骤2；步骤7，按照确定的时间间隔反复执行步骤3到步骤5，直至所有自动引导车辆都到达终点结束运动，其中，步骤3进一步包括：步骤3.1：自动引导车辆的路径生成后，在第一次动态划分之前，将路径的起始点加入占用点子集，其余点加入探测点子集；步骤3.2：动态划分开始，此时探测点子集应为空；根据当前的自动引导车辆车身中点位置，将占用点子集中靠近路径起点且到车身中点的距离大于预设值的所有特征点转移到已过点子集中，所述预设值大于车身长度的一半，转入步骤3.3；步骤3.3：根据当前的自动引导车辆车身中点位置和瞬时速度计算最远申请距离，得到路径前方到自动引导车辆车身中点距离小于该距离的最远特征点T；如果该点在探测点子集范围内，转入步骤3.4；否则，该点应在占用点子集范围内，转入步骤3.5；步骤3.4：如果T点所在的子路径为直行子路径，则将T点自身和探测点子集内排在T点后方的特征点转移到探测点子集；否则，将T点所在子路径的所有特征点全部转移到探测点子集，转入步骤3.5；步骤3.5：本次动态划分结束，转入路径占用点子集更新阶段；一段时间以后开始一次新的动态划分，转入步骤3.2，其中，所述步骤4进一步包括以下判断原则：第i次动态划分后，若路径j的申请点子集中的某个特征点与路径j’的申请点子集中的某个特征点冲突，则认为路径j的申请点子集与路径j’的申请点子集存在冲突关系；第i次动态划分后，若路径j的申请点子集中的某个特征点与路径j’的占用点子集中的某个特征点冲突，则认为路径j的申请点子集与路径j’的占用点子集存在冲突关系；第i次动态划分后，若路径j的申请点子集中的某个特征点与路径j’的探测点子集中的某个特征点冲突，则认为路径j的申请点子集与路径j’的探测点子集存在冲突关系；第i次动态划分后，若路径j的占用点子集中的某个特征点与路径j’的探测点子集中的某个特征点冲突，则认为路径j的占用点子集与路径j’的探测点子集存在冲突关系。