[发明专利]路径规划方法及装置

摘要

本发明提供一种路径规划方法及装置，包括以下步骤：获取机器人组当前的位置状态；当第一机器人和所述机器人组中除所述第一机器人外的其他机器人的距离小于第一阈值时，将比较结果为小于所述第一阈值的两个机器人的位置状态记录在碰撞信息列表中；基于所述碰撞信息列表，应用拓扑排序法进行死锁环检测；当存在所述死锁环时，应用预设的避障区规划法，解除所述死锁环并重新规划机器人路径。本发明的路径规划方法及装置能够高效地检测出机器人间的碰撞、死锁现象，进而更准确地规划机器人路径；在实际应用中不占用物理机和虚拟机资源，在软件中即可运行，提高执行效率；此外应用场景广泛，可满足仿真环境下数千码点内的各种路径规划需求。