[发明专利]一种应用于多AGV协作运行的调度控制方法及系统

摘要

本发明涉及一种应用于多AGV协作运行的调度控制方法、装置及系统，其中方法包括：规划当前AGV的当前任务行走路径；检测当前任务行走路径上是否有冲突点，有则转抢占判断步骤；否则规划正在执行路径并转任务执行步骤；找出最远不冲突点作为正在执行路径，检测正在执行路径不为空时转任务执行步骤，检测正在执行路径为空时判断是否满足抢占条件，是则抢占，否则等待预设时间转冲突点检测步骤；控制当前AGV前进执行任务，正在执行路径完毕判断当前任务是否存在剩余路径，是则转冲突点检测步骤，否则将当前AGV切换为空闲状态。本发明可以满足多AGV无堵塞、无碰撞的作业，可以保证AGV的作业效率。

主权项

1.一种应用于多AGV协作运行的调度控制方法，其特征在于，包括以下步骤：路径规划步骤：规划当前自动引导运输车AGV的当前任务行走路径；冲突点检测步骤：检测所述当前任务行走路径上是否有冲突点，所述冲突点为当前任务行走路径与调度区域内其它AGV的行走路径重合的路径点，有则转抢占判断步骤，否则规划正在执行路径并转任务执行步骤；抢占判断步骤：找出最远不冲突点作为正在执行路径，检测正在执行路径不为空时转任务执行步骤，检测正在执行路径为空时判断是否满足抢占条件，是则抢占，否则等待预设时间转冲突点检测步骤；任务执行步骤：控制当前AGV前进执行任务，正在执行路径完毕判断当前任务是否存在剩余路径，是则转冲突点检测步骤将剩余路径作为当前任务行走路径判断是否有冲突点，否则将当前AGV切换为空闲状态；所述抢占判断步骤中通过以下公式判断是否满足抢占条件：||PB‑PC||≥TQ；其中PB为与当前AGV冲突的冲突AGV所在位置，PC为冲突点的位置，||PB‑PC||为冲突AGV从所在位置到冲突点位置的时间；所述TQ为当前AGV抢占冲突点的时间；所述抢占判断步骤中通过以下公式计算：其中T_BZ为冲突AGV的转弯时间，C_BZ为冲突AGV到冲突点位置的转弯数量，为冲突AGV从所在位置到冲突点位置行走的直线距离的时间总和，S_BL为冲突AGV从所在位置到冲突点位置行走的各个子路径的距离，V_B为冲突AGV的行走速度。