CN111158353A - 用于多个机器人的移动控制方法以及其系统 - Google Patents
用于多个机器人的移动控制方法以及其系统 Download PDFInfo
- Publication number
- CN111158353A CN111158353A CN201811275885.0A CN201811275885A CN111158353A CN 111158353 A CN111158353 A CN 111158353A CN 201811275885 A CN201811275885 A CN 201811275885A CN 111158353 A CN111158353 A CN 111158353A
- Authority
- CN
- China
- Prior art keywords
- robot
- predicted
- movement
- robots
- task
- 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.)
- Pending
Links
- 230000033001 locomotion Effects 0.000 title claims abstract description 120
- 238000000034 method Methods 0.000 title claims abstract description 23
- 238000004140 cleaning Methods 0.000 claims description 34
- 230000004044 response Effects 0.000 claims description 28
- 230000008859 change Effects 0.000 claims description 5
- 238000010586 diagram Methods 0.000 description 16
- 238000004891 communication Methods 0.000 description 14
- 230000008569 process Effects 0.000 description 4
- 230000009471 action Effects 0.000 description 2
- 230000006399 behavior Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 241000283690 Bos taurus Species 0.000 description 1
- 230000004075 alteration Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000009429 electrical wiring Methods 0.000 description 1
- 239000000835 fiber Substances 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000010408 sweeping Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0287—Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
- G05D1/0289—Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling with means for avoiding collisions between vehicles
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
- B25J11/008—Manipulators for service tasks
- B25J11/0085—Cleaning
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
- B25J9/1666—Avoiding collision or forbidden zones
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
本发明公开一种用于多个机器人的移动控制方法以及其系统,该方法的步骤包括:取得对应于一第一机器人的一第一运作状态以及一第一预测移动路径;取得对应于一第二机器人的一第二运作状态以及一第二预测移动路径;判断第一预测移动路径以及第二移动路径是否有重叠或邻接的区段;响应于第一预测移动路径以及第二移动路径具有重叠或邻接的区段时,判断对应于重叠或邻接的区段的第一机器人的第一预测时间以及第二机器人的第二预测时间的差异是否小于一既定时间;以及响应于第一预测时间以及第二预测时间的差异小于既定时间时,根据第一运作状态以及第二运作状态改变第一机器人的一第一移动状态或者第二机器人的一第二移动状态。
Description
技术领域
本发明涉及一种用于多个机器人的移动控制方法以及其系统。
背景技术
随着科技的进步,机器人在生活上的应用已相当地广泛。而响应于同一个空间中有多个机器人同时在执行任务时,已知技术通过激光、光学镜头或者检测信号的强度来判断两个机器人是否会发生碰撞。然而,由于激光或者光学镜头有检测死角或者盲点,且信号强度的判断可能无法很精准地检测机器人的实际位置,仍有可能会发生碰撞的情况。因此,如何在碰撞发生前即提前执行闪避策略为目前所需解决的问题。
发明内容
本发明一实施例提供一种用于多个机器人的移动控制方法,步骤包括:取得对应于一第一机器人的一第一运作状态以及一第一预测移动路径;取得对应于一第二机器人的一第二运作状态以及一第二预测移动路径;判断第一预测移动路径以及第二移动路径是否有重叠或邻接的区段;响应于第一预测移动路径以及第二移动路径具有重叠或邻接的区段时,判断对应于重叠或邻接的区段的第一机器人的第一预测时间以及第二机器人的第二预测时间的差异是否小于一既定时间;以及响应于第一预测时间以及第二预测时间的差异小于既定时间时,根据第一运作状态以及第二运作状态改变第一机器人的一第一移动状态或者第二机器人的一第二移动状态。
本发明另一实施例提供一种用于多个机器人的移动控制系统,包括一控制端以及多个机器人。控制端包括一第一存储单元以及一第一处理单元。第一存储单元存储一任务地图。第一处理单元用以将任务地图分割为多个任务区域、将任务区域分给多个机器人以及根据每个机器人的一运作状态以及一预测移动路径判断两个机器人之间是否有重叠或邻接的区段。其中,响应于两个机器人具有重叠或邻接的区段时,第一处理单元更判断对应于重叠或邻接的区段的两个机器人的预测时间的差异是否小于一既定时间。以及,响应于两个机器人的预测时间的差异小于既定时间时,根据两个机器人的运作状态输出一控制信号以改变两个机器人中的一个的一移动状态。其中,每个机器人包括一第二存储单元以及一第二处理单元。第二存储单元用以存储自控制端所接收到的任务区域。第二处理单元用以根据任务区域决定运作状态以及产生预测移动路径,以及根据控制信号改变移动状态。
根据本发明一实施例,其中响应于第一运作状态为跨区移动以及第二运作状态亦为跨区移动时,第一预测时间以及第二预测时间中较晚中的一个所对应的第一机器人或者第二机器人在到达重叠或邻接的区段时,暂时停止在重叠或邻接的区段的一起点前,其中跨区移动为自一任务区域移动至另一任务区域。
根据本发明另一实施例,其中响应于第一预测时间以及第二预测时间中较晚的一个所对应的第一机器人的第一预测移动路径或者第二机器人的第二预测移动路径被阻挡时,改变第一预测移动路径或者第二预测移动路径。
根据本发明另一实施例,其中响应于第一运作状态为执行清扫任务以及第二运作状态亦为执行清扫任务时,第一预测时间以及第二预测时间中较晚的一个所对应的第一机器人或者第二机器人在到达重叠或邻接的区段时,暂时停止在重叠或邻接的区段的一起点前。
根据本发明另一实施例,其中响应于第一运作状态为跨区移动以及第二运作状态为执行清扫任务时,第一机器人改变第一预测移动路径、改变第一机器人的下一个任务区域或者在到达重叠或邻接的区段时暂时停止在重叠或邻接的区段的一起点前。
附图说明
图1是显示根据本发明一实施例所述的用于多个机器人的移动控制系统的系统架构图。
图2是显示根据本发明另一实施例所述的用于多个机器人的移动控制系统的系统架构图。
图3A~3C是显示根据本发明一些实施例所述的机器人的的预测移动路径的示意图。
图4A~4D是显示根据本发明一实施例所述的机器人闪避策略的示意图。
图5A~5D是显示根据本发明另一实施例所述的机器人闪避策略的示意图。
图6是显示根据本发明另一实施例所述的机器人闪避策略的示意图。
图7是显示根据本发明一实施例所述的用于多个机器人的移动控制方法的示意图。
【符号说明】
110~控制端
120a~120n~机器人
311、321、331、411、421、511、521、611、621~移动起点
312、322、332、412、422、512、612、622~移动终点
350~障碍物
510~540~任务区域
512~对应于另一个任务区域的移动终点
651、652~邻接的区段
713、723~邻接的区段的起点
S701~S708~步骤流程
具体实施方式
有关本发明的用于多个机器人的移动控制方法以及其系统适用的其他范围将在接下来所提供的详述中清楚易见。必须了解的是下列的详述以及具体的实施例,当提出有关用于多个机器人的移动控制方法以及其系统的示范实施例时,仅作为描述的目的以及并非用以限制本发明的范围。
图1是显示根据本发明一实施例所述的机器人任务区域分配系统的系统架构图。任务分配系统可包括一控制端110以及多个机器人120a~120n。控制端110可实施于在例如桌上型计算机、笔记型计算机、平板计算机或者智能手机等的电子装置中,且至少包含一第一处理单元、一第一存储单元以及一第一通信接口。第一处理单元可通过多种方式实施,例如以专用硬件电路或者通用硬件(例如,单一处理器、具平行处理能力的多处理器、图形处理器或者其它具有运算能力的处理器),且在执行程序代码或者软件时,提供之后所描述的功能。第一存储单元用以存储至少一任务地图以及与任务相关的信息等,以供第一处理单元在执行相关运算时进行存取接入。其中,第一存储单元可为硬盘、快闪存储器、ROM等非易失性存储装置。此外,第一通信接口可为一无线通信接口(未显示),无线通信接口可为局域网络(local area network,LAN)通信模块、无线局域网络通信模块(WLAN)或蓝牙(Bluetooth)通信模块等,用以与机器人120a~120n交换各种信号以及数据。在一具体实施例中,机器人120a~120n为扫地机器人或者其它可根据指令执行清扫任务的清洁装置等。
每个机器人120a~120n至少包含一第二处理单元、一第二存储单元以及一第二通信接口。同样地,第二处理单元可通过多种方式实施,例如以专用硬件电路或者通用硬件,且在执行程序代码或者软件时,提供之后所描述的功能。第二存储单元可为硬盘、快闪存储器、ROM等非易失性存储装置,用以存储任务地图和/或通过第二通信接口自控制端110所接收到的与清扫任务相关的指令以及信息等。第二处理单元用以根据接收到的任务地图驱动马达以致使机器人执行清扫任务,或者执行与清扫任务相关的计算(例如决定预测移动路径以及计算对应于预测移动路径的每个位置的预测时间)。
根据本发明一实施例,在启动每个机器人120a~120n后,每个机器人120a~120n首先将自身位于任务地图中的位置发送至控制端110。其中,每个机器人120a~120n在任务地图中的位置可通过以下的方式取得,例如通过使用者自行将每个机器人120a~120n的位置(例如坐标或相对位置)输入至控制端110中、直接根据任务区域的位置将每个机器人120a~120n置放于下一任务区域的起点、或者藉由机器人120a~120n所内建的至少一传感器通过同步定位与地图构建(Simultaneous localization and mapping,SLAM))方式在任务地图中进行定位等,但本发明并不以此为限。而在取得每个机器人120a~120n的位置后,控制端110通过第一通信接口将任务区域发送给每个机器人120a~120n,使得每个机器人120a~120n可根据任务区域决定对应的预测移动路径并产生对应于预测移动路径的每个位置的预测时间等。每个机器人120a~120n在完成计算预测移动路径以及预测时间后,会将预测移动路径以及预测时间通过第二通信接口回传至控制端110,以供控制端110判断机器人120a~120n之间的预测移动路径是否有重叠或邻接的区段,以及响应于控制端110判断两个机器人之间有重叠或邻接的区段时,控制端110将会发送控制信号以改变机器人120a~120n的移动状态。
图2是显示根据本发明另一实施例所述的用于多个机器人的移动控制系统的系统架构图。其中,每个机器人120a~120n至少包含一第二处理单元、一第二存储单元以及一第二通信接口。同样地,第二处理单元、第二存储单元以及第二通信接口的配置如前所述,在此即不加以描述以精简说明。此外,机器人120a~120n中的一个会被设定为领导者,而领导者机器人会将任务地图切割为多个任务区域,并将任务区域分派给其它机器人,使得每个机器人120a~120n可根据任务地图计算对应的预测移动路径以及对应于预测移动路径的每个位置的预测时间等。每个机器人120a~120n在完成计算预测移动路径以及预测时间后,会将预测移动路径以及预测时间通过第二通信接口与发送给其它机器人,使得每个机器人120a~120n在预测移动路径与其它机器人的预测移动路径重叠或邻接时,可根据对应于其它机器人的运作状态、预测移动路径以及预测时间决定后续的动作。
图3A~3C是显示根据本发明一些实施例所述的机器人的移动路径的示意图。在本发明一些实施例中,响应于机器人的运作状态为执行清扫任务时,可以沿墙(WallFollowing)行为模式或者牛耕(Boustrophedon)模式在任务区域中移动。举例来说,图3A是显示沿墙行为模式的示意图。如图所示,机器人的移动起点为方格311以及移动终点为方格321,而机器人如图中箭头所示沿着任务区域的边缘行走。其中,响应于机器人遇到障碍物时,亦会沿着障碍物的边缘行走。
图3B是显示牛耕模式的示意图。如图所示,机器人的移动起点为方格321以及移动终点为方格322,而机器人将如图中箭头所示来回移动以清扫整个任务区域。
图3C是显示跨区移动的移动路径的示意图。当机器人跨区移动时,将以最少的转弯次数到达下一个任务区域。举例来说,响应于机器人自方格331移动至方格332时,图中箭头所示的移动路径为可避开障碍物350、转弯次数最少且移动距离最短的路径。
图4A~4D是显示根据本发明一实施例所述的机器人闪避策略的示意图。在此一实施例中,两个机器人的运作状态皆为跨区移动。其中,跨区移动指机器人已完成当前任务区域的清扫任务,并从当前任务区域移动至下一个任务区域的动作。如图4A所示,方格411为第一机器人的移动起点,以及方格412为第一机器人的移动终点,而图中所示的箭头则为第一机器人的预测移动路径。请参阅图4B,在图4B中,方格421为第二机器人的移动起点,以及方格422为第二机器人的移动终点,而图中所示的箭头则为第二机器人的预测移动路径。配合参阅第4A、4B图的内容,图4C中区域450为第一机器人以及第二机器人两者的预测移动路径重叠的区段,控制端110或者领导者机器人将进一步地根据第一机器人以及第二机器人进入区域450的预测时间(即第一机器人以及第二机器人走至图4C所示的方格451的预测时间)判断第一机器人是否会与第二机器人碰撞。
根据本发明一实施例,响应于第一机器人比第二机器人还晚到达方格451,且两者到达方格451的时间差异小于既定时间时(在一具体实施例,当机器人的速度为20厘米/秒,上述既定时间例如为5秒或5秒至10秒之一区间),第一机器人将暂时停止在方格451前(例如停在图4C所示的方格413的位置),直到第二机器人离开区域450或者进入区域450一既定时间(例如到达方格452的位置)后,第一机器人再进入区域450中,并移动至移动终点412的位置。
根据本发明另一实施例,响应于第二机器人比第一机器人还晚到达方格451,且两者到达方格451的时间差异小于既定时间时,第二机器人将暂时停止在方格451前(例如停在图4C所示的方格423的位置),直到第一机器人离开区域450或者进入区域450既定时间(例如到达方格452的位置)后,第二机器人再进入区域450中。然而,根据图4C的内容,由于第一机器人的移动终点412位于第二机器人的预测移动路径上,且若第一机器人较第二机器人先移动,第二机器人原先的预测移动路径将会被第一机器人所阻挡。此时,第二机器人的第二处理单元将重新规划一新的预测移动路径(如第4D图中箭头所示),以避免与第一机器人发生碰撞。
图5A~5D是显示根据本发明另一实施例所述的机器人闪避策略的示意图。在此一实施例中,第一机器人的运作状态为跨区移动,以及第二机器人的运作状态为执行清扫任务。其中,如图5A所示,第一机器人预自任务区域510移动至任务区域530,以及第二机器人在任务区域520中执行清扫任务。在本发明的实施例中,为了避免降低机器人执行清扫任务的效率,响应于执行清扫任务的机器人的预测移动路径与跨区移动的机器人的预测移动路径具有重叠的区段时,执行清扫任务的机器人相较于跨区移动的机器人具有较高的优先权。换句话说,跨区移动的机器人必须让执行清扫任务的机器人优先完成清扫任务。因此,在本发明的一实施例中,如图5B所示,第一机器人将其预测移动路径改变为绕过任务区域520,而不穿越任务区域520(如图中箭头所示),以避免影响第二机器人执行清扫任务。
根据本发明另一实施例,第一机器人也可根据第二机器人的预测移动路径以及预测时间避开第二机器人正在清扫的区域,以避免与第二机器人碰撞。举例来说,如图5C所示,响应于第二机器人正在清扫任务区域520右半边的区域时(例如第二机器人当前位于方格521的位置),由于任务区域520左半边仍具有足够的空间可供第一机器人移动,因此第一机器人可选择直接穿越任务区域520左半边的预测移动路径(如图中箭头所示)。
或者,根据本发明另一实施例,响应于第一机器人具有其它未完成的任务区域时(例如如第5D图中任务区域540所示),由于第一机器人自任务区域510移动至任务区域540的最短移动距离并不会穿越任务区域520,因此第一机器人也可选择将下一个任务区域自任务区域530改变至任务区域540(移动至位于任务区域540的方格512’的位置)(如图中箭头所示),以避免预测移动路径与第二机器人的预测移动路径具有重叠的区段。
值得注意的是,响应于前述三种实施例对第一机器人而言皆为可执行时,第一机器人可分别计算执行三种实施例所需花费的时间,并执行时间最短的一个所对应的方案。
此外,根据本发明另一实施例,响应于第一机器人没有其它可绕过任务区务520的移动路径、没有其它未完成的任务区域或者完全无法避开第二机器人的当前清扫区域时(例如任务区域为狭长的走廊且两个机器人无法错开移动的情况),则第一机器人暂时停止在当前位置(如第5D图中所示的方格511),直到第二机器人完成任务区域520的清扫任务并离开任务区域520为止,第一机器人再穿越任务区域520至任务区域530以执行下一个清扫任务。
图6是显示根据本发明另一实施例所述的机器人闪避策略的示意图。在此一实施例中,第一机器人以及第二机器人的运作状态皆为执行清扫任务。如图6所示,第一机器人的移动起点为611,并沿着图中箭头所示的方向移动至移动终点612,以及第二机器人的移动起点为621,并沿着图中箭头所示的方向移动至移动终点622。而根据图6的内容,第一机器人的预测移动路径与第二机器人的预测移动路径具有邻接的区段(如图中区段651以及区段652所示)。其中,由于机器人具有既定的体积,因此当两个机器人同时进入邻接的区段时,将可能发生碰撞的情况。为了避免碰撞情况产生,控制端110或者领导者机器人将进一步地判断第一机器人以及第二机器人进入区域450所分别对应的预测时间的差异是否小于既定时间。其中,图6中方格中所示的数字为预测移动路径上每个位置所对应的预测时间。在此一实施例中,第一机器人与第二机器人同时自各自的起点出发,而第一机器人预测在第2个时间点进入邻接的区段651,以及第二机器人预测在第3个时间点进入邻接的区段652。由于第一机器人与第二机器人分别进入邻接的区段的预测时间仅相差1秒(小于预设的既定时间),且两者的行进方向为相对的,因此较晚进入邻接的区段的机器人将暂时停止在邻接的区段前,以避免两个机器人发生碰撞的情况。举例来说,在此一实施例中,由于第二机器人较晚进入邻接的区段652,因此第二机器人将暂时停止在方格623前一格的位置(即方格624),直到第一机器人离开邻接的区段651为止。
图7是显示根据本发明一实施例所述的用于多个机器人的移动控制方法的示意图。首先,在步骤S701,控制端111或者领导者机器人将任务地图切割为多个任务区域,并将任务区域分配给多个机器人。在步骤S702,每个机器人根据任务区域决定对应于每个机器人的运作状态并计算预测移动路径。在步骤S703,控制端110或者领导者机器人判断每个机器人的预测移动路径是否与其它机器人的预测移动路径有重叠或邻接的区段。其中,响应于两个机器人的预测移动路径具有重叠或者邻接的区段时,进入步骤S704,控制端110或者领导者机器人更判断两个机器人分别对应于重叠或邻接的区段的预测时间的差异是否小于既定时间。其中,响应于两个机器人的预测移动路径不具有重叠或者邻接的区段,或者响应于两个机器人分别对应于重叠或邻接的区段的预测时间的差异大于或等于既定时间时,则进入步骤S705,两个机器人维持当前的运作状态,并沿着预测移动路径移动或者执行当前的清扫任务。
此外,响应于两个机器人的预测移动路径具有重叠或者邻接的区段,且两个机器人对应于重叠或邻接的区段的预测时间的差异小于既定时间时,控制端110或者领导者机器人更进一步地判断其所分别对应的运作状态。而响应于两个机器人的运作状态皆为跨区移动或者执行清扫任务时,进入步骤S706,两个机器人中预测移动路径所对应的预测时间较晚的一个在到达重叠或邻接的区段时,暂时停止在重叠或邻接的区段的起点前,直到距离另一机器人一既定距离或另一机器人进入重叠或邻接的区段经过既定时间。而响应于一机器人的运作状态为跨区移动,以及另一机器人的运作状态为执行清扫任务时,进步步骤S707,运作状态为跨区移动所对应的机器人改变其原先的预测移动路径、改变下一个任务区域或者在到达重叠或邻接的区段时暂时停止在重叠或邻接的区段的起点前。
值得注意的是,在上述示例性装置中,尽管上述方法已在使用一系列步骤或方框的流程图的基础上描述,但本发明不局限于这些步骤的顺序,并且一些步骤可不同于其余步骤的顺序执行或其余步骤可同时进行。此外,本领域技术人员将理解在流程图中所示的步骤并非唯一的,其可包括流程图的其他步骤,或者一或多个步骤可被删除而不会影响本发明的范围。
本发明的方法,或特定形态或其部分,可以以程序代码的形态存在。程序代码可以包含在物理介质,如软盘、光盘、硬盘、或是任何其他机器可读取(如计算机可读)存储介质,亦或不限于外在形式的计算机程序产品,其中,当程序代码被机器,如计算机载入且执行时,此机器变成用以参与本发明的装置。程序代码也可通过一些传送介质,如电线或电缆线、光纤、或是任何传输形态进行传送,其中,当程序代码被机器,如计算机接收、载入且执行时,此机器变成用以参与本发明的装置。当在一般用途处理单元实作时,程序代码结合处理单元提供一操作类似于应用特定逻辑电路的独特装置。
综上所述,根据本发明一些实施例所述的用于多个机器人的移动控制方法以及其系统,响应于任务地图中有多个机器人时,控制端或者领导者机器人可在接收到每个机器人的预测移动路径后,以及在两个机器人移动到重叠或邻接的区段前,根据机器人进入重叠或邻接的区段所对应的预测时间致使两个机器人中的一个执行适当的闪避策略,以避免两个机器人发生碰撞的情况。此外,响应于跨区移动的机器人的预测移动路径与执行清扫任务的机器人的预测移动路径重叠时,通过将移动路径的使用权优先分配给执行清扫任务的机器人、或者直接改变跨区移动的机器人的预测移动路径,将可避免影响正在执行清扫任务的机器人的工作效率。
以上叙述许多实施例的特征,使本领域技术人员能够清楚理解本说明书的形态。本领域技术人员能够理解其可利用本发明揭示内容为基础以设计或更动其他工艺及结构而完成相同于上述实施例的目的和/或达到相同于上述实施例的优点。本领域技术人员亦能够理解不脱离本发明的精神和范围的等效构造可在不脱离本发明的精神和范围内作任意的更动、替代与润饰。
Claims (10)
1.一种用于多个机器人的移动控制方法,包括:
取得对应于第一机器人的第一运作状态以及第一预测移动路径;
取得对应于第二机器人的第二运作状态以及第二预测移动路径;
判断上述第一预测移动路径以及上述第二移动路径是否有重叠或邻接的区段;
响应于上述第一预测移动路径以及上述第二移动路径具有上述重叠或邻接的区段时,判断对应于上述重叠或邻接的区段的上述第一机器人的第一预测时间以及上述第二机器人的第二预测时间的差异是否小于既定时间;以及
响应于上述第一预测时间以及上述第二预测时间的差异小于上述既定时间时,根据上述第一运作状态以及上述第二运作状态改变上述第一机器人的第一移动状态或者上述第二机器人的第二移动状态。
2.如权利要求1所述的移动控制方法,其中根据上述第一运作状态以及上述第二运作状态改变上述第一机器人的上述第一移动状态或者上述第二机器人的上述第二移动状态的步骤还包括:
响应于上述第一运作状态为跨区移动以及上述第二运作状态亦为上述跨区移动时,上述第一预测时间以及上述第二预测时间中较晚的一个所对应的上述第一机器人或者上述第二机器人在到达上述重叠或邻接的区段时,暂时停止在上述重叠或邻接的区段的起点前;
其中,上述跨区移动为自一任务区域移动至另一任务区域。
3.如权利要求2所述的移动控制方法,其中响应于上述第一预测时间以及上述第二预测时间中较晚的一个所对应的上述第一机器人的上述第一预测移动路径或者上述第二机器人的上述第二预测移动路径被阻挡时,改变上述第一预测移动路径或者上述第二预测移动路径。
4.如权利要求1所述的移动控制方法,其中根据上述第一运作状态以及上述第二运作状态改变上述第一机器人的上述第一移动状态或者上述第二机器人的上述第二移动状态的步骤还包括:
响应于上述第一运作状态为执行清扫任务以及上述第二运作状态亦为上述执行清扫任务时,上述第一预测时间以及上述第二预测时间中较晚的一个所对应的上述第一机器人或者上述第二机器人在到达上述重叠或邻接的区段时,暂时停止在上述重叠或邻接的区段的起点前。
5.如权利要求1所述的移动控制方法,其中根据上述第一运作状态以及上述第二运作状态改变上述第一机器人的上述第一移动状态或者上述第二机器人的上述第二移动状态的步骤还包括:
响应于上述第一运作状态为跨区移动以及上述第二运作状态为执行清扫任务时,上述第一机器人改变上述第一预测移动路径、改变上述第一机器人的下一个任务区域或者在到达上述重叠或邻接的区段时暂时停止在上述重叠或邻接的区段的起点前。
6.一种用于多个机器人的移动控制系统,包括:
控制端,包括:
第一存储单元,存储任务地图;
第一处理单元,用以:
将上述任务地图分割为多个任务区域;
将上述任务区域分给多个机器人;
根据每个上述机器人的运作状态以及预测移动路径判断两个上述机器人之间是否有重叠或邻接的区段;
响应于两个上述机器人具有上述重叠或邻接的区段时,判断对应于上述重叠或邻接的区段的两个上述机器人的预测时间的差异是否小于既定时间;以及
响应于两个上述机器人的上述预测时间的差异小于上述既定时间时,根据两个上述机器人的上述运作状态输出控制信号以改变两个上述机器人中的一个的移动状态;
其中,每个上述机器人包括:
第二存储单元,用以存储自上述控制端所接收到的上述任务区域;
第二处理单元,用以:
根据上述任务区域决定上述运作状态以及产生上述预测移动路径;以及
根据上述控制信号改变上述移动状态。
7.如权利要求6所述的移动控制系统,其中响应于两个上述机器人的上述运作状态皆为跨区移动时,两个上述机器人的上述预测时间中较晚的一个所对应的上述在到达上述重叠或邻接的区段时,上述第二处理单元致使上述机器人暂时停止在上述重叠或邻接的区段的起点前;
其中,上述跨区移动为自一任务区域移动至另一任务区域。
8.如权利要求7所述的移动控制系统,其中响应于两个上述机器人的上述预测时间中较晚的一个所对应的预测移动路径被阻挡时,上述第二处理单元致使上述机器人改变上述预测移动路径。
9.如权利要求6所述的移动控制系统,其中响应于两个上述机器人的上述运作状态皆为执行清扫任务时,两个上述机器人的上述预测时间中较晚的一个所对应的上述在到达上述重叠或邻接的区段时,上述第二处理单元致使上述机器人暂时停止在上述重叠或邻接的区段的起点前。
10.如权利要求6所述的移动控制系统,其中响应于两个上述机器人的上述运作状态分别为跨区移动以及执行清扫任务时,对应于上述跨区移动的上述机器人改变对应的上述预测移动路径、改变对应于上述跨区移动的上述机器人的下一个任务区域或者对应于上述跨区移动的上述机器人在到达上述重叠或邻接的区段时暂时停止在上述重叠或邻接的区段的起点前。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW107136965 | 2018-10-19 | ||
TW107136965A TWI676090B (zh) | 2018-10-19 | 2018-10-19 | 用於多個機器人之移動控制方法以及其系統 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111158353A true CN111158353A (zh) | 2020-05-15 |
Family
ID=69189085
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811275885.0A Pending CN111158353A (zh) | 2018-10-19 | 2018-10-30 | 用于多个机器人的移动控制方法以及其系统 |
Country Status (3)
Country | Link |
---|---|
US (1) | US20200125116A1 (zh) |
CN (1) | CN111158353A (zh) |
TW (1) | TWI676090B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113344263A (zh) * | 2021-05-28 | 2021-09-03 | 深圳市无限动力发展有限公司 | 沿边行走过程的轨迹闭合判断方法、装置及计算机设备 |
CN113799143A (zh) * | 2021-11-18 | 2021-12-17 | 广东隆崎机器人有限公司 | 一种多机器人在工作区域内的安全协作方法及装置 |
CN114427310A (zh) * | 2022-02-18 | 2022-05-03 | 智橙动力(北京)科技有限公司 | 泳池边缘清洗方法、装置、电子设备及计算机存储介质 |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107553497B (zh) * | 2017-10-20 | 2023-12-22 | 苏州瑞得恩光能科技有限公司 | 太阳能面板清扫机器人的边缘定位装置及其定位方法 |
WO2021041419A1 (en) * | 2019-08-30 | 2021-03-04 | X Development Llc | Robot planning from process definition graph |
US11745345B2 (en) * | 2019-08-30 | 2023-09-05 | Intrinsic Innovation Llc | Planning by work volumes to avoid conflicts |
JP7327225B2 (ja) * | 2020-03-13 | 2023-08-16 | オムロン株式会社 | ロボット制御システムおよび制御方法 |
CN111474947A (zh) * | 2020-05-07 | 2020-07-31 | 北京云迹科技有限公司 | 机器人避障的方法、装置及系统 |
CN111612342B (zh) * | 2020-05-22 | 2024-03-15 | 格力博(江苏)股份有限公司 | 一种割草机队管理装置、管理方法以及管理系统 |
CN111596661B (zh) * | 2020-05-26 | 2023-09-08 | 深圳优地科技有限公司 | 一种消毒控制方法、装置、电子设备及系统 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1461693A (zh) * | 2002-05-30 | 2003-12-17 | 库卡-罗伯特有限公司 | 用于避免在协作机器人之间的碰撞的方法和控制装置 |
CN205325689U (zh) * | 2015-12-24 | 2016-06-22 | 华中科技大学 | 一种双机器人实时动态避障装置 |
US20180178383A1 (en) * | 2015-06-25 | 2018-06-28 | Kuka Roboter Gmbh | Moving Along A Predetermined Path With A Robot |
CN108268040A (zh) * | 2018-01-19 | 2018-07-10 | 广东美的智能机器人有限公司 | 多移动机器人的冲突管理方法及系统 |
CN108287545A (zh) * | 2018-01-19 | 2018-07-17 | 广东美的智能机器人有限公司 | 多移动机器人的冲突管理方法及系统 |
US20180267552A1 (en) * | 2015-11-17 | 2018-09-20 | RobArt GmbH | Robot-assisted processing of a surface using a robot |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2884816B2 (ja) * | 1991-05-10 | 1999-04-19 | 神鋼電機株式会社 | 移動ロボットシステムにおける制御方法 |
JP3296105B2 (ja) * | 1994-08-26 | 2002-06-24 | ミノルタ株式会社 | 自律移動ロボット |
US7363124B1 (en) * | 1998-12-21 | 2008-04-22 | The United States Of America As Represented By The Secretary Of The Navy | Disperse, aggregate and disperse (DAD) control strategy for multiple autonomous systems to optimize random search |
CN101196561B (zh) * | 2007-12-26 | 2012-03-14 | 北京理工大学 | 一种无线测距全向图像组合定位系统 |
TWI420432B (zh) * | 2010-04-09 | 2013-12-21 | 台灣新光保全股份有限公司 | Robot access control system |
US9707681B2 (en) * | 2015-07-27 | 2017-07-18 | Siemens Industry Software Ltd. | Anti-collision management of overlapping robotic movements |
US10081106B2 (en) * | 2015-11-24 | 2018-09-25 | X Development Llc | Safety system for integrated human/robotic environments |
-
2018
- 2018-10-19 TW TW107136965A patent/TWI676090B/zh active
- 2018-10-30 CN CN201811275885.0A patent/CN111158353A/zh active Pending
-
2019
- 2019-06-10 US US16/435,636 patent/US20200125116A1/en not_active Abandoned
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1461693A (zh) * | 2002-05-30 | 2003-12-17 | 库卡-罗伯特有限公司 | 用于避免在协作机器人之间的碰撞的方法和控制装置 |
US20180178383A1 (en) * | 2015-06-25 | 2018-06-28 | Kuka Roboter Gmbh | Moving Along A Predetermined Path With A Robot |
US20180267552A1 (en) * | 2015-11-17 | 2018-09-20 | RobArt GmbH | Robot-assisted processing of a surface using a robot |
CN205325689U (zh) * | 2015-12-24 | 2016-06-22 | 华中科技大学 | 一种双机器人实时动态避障装置 |
CN108268040A (zh) * | 2018-01-19 | 2018-07-10 | 广东美的智能机器人有限公司 | 多移动机器人的冲突管理方法及系统 |
CN108287545A (zh) * | 2018-01-19 | 2018-07-17 | 广东美的智能机器人有限公司 | 多移动机器人的冲突管理方法及系统 |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113344263A (zh) * | 2021-05-28 | 2021-09-03 | 深圳市无限动力发展有限公司 | 沿边行走过程的轨迹闭合判断方法、装置及计算机设备 |
CN113344263B (zh) * | 2021-05-28 | 2022-12-27 | 深圳市无限动力发展有限公司 | 沿边行走过程的轨迹闭合判断方法、装置及计算机设备 |
CN113799143A (zh) * | 2021-11-18 | 2021-12-17 | 广东隆崎机器人有限公司 | 一种多机器人在工作区域内的安全协作方法及装置 |
CN113799143B (zh) * | 2021-11-18 | 2022-04-19 | 广东隆崎机器人有限公司 | 一种多机器人在工作区域内的安全协作方法及装置 |
CN114427310A (zh) * | 2022-02-18 | 2022-05-03 | 智橙动力(北京)科技有限公司 | 泳池边缘清洗方法、装置、电子设备及计算机存储介质 |
Also Published As
Publication number | Publication date |
---|---|
TW202016669A (zh) | 2020-05-01 |
US20200125116A1 (en) | 2020-04-23 |
TWI676090B (zh) | 2019-11-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111158353A (zh) | 用于多个机器人的移动控制方法以及其系统 | |
CA3138062C (en) | Systems and methods for optimizing route plans in an operating environment | |
EP3566821B1 (en) | Robot movement control method, and robot | |
EP3610340B1 (en) | Roadmap annotation for deadlock-free multi-agent navigation | |
US10994418B2 (en) | Dynamically adjusting roadmaps for robots based on sensed environmental data | |
Draganjac et al. | Decentralized control of multi-AGV systems in autonomous warehousing applications | |
US11145206B2 (en) | Roadmap segmentation for robotic device coordination | |
KR102041093B1 (ko) | 조정된 경로 계획기를 사용하는 다수의 자동화 비-홀로노믹 차량들을 효율적으로 스케줄링하는 방법 및 장치 | |
US10442082B1 (en) | Methods and systems for automated robotic movement | |
CN113156956B (zh) | 机器人的导航方法、芯片及机器人 | |
CN109984689A (zh) | 一种清洁机器人及清洁机器人的路径优化方法 | |
CN113190010B (zh) | 一种沿边绕障路径规划方法、芯片及机器人 | |
CN101650189A (zh) | 行走路径规划方法与避开动态障碍物的导航方法 | |
CN113867347A (zh) | 机器人路径规划方法、装置、管理系统及计算机存储介质 | |
CN114527751A (zh) | 机器人路径规划方法、装置及电子设备 | |
WO2019141226A1 (zh) | 多移动机器人的冲突管理方法及系统 | |
US20210125493A1 (en) | Travel control apparatus, travel control method, and computer program | |
CN113110497A (zh) | 基于导航路径的沿边绕障路径选择方法、芯片及机器人 | |
CN113534818A (zh) | 路径导航规划方法、装置、存储介质及电子设备 | |
JP7272547B2 (ja) | マルチロボット経路計画 | |
EP4348370A1 (en) | Waypoint reduction for path planning of multiple autonomous robots | |
CN113110499A (zh) | 一种通行区域的判定方法、路线搜索方法、机器人及芯片 | |
CN115185286B (zh) | 一种移动机器人自主绕障规划方法及其任务调度系统 | |
CN113110473B (zh) | 基于连通性的区域判定方法、芯片及机器人 | |
CN116149314A (zh) | 机器人全覆盖作业方法、装置及机器人 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20200515 |
|
WD01 | Invention patent application deemed withdrawn after publication |