[发明专利]基于三维空间密集存储区域的多机器人路径规划方法

摘要

本发明涉及一种基于三维空间密集存储区域的多机器人路径规划方法，其技术特点是包括调度服务器内的主线程和并行执行的规划线程、避碰线程和执行线程，主线程初始化一张三维立体网状路径图并实时更新，规划线程划分任务、任务路径、标记任务路径并送入执行队列，避碰线程划分冲突区，并执行命令前的命令转义任务，执行线程向移动机器人或电梯机器人发送执行命令。本发明通过不同种类机器人接力操作、共同完成该任务行走路线的方法，实现了移动机器人和电梯机器人自动切换并且跨楼层任意存取货物的需求，具有高效率、合理性、实时性等特点。

主权项

一种基于三维空间密集存储区域的多机器人路径规划方法，其特征在于：包括调度服务器内的主线程和并行执行的规划线程、避碰线程和执行线程， 所述的主线程包括以下步骤： 步骤1：主线程初始化一张三维立体网状路径图； 步骤2：主线程实时接收移动机器人当前位置的命令反馈信息，根据反馈信息实时更新三维网状立体路径图； 所述的规划线程包括以下步骤： 步骤1：规划线程检测到有存取货物任务时，获取起始点和目标点信息并将任务划分若干个子任务，每个子任务下又划分任务阶段，每个任务阶段又设有各自的起始点和目标点； 步骤2：规划线程根据子任务的起始点、目标点及输入参数使用图搜索法输出当前子任务的密集存储区域三维空间任务路径； 步骤3：规划线程判断该子任务目标点是否被上一个的任务释放掉，如果已经被释放，则进入步骤4，否则等待释放； 步骤4：规划线程使用携带机器人行走方向及排序特征的任务编号标记每个任务路经； 步骤5：规划线程标记完所有任务路径后，将标记后的任务送入执行队列，返回步骤2； 所述的避碰线程包括以下步骤： 步骤1：避碰线程执行任务队列的各任务抢占资源变量； 步骤2：避碰线程根据当前环境信息划分冲突区； 步骤3：避碰线程判断冲突区是否释放干净，如果释放干净转入步骤4；如果没有释放干净，继续等待； 步骤4：避碰线程完成移动机器人和电梯机器人执行命令前的命令转义任务； 步骤5：避碰线程释放资源变量给调度服务器； 所述的执行线程包括以下步骤： 步骤1:执行线程到执行队列等待经过转义后的任务； 步骤2:执行线程判断是否有未发送出去的命令，如果有未发送命令，进入步骤3，如果没有未发送命令,返回步骤1； 步骤3：执行线程根据执行体类型的不同，划分阶段，每个阶段内最后一个命令为本阶段的阶段结束命令； 步骤4：判断上一阶段命令是否全部执行完成，如果完成，则发送当前阶段除阶段结束命令以外的其它命令，并且转入步骤5，如果上一阶段命令还未完成，执行步骤6； 步骤5：执行线程判断下一个任务阶段的机器人执行体，是否准备就绪，如果准备就绪，发送本阶段的阶段结束命令，并将下一阶段指定为当前阶段，转入步骤7；如果没有准备就绪，转入步骤6； 步骤6：将当前未完成的任务放回执行队列，并且返回步骤4； 步骤7:返回步骤1。