CN102929279B - 基于三维空间密集存储区域的多机器人路径规划方法 - Google Patents

基于三维空间密集存储区域的多机器人路径规划方法 Download PDF

Info

Publication number
CN102929279B
CN102929279B CN201210440094.5A CN201210440094A CN102929279B CN 102929279 B CN102929279 B CN 102929279B CN 201210440094 A CN201210440094 A CN 201210440094A CN 102929279 B CN102929279 B CN 102929279B
Authority
CN
China
Prior art keywords
thread
task
execution
waypoint
planning
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201210440094.5A
Other languages
English (en)
Other versions
CN102929279A (zh
Inventor
杨宇
景国辉
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Aibo Technology Hainan Co ltd
Original Assignee
WUXI PUZHILIANKE HIGH-TECH Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by WUXI PUZHILIANKE HIGH-TECH Co Ltd filed Critical WUXI PUZHILIANKE HIGH-TECH Co Ltd
Priority to CN201210440094.5A priority Critical patent/CN102929279B/zh
Publication of CN102929279A publication Critical patent/CN102929279A/zh
Application granted granted Critical
Publication of CN102929279B publication Critical patent/CN102929279B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Abstract

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

Description

基于三维空间密集存储区域的多机器人路径规划方法
技术领域
本发明属于移动机器人领域,尤其是一种基于三维空间密集存储区域的多机器人路径规划方法。
背景技术
二维平面的多机器人路径规划技术已经取得了丰硕的成果并得到了广泛的应用。在现有的多移动机器人系统路径规划技术研究中,基本上是针对移动机器人在地面上行驶可能会发生的冲突而提出的二维平面路径规划解决方法,其冲突包括:地面上的路口冲突、地面上的赶超冲突、地面上的相向冲突。随着多移动机器人在密集存储区域应用的扩张,针对二维平面路径规划和冲突解决方法越来越满足不了实际应用需求,实际应用中,往往需要移动移动机器人跨楼层地在多层钢筋混凝土建筑物式的货层(每一楼层相当于一层货格)之间来回穿梭地送货和取货,这个过程需要两种类型的机器人协同工作,一种是在水平面上行走的机器人,一种是竖直面上行走的电梯机器人,两类机器人共同完成跨楼层的存取货任务,目前只能通过人工切换方式实现移动机器人跨楼层搬运货物,因此,迫切需要一套成熟可靠的基于三维空间的多移动机器人多层路径规划方法用以解决移动移动机器人如何平滑地上楼和平滑下楼的问题。
发明内容
本发明的目的在于克服现有技术的不足,提供一种基于三维空间密集存储区域的多机器人路径规划方法,解决了移动机器人只能通过人工切换方法致使移动机器人跨楼层搬运时在电梯机器人口出现停顿、前后任务不衔接不连贯的问题。
本发明解决其技术问题是采取以下技术方案实现的:
一种基于三维空间密集存储区域的多机器人路径规划方法,包括调度服务器内的主线程和并行执行的规划线程、避碰线程和执行线程,
所述的主线程包括以下步骤:
步骤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。
而且,所述初始化一张三维立体网状路径图的方法包括以下处理步骤:
⑴获得存储区域的存储位图纸;
⑵建立存储点:取每个存储位中心点作为存储点;
⑶建立路点:非存储区域与存储点区域大小相同的可行走区域的中心点作为路点,该路点包括巷道路点、车辆存取间路点、电梯机器人路点;
⑷建立连通性:将具有连通性的两个相邻点进行连线构成初始化网状路径图,所述的连通性包括同一个楼层的两个相邻存储点之间、存储点和路点之间以及不同楼层的电梯机器人路点之间。
而且,所述主线程实时接收移动机器人当前位置的命令反馈信息是包括:移动机器人每经过一个路点时反馈当前路点所在位置坐标(X、Y、Z),路点包括电梯机器人路点和存储层地面上的路点,其中,X、Y代表水平面坐标,Z代表楼层信息。
而且,所述密集存储区域三维立体网状路径包括由水平面内的线段和竖直面内的线段组成的路径。
而且,所述规划线程标记任务路经的方法为:使用携带行走方向以及排序特征的任务编号来标记每个任务路经;所述的行走方向可以是同一个水平面或竖直面的行走方向,也可以是既包括水平面也包括竖直面的行走方向。
而且,所述避碰线程的某个任务释放资源变量给调度服务器后,重新返回线程抢占资源变量,当这个任务再次获得资源变量后,根据此时变化的环境重新识别当前冲突区。
而且,所述执行线程的某个任务当给不同执行体发送命令后,这个任务还会重新返回线程开始处,获得更新后的该任务的转义命令,并根据更新后的该任务的转义命令重新给不同的执行体发送命令。
而且,所述的任务阶段,其相临两个任务阶段的机器人执行体是不同的:由地面上行走的机器人和竖直面内行走的电梯机器人分别执行各个阶段的任务。
而且,所述冲突区的划分方法为:将所有路点上被标记至少两个任务编号、以及行走方向相反的路点组合的区域划分为冲突区;所述冲突区包括由存储层地面路点和电梯机器人路点组成的冲突区。
本发明的优点和积极效果是:
1、本发明通过不同种类机器人接力操作、共同完成该任务行走路线的方法,实现了移动机器人和电梯机器人自动切换并且跨楼层任意存取货物的需求;解决了移动机器人一般只能在单层地面上行走、或只有通过人工切换方法才可以跨楼层行走,而不能自动切换到其它楼层行走的问题。
2、本发明将地面路点和电梯路点、地面坐标和楼层位置坐标、移动机器人和电梯机器人有机地结合为一个整体,共同构成一个由调度服务器实时控制机器人行走的三维网状路径,从而保证了移动机器人在各个楼层之间平滑地送货和取货的可能性,解决了由于人工切换方法致使机器人跨楼层搬运时在电梯机器入口出现停顿、前后任务不衔接不连贯的问题。
3、本发明通过主线程实时获取和更新环境、规划线程实时获取任务和实时规划路径、避碰线程实时更新冲突区、执行线程实时切换任务阶段和实时发送命令等手段,具有高效率、合理性、实时性等特点。
附图说明
图1是本发明的处理流程图;
图2是初始化三维网状立体路径图(一层俯视图);
图3是初始化三维网状立体路径图(顶层俯视图);
图4是初始化三维网状立体路径图(A1、A2区域的三层立体示意图);
图5是初始化三维网状立体路径图(B1、B2区域的三层立体示意图);
图6是一个存车任务路径的三维示意图;
图7是图6的任务标记存车平面示意图;
图8是一个取车任务路径的三维示意图;
图9是图8的任务标记取车平面示意图;
图10是一个划分冲突区三维示意图;
图11是图10的任务标记冲突区平面示意图。
具体实施方式
以下结合附图对本发明实施例做进一步详述:
一种基于三维空间密集存储区域的多机器人路径规划方法所依据的路径规划条件是:(1)所述多机器人路径规划主要解决碰撞和冲突问题;(2)机器人执行体包括地面上行走的移动机器人和电梯机器人;(3)移动机器人的碰撞和冲突不仅来自水平面内的碰撞和冲突而且来自竖直面内的碰撞和冲突;(4)移动机器人的碰撞和冲突指的是由于相向而行而发生的任务死锁(在水平面内的相向而行和竖直面内的相向而行);(5)移动机器人组成了其它机器人成员的动态障碍;(6)移动机器人和调度服务器之间通过无线网络进行通讯。
如图1所示,一种基于三维空间密集存储区域的多机器人路径规划方法,包括调度服务器内的主线程和并行执行的规划线程、避碰线程和执行线程的协调处理方法。其中,所述的主线程包括以下步骤:
步骤1:调度服务器初始化一张三维立体网状路径图;
如图2至图5所示,初始化三维立体网状路径图的具体方法为:
①获得存储区域的存储位图纸;
②建立存储点:取每个存储位中心点作为存储点;
③建立路点:非存储区域与存储点区域大小相同的可行走区域的中心点作为路点。所述路点包括巷道路点、车辆存取间路点(图2中的5号标识、10号标识)、电梯机器人路点(图3中的61标识、61-1标识、61-2标识、66标识、66-1标识、66-2标识)。
④建立连通性:同一个楼层的两个相邻存储点之间、存储点和路点之间具有连通性;不同楼层的电梯机器人路点之间也具有连通性;
步骤2:调度服务器主线程实时接收移动机器人当前位置的命令反馈信息,根据反馈信息实时更新包括环境信息的三维网状立体路径图,主线程实时接收移动机器人当前位置的命令反馈信息是包括:移动机器人每经过一个路点时反馈当前路点所在位置坐标(X、Y、Z),路点包括电梯机器人路点和存储层地面上的路点。其中,X、Y代表水平面坐标,Z代表楼层信息:0、1、2分别代表一、二、三层楼。
所述的规划线程包括以下步骤:
步骤1:规划线程检测到有存取货物任务时,获取起始点和目标点信息并将任务划分若干个子任务,每个子任务下又划分任务阶段,每个任务阶段又设有各自的起始点和目标点;相临两个任务阶段的机器人执行体是不同的:由地面上行走的移动机器人和竖直面内行走的电梯机器人分别执行各个阶段的任务。
步骤2:规划线程根据子任务的起始点、目标点及输入参数使用图搜索法输出当前子任务的密集存储区域三维空间任务路径,如图6,密集存储区域三维空间路径包括由水平面内的线段(66-2、52-2、38-2、24-2、23-2)和竖直面内的线段(66、66-1、66-2)组成的路径;如图8,三位空间路径包括由水平面内的第一条线段(53-2、52-2、66-2)、竖直面内的线段(66-2、66-1、66)、水平面内的第二条线段(66、52、53)组成的路径;
步骤3:规划线程判断该子任务目标点(图6中,A任务目标点为23-2,图8中,B任务目标点为53)是否被上一个的任务释放掉,如果已经被释放,则进入步骤4,否则等待释放;
步骤4:规划线程使用携带行走方向以及排序特征的任务编号标记每个任务路经,所述的行走方向可以是同一个水平面或竖直面的行走方向,也可以是跨楼层的行走方向;
步骤5:规划线程标记完所有任务路径后,将标记后的任务送入执行队列,返回步骤2;
所述的避碰线程包括以下步骤:
步骤1:避碰线程执行任务队列的各任务抢占资源变量,所述各个任务抢占资源变量不只1次,而是循环抢占,直至任务结束:这是由于服务器主线程实时更新环境信息,所以需要不断根据变化的环境信息重新识别冲突区;
步骤2:避碰线程根据当前环境信息划分冲突区:将所有路点上被标记至少两个任务编号、以及行走方向相反(在水平面或电梯机器人空间的竖直面内)的路点组合的区域划分为冲突区;冲突区包括由存储层地面上的路点和电梯机器人路点组成的冲突区;
步骤3:避碰线程判断冲突区是否释放干净,如果释放干净转入步骤4;如果没有释放干净,继续等待;
步骤4:避碰线程完成移动机器人和电梯机器人执行命令前的命令转义任务;
步骤5:避碰线程释放资源变量给调度服务器。当释放资源变量给调度服务器后,还会重新返回线程抢占资源变量,当再次获得资源变量后,根据此时变化的环境重新识别当前冲突区。
所述的执行线程包括以下步骤:
步骤1:执行线程到执行队列等待经过转义后的任务,每次收到的转义后的命令可能是同一个任务的,但每次转义的内容可能不相同,这是由于同一个任务所处环境信息实时更新,冲突区实时更新、转义命令实时更新的缘故;
步骤2:执行线程判断是否有未发送出去的命令,如果有未发送命令,进入步骤3,如果没有未发送命令,返回步骤1;
步骤3:执行线程根据执行体类型的不同,划分阶段,每个阶段内最后一个命令为本阶段的阶段结束命令。
步骤4:判断上一阶段命令是否全部执行完成(包括阶段结束命令),如果完成,则发送当前阶段除阶段结束命令以外的其它命令,并且转入步骤5,如果上一阶段命令(包括阶段结束命令)还未完成,执行步骤6;
步骤5:执行线程判断下一个任务阶段的机器人执行体,是否准备就绪。如果准备就绪,发送本阶段的阶段结束命令,并将下一阶段指定为当前阶段,转入步骤7;如果没有准备就绪,转入步骤6;
步骤6:将当前未完成的任务放回执行队列,并且返回步骤4;
步骤7:返回步骤1。
下面以三层停车场为例,如图6至图9所示,调度服务器同时处理两个子任务(一个存车任务、一个取车任务)的详细处理过程:
步骤1、调度服务器规划线程接收任务并划分子任务:送货子任务(A任务)和取货子任务(B任务);
步骤2、调度服务器规划线程用图搜索法给这两个子任务输出路径,A任务输出路径为:10→24→38→52→66→66-1→66-2→52-2→38-2→24-2→23-2,其任务标记为:A1→A2→A3→A4→A5→A6→A7→A8→A9→A10→A11;B任务输出路径为:53-2→52-2→66-2→61-2→66→52→53,任务标记为B1→B2→B3→B4→B5→B6→B7;
步骤3、调度服务器规划线程判断这两个任务的目标点23-2,53都已经被释放;
步骤4、调度服务器规划线程将A、B任务放入执行队列;
步骤5、调度服务器避碰线程各个任务抢占资源变量;
步骤6、调度服务器避碰线程的A任务抢到了资源变量;
步骤7、调度服务器规划线程的A任务根据更新后的环境信息划分和识别当前冲突区,冲突区为52、66、66-1、66-2、52-2所包围的区域;
步骤8、调度服务器避碰线程的A任务获得A任务移动机器人距离冲突区的位置(A任务刚刚拿到资源变量时,A移动机器人初始位置在路点10),如果没有到达紧贴冲突区的前一个路点,(冲突去前一个路点在此例中其标识为38),则生成移动机器人行走路线转义命令给执行线程,进入步骤9;如果已经到达紧贴冲突区的前一个路点,则增加生成一个呼叫电梯机器人的转义命令给执行线程,并锁定这个冲突区,锁定期间,这个冲突区不能再被其它任务占用;
步骤9、调度服务器避碰线程的A任务释放资源变量给服务器,当释放资源变量给调度服务器后,还会重新返回线程的开始执行处,抢占资源变量,当再次获得资源变量后,根据此时变化的环境重新识别当前冲突区。并返回步骤5;
步骤10、调度服务器避碰线程的B任务抢到了资源变量;
步骤11、调度服务器规划线程的B任务根据更新后的环境信息划分和识别当前冲突区,由于没有第三个任务插入,因此,B任务和A任务所识别的是相同的,冲突区均为52、66、66-1、66-2、52-2所包围的区域,如果有第三个任务,并且该任务行走路径部分包括52、66、66-1、66-2、52-2组成的冲突区,则B任务此时所识别的冲突区将有别于A任务识别的冲突区;
步骤12、调度服务器避碰线程的B任务获得B任务移动机器人距离冲突区的位置(B任务刚刚拿到资源变量时,B移动机器人初始位置在路点53-2),如果没有到达紧贴冲突区的前一个路点,(冲突去前一个路点在此例中其标识为52-2),则生成移动机器人行走路线转义命令给执行线程,进入步骤9;如果已经到达紧贴冲突区的前一个路点,则增加生成一个呼叫电梯机器人的转义命令给执行线程,并锁定这个冲突区,锁定期间,这个冲突区不能再被其它任务占用;
步骤13、调度服务器避碰线程的B任务释放资源变量给服务器,并返回步骤5,当释放资源变量给调度服务器后,还会重新返回线程的开始执行处,抢占资源变量,当再次获得资源变量后,根据此时变化的环境重新识别当前冲突区。
下面以A子任务为例,说明执行线程的工作情况。
步骤14:执行线程的A任务获得转义后的命令;
步骤15:执行线程根据执行体类型的不同,划分阶段,每个阶段内最后一个命令为本阶段的阶段结束命令。A子任务的任务阶段分为3个任务阶段:路点:10、24、38、52、66为一段;路点:66、66-1、66-2为一段;路点:66-2、52-2、38-2、24-2、23-2为一段;第一段的最后一个命令是从52到66的命令;第二段的最后一个命令是从66-1到66-2的命令;
步骤16:判断上一阶段命令是否全部执行完成(包括阶段结束命令),如果完成,则发送当前阶段除阶段结束命令以外的其它命令,并且转入步骤17,如果上一阶段命令(包括阶段结束命令)还未完成,执行步骤18。假设A任务已经走完了第一段任务路程(路点:10、24、38、52、66),下面该走第二段任务路程,此时要判断上个阶段的最后1个命令,也就是52到66的命令是否完成,如果上个阶段最后1个命令完成,则发送66、66-1的命令(不包括66-1到66-2的命令),转入步骤17,如果上个阶段最后1个命令没完成,则转入步骤18;
步骤17:执行线程判断下一个任务阶段的机器人执行体,是否准备就绪。如果准备就绪,发送本阶段的阶段结束命令,并将下一阶段指定为当前阶段,转入步骤19;如果没有准备就绪,转入步骤18。以上所述的下一个阶段任务机器人执行体是移动机器人,执行路点66-2、52-2、38-2、24-2、23-2的任务,由于此实施例中移动机器人始终被电梯机器人携带,所以可以认为下一阶段机器人执行体已经准备就绪,于是执行线程发送当前阶段最后一个命令66-1到66-2的命令,也就是本阶段的阶段结束命令,并将下个(第三阶段)阶段(路点为:6-2、52-2、38-2、24-2、23-2)的任务作为当前任务(A任务执行第三阶段任务的方法可以以此类推),同时转入步骤19;
步骤18:将当前未完成的任务放回执行队列,并且返回步骤17;
步骤19:返回步骤14。
通过上述步骤即可实现基于三维空间密集存储区域的多机器人路径规划方法。
需要强调的是,本发明所述的实施例是说明性的,而不是限定性的,因此本发明并不限于具体实施方式中所述的实施例,凡是由本领域技术人员根据本发明的技术方案得出的其他实施方式,同样属于本发明保护的范围。

Claims (9)

1.一种基于三维空间密集存储区域的多机器人路径规划方法,其特征在于:包括调度服务器内的主线程和并行执行的规划线程、避碰线程和执行线程, 
所述的主线程包括以下步骤: 
步骤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。 
2.根据权利要求1所述的基于三维空间密集存储区域的多机器人路径规划方法,其特征在于:所述初始化一张三维立体网状路径图的方法包括以下处理步骤: 
⑴获得存储区域的存储位图纸; 
⑵建立存储点:取每个存储位中心点作为存储点; 
⑶建立路点:非存储区域与存储点区域大小相同的可行走区域的中心点作为路点,该路点包括巷道路点、车辆存取间路点、电梯机器人路点; 
⑷建立连通性:将具有连通性的两个相邻点进行连线构成初始化网状路径图,所述的连通性包括同一个楼层的两个相邻存储点之间、存储点和路点 之间以及不同楼层的电梯机器人路点之间。 
3.根据权利要求1所述的基于三维空间密集存储区域的多机器人路径规划方法,其特征在于:所述主线程实时接收移动机器人当前位置的命令反馈信息是包括:移动机器人每经过一个路点时反馈当前路点所在位置坐标(X、Y、Z),路点包括电梯机器人路点和存储层地面上的路点,其中,X、Y代表水平面坐标,Z代表楼层信息。 
4.根据权利要求1所述的基于三维空间密集存储区域的多机器人路径规划方法,其特征在于:所述密集存储区域三维立体网状路径包括由水平面内的线段和竖直面内的线段组成的路径。 
5.根据权利要求1所述的基于三维空间密集存储区域的多机器人路径规划方法,其特征在于:所述规划线程标记任务路经的方法为:使用携带行走方向以及排序特征的任务编号来标记每个任务路经,所述的行走方向可以是同一个水平面或竖直面的行走方向,也可以是既包括水平面也包括竖直面的行走方向; 
6.根据权利要求1所述的基于三维空间密集存储区域的多机器人路径规划方法,其特征在于:所述避碰线程的某个任务释放资源变量给调度服务器后,重新返回线程抢占资源变量,当这个任务再次获得资源变量后,根据此时变化的环境重新识别当前冲突区。 
7.根据权利要求1所述的一种基于密集存储区域三维空间的多移动机器人多层路径规划方法,其特征在于:所述执行线程的某个任务当给不同执行体发送命令后,这个任务还会重新返回线程开始处,获得更新后的该任务的转义命令,并根据更新后的该任务的转义命令重新给不同的执行体发送命令。 
8.根据权利要求1所述的一种基于密集存储区域三维空间的多移动机器人多层路径规划方法,其特征在于:所述的任务阶段,其相临两个任务阶段的机器人执行体是不同的:由地面上行走的机器人和竖直面内行走的电梯机器人分别执行各个阶段的任务。 
9.根据权利要求1所述的基于三维空间密集存储区域的多机器人路径规划方法,其特征在于:所述冲突区的划分方法为:将所有路点上被标记至少两个任务编号、以及行走方向相反的路点组合的区域划分为冲突区;所述冲 突区包括由存储层地面路点和电梯机器人路点组成的冲突。 
CN201210440094.5A 2012-11-07 2012-11-07 基于三维空间密集存储区域的多机器人路径规划方法 Active CN102929279B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201210440094.5A CN102929279B (zh) 2012-11-07 2012-11-07 基于三维空间密集存储区域的多机器人路径规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201210440094.5A CN102929279B (zh) 2012-11-07 2012-11-07 基于三维空间密集存储区域的多机器人路径规划方法

Publications (2)

Publication Number Publication Date
CN102929279A CN102929279A (zh) 2013-02-13
CN102929279B true CN102929279B (zh) 2014-11-05

Family

ID=47644107

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201210440094.5A Active CN102929279B (zh) 2012-11-07 2012-11-07 基于三维空间密集存储区域的多机器人路径规划方法

Country Status (1)

Country Link
CN (1) CN102929279B (zh)

Families Citing this family (25)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103217979B (zh) * 2013-03-29 2015-04-15 无锡普智联科高新技术有限公司 基于缓冲区的多移动机器人路径冲突解决方法
CN104760853A (zh) * 2014-03-11 2015-07-08 北京博锐尚格节能技术股份有限公司 一种电梯运行监控方法、装置及系统
CN104609086B (zh) * 2015-01-12 2017-01-11 世仓智能仓储设备(上海)股份有限公司 基于路权令牌的四向穿梭车控制系统
CN104851211A (zh) * 2015-06-12 2015-08-19 刘子腾 一种图书馆自动存取书系统
US20190315592A1 (en) * 2016-10-04 2019-10-17 Mitsubishi Electric Corporation Elevator system
CN106979785B (zh) * 2017-03-24 2020-10-16 北京大学深圳研究生院 一种面向多机器人系统的完全遍历路径规划方法
CN107272698B (zh) * 2017-07-25 2018-07-31 哈尔滨工大特种机器人有限公司 一种应用于多agv协作运行的调度控制方法及系统
CN107450535B (zh) * 2017-07-31 2018-06-29 中南大学 一种智能运载机器人最优路径混合图论控制规划方法
CN107368076B (zh) * 2017-07-31 2018-03-27 中南大学 一种智能环境下机器人运动路径深度学习控制规划方法
CN109471427A (zh) * 2017-09-08 2019-03-15 杭州海康机器人技术有限公司 搬运物品的方法、调度系统及计算机可读存储介质
CN107807648B (zh) * 2017-11-28 2020-10-30 广州市妇女儿童医疗中心 基于机器人与电梯系统的路径规划系统及方法
CN108445893A (zh) * 2018-06-07 2018-08-24 浙江国自机器人技术有限公司 一种移动机器人控制器及移动机器人
CN109019201A (zh) * 2018-08-07 2018-12-18 北京云迹科技有限公司 信号传输方法及系统
CN109108972B (zh) * 2018-08-29 2020-06-16 广州市君望机器人自动化有限公司 多机器人通过狭窄区域的调度方法及装置
CN109108973B (zh) * 2018-08-29 2021-05-07 广州安商智能科技有限公司 单向式路径调度方法及系统
CN110967012B (zh) * 2018-09-30 2022-11-08 北京京东振世信息技术有限公司 路径规划方法及系统、计算机系统和计算机可读存储介质
CN111781919A (zh) * 2019-04-12 2020-10-16 北京京东尚科信息技术有限公司 一种多自动行驶设备共用地图的行驶方法和装置
CN112060072B (zh) * 2019-06-11 2023-06-20 华邦电子股份有限公司 一种协同型机器人控制系统和方法
CN112388625B (zh) * 2019-08-15 2022-05-24 纳恩博(北京)科技有限公司 任务的下发方法及装置、任务的执行方法及装置
CN110647129A (zh) * 2019-10-30 2020-01-03 广东博智林机器人有限公司 机器人调度方法、升降机调度方法和系统
CN110815228A (zh) * 2019-11-18 2020-02-21 广东博智林机器人有限公司 一种跨楼层施工调度方法及系统
CN112990617A (zh) * 2019-12-02 2021-06-18 杭州海康机器人技术有限公司 智能移动机器人的调度方法和调度装置
CN111103887B (zh) * 2020-01-14 2021-11-12 大连理工大学 一种基于多传感器的多移动机器人调度系统设计方法
CN111694333A (zh) * 2020-06-10 2020-09-22 中国联合网络通信集团有限公司 一种agv协同管理方法及装置
CN112327890A (zh) * 2020-11-10 2021-02-05 中国海洋大学 一种基于whca*算法的水下多机器人路径规划

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5416713A (en) * 1992-10-30 1995-05-16 Mitsubishi Denki Kabushiki Kaisha Obstacle avoidance apparatus
EP1571515A1 (en) * 2004-03-04 2005-09-07 Leica Geosystems AG Method and apparatus for managing data relative to a worksite area
CN102402224A (zh) * 2010-09-03 2012-04-04 株式会社日立工业设备技术 无人搬送车以及行驶控制方法
CN102535915A (zh) * 2012-02-03 2012-07-04 无锡普智联科高新技术有限公司 一种基于移动机器人小车的自动停车系统
CN102602643A (zh) * 2012-03-02 2012-07-25 无锡普智联科高新技术有限公司 一种高密度自动立体仓储系统

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3994950B2 (ja) * 2003-09-19 2007-10-24 ソニー株式会社 環境認識装置及び方法、経路計画装置及び方法、並びにロボット装置
US9043016B2 (en) * 2005-10-21 2015-05-26 Deere & Company Versatile robotic control module

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5416713A (en) * 1992-10-30 1995-05-16 Mitsubishi Denki Kabushiki Kaisha Obstacle avoidance apparatus
EP1571515A1 (en) * 2004-03-04 2005-09-07 Leica Geosystems AG Method and apparatus for managing data relative to a worksite area
CN102402224A (zh) * 2010-09-03 2012-04-04 株式会社日立工业设备技术 无人搬送车以及行驶控制方法
CN102535915A (zh) * 2012-02-03 2012-07-04 无锡普智联科高新技术有限公司 一种基于移动机器人小车的自动停车系统
CN102602643A (zh) * 2012-03-02 2012-07-25 无锡普智联科高新技术有限公司 一种高密度自动立体仓储系统

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
JP特开2005-92820A 2005.04.07 *
刘国栋等.多AGV调度系统中的两阶段动态路径规划.《机器人》.2005,第27卷(第3期), *
可重组制造系统中物流运输路径规划;宋士刚等;《同济大学学报(自然科学版)》;20100131;第38卷(第1期);全文 *
多AGV调度系统中的两阶段动态路径规划;刘国栋等;《机器人》;20050530;第27卷(第3期);全文 *
宋士刚等.可重组制造系统中物流运输路径规划.《同济大学学报(自然科学版)》.2010,第38卷(第1期), *

Also Published As

Publication number Publication date
CN102929279A (zh) 2013-02-13

Similar Documents

Publication Publication Date Title
CN102929279B (zh) 基于三维空间密集存储区域的多机器人路径规划方法
JP7228420B2 (ja) 情報処理装置、情報処理方法、情報処理システム及びコンピュータプログラム
CN109823931B (zh) 智能移动设备的乘梯方法、装置、电子设备和存储介质
Bae et al. Comparison of operations of AGVs and ALVs in an automated container terminal
CN109059926B (zh) 跨楼层路径规划方法及系统
CN110119861A (zh) 调度无人车的方法、装置及计算机可读存储介质
CN103217979B (zh) 基于缓冲区的多移动机器人路径冲突解决方法
CN103955221B (zh) 带任务时效性的多平台协作路径规划系统和方法
CN109250593A (zh) 一种多机器人与多电梯的调度方法及系统
CN110482342B (zh) 一种基于机器人的召梯方法及相关设备
CN109108973A (zh) 单向式路径调度方法及系统
CN102865877A (zh) 基于密集存储区域的多移动机器人路径冲突解决方法
CN102169347A (zh) 基于协作协进化和多种群遗传算法的多机器人路径规划系统
CN104678915B (zh) 一种面向半导体生产线搬运系统多天车协调调度方法
JP7328923B2 (ja) 情報処理装置、情報処理方法、及びコンピュータプログラム
Wu et al. Resource-oriented Petri nets in deadlock avoidance of AGV systems
WO2021140577A1 (ja) ロボット制御システム
CN104346658A (zh) 基于改进银行家算法的自动小车存取系统动态调度方法
KR20140042895A (ko) 동적인 통행 프로파일 해법을 가진 엘리베이터 시스템
Levin et al. A general framework for modeling shared autonomous vehicles
Pypno et al. Automated large capacity multi-story garage—Concept and modeling of client service processes
CN115951691A (zh) 一种5g通讯下密集库的穿梭车的轨迹规划方法及其系统
CN114611896A (zh) 机器人任务调度方法、计算机设备及存储介质
Zhao et al. Spare zone based hierarchical motion coordination for multi-AGV systems
Binder et al. Multi robot route planning (MRRP): Extended spatial-temporal prioritized planning

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
C41 Transfer of patent application or patent right or utility model
TR01 Transfer of patent right

Effective date of registration: 20160112

Address after: 518000 Guangdong province Shenzhen City Xili Nanshan District University City sangtai building block A room 503

Patentee after: SHENZHEN PUZHI LIANKE ROBOT TECHNOLOGY Co.,Ltd.

Address before: 214135 Jiangsu Province, Wuxi City District Zhenze Wuxi Road No. 18 (National) whale Software Park A District 4 floor

Patentee before: WUXI PUZHI LIANKE HIGH-TECH Co.,Ltd.

TR01 Transfer of patent right

Effective date of registration: 20221115

Address after: 570100 Room 101, Building 7, Fisheries Yard, No. 2, Haixiu East Road, Haifu Street, Meilan District, Haikou, Hainan

Patentee after: Aibo Technology (Hainan) Co.,Ltd.

Address before: Room 503, Block A, Sangtai Building, Xili University Town, Nanshan District, Shenzhen City, Guangdong Province

Patentee before: SHENZHEN PUZHI LIANKE ROBOT TECHNOLOGY Co.,Ltd.

TR01 Transfer of patent right