WO2019141217A1 - 多移动机器人的冲突管理方法及系统 - Google Patents

多移动机器人的冲突管理方法及系统 Download PDF

Info

Publication number
WO2019141217A1
WO2019141217A1 PCT/CN2019/072254 CN2019072254W WO2019141217A1 WO 2019141217 A1 WO2019141217 A1 WO 2019141217A1 CN 2019072254 W CN2019072254 W CN 2019072254W WO 2019141217 A1 WO2019141217 A1 WO 2019141217A1
Authority
WO
WIPO (PCT)
Prior art keywords
node
path
state
mobile robot
time
Prior art date
Application number
PCT/CN2019/072254
Other languages
English (en)
French (fr)
Inventor
刘清
Original Assignee
库卡机器人(广东)有限公司
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 库卡机器人(广东)有限公司 filed Critical 库卡机器人(广东)有限公司
Publication of WO2019141217A1 publication Critical patent/WO2019141217A1/zh

Links

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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0234—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
    • G05D1/0236—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons in combination with a laser
    • 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
    • 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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle

Definitions

  • the present invention relates to the field of robots, and in particular to a method and system for conflict management of multiple mobile robots.
  • the robot has good conflict resolution capability through the current local environment information of the robot.
  • the second is centralized management conflict resolution, which is mainly to eliminate conflicts by segmenting the motion path of the robot.
  • the inventors of the present application found in the prior art that at least the following drawbacks exist in the prior art: First, the distributed method is simple in operation, real-time and flexible, but due to local poles, often The task cannot be completed completely. Secondly, the centralized management method can perform tasks more accurately, but it is very easy to cause the robot to run path conflicts. Usually, the optimal solution is found, but the calculation is large and the real-time performance is poor. No better solution can be proposed.
  • An object of the embodiments of the present invention is to provide a collision management method and system for a multi-mobile robot, which is to solve at least a path conflict problem caused by centralized scheduling of multiple mobile robots in a dense area.
  • an embodiment of the present invention provides a conflict management method for a multiple mobile robot, including: acquiring a current location and a planned path of each of the plurality of mobile robots, wherein the planned path can bypass an obstacle in the predetermined area, And the predetermined area includes a plurality of node areas; the planned path is divided into path segments corresponding to a moving state of the robot, wherein the robot moving state includes an acceleration state, a deceleration state, and/or a uniform state; determining the movement a state in which the robot passes the state of movement of the robot through a state of the node; the node resource table is established according to the current position of the plurality of mobile robots, the state transit time, and the path segment.
  • the node resource table records a correspondence between the mobile robot ID, the node area ID of the node area through which the path segment passes, and the occupation time, and any two of the plurality of mobile robot IDs are
  • the node resource table does not jointly correspond to the same occupation under the same node area ID. a time; and controlling the plurality of mobile robots to occupy the node area of the corresponding node area ID according to the occupation time corresponding to the respective mobile robot IDs in the node resource table.
  • the dividing the planning path into a path segment corresponding to a moving state of the robot includes: planning the path according to a starting position, a target position, and/or a turning position of the planned path of the mobile robot Dividing into a path segment corresponding to a moving state of the robot, wherein the segment near the starting position is a path segment in an accelerated state, and the segment near the target position and/or the turning position is in a decelerating state a path segment, wherein the path segment in which the acceleration state is removed and the remaining segment after the path segment in the deceleration state are path segments in a uniform state.
  • the establishing a node resource table according to the current location, the state transit time, and the path segmentation of the multiple mobile robots includes: determining, when the mobile robot passes the planned path corresponding thereto
  • the number of window times includes: determining, according to the divided path segments corresponding to the planned path, the number of node regions through which each path segment passes, according to the number of node regions and corresponding corresponding to each path segment Determining, by the state transit time, a calculation duration required for the mobile robot to complete the planned path, determining the number of window times according to the calculation duration and a predetermined length of window time; based on the number of corresponding window times
  • the time interval updates the node resource table according to the real-time location of the plurality of mobile robots, the state transit time, and the path segmentation.
  • the establishing a node resource table according to the current location, the state transit time, and the path segmentation of the multiple mobile robots includes: according to respective current locations of the first mobile robot and the second robot, a state transit time, the planned path, allocating a plurality of first node regions and a corresponding first occupied time to the first mobile robot, and allocating a plurality of second node regions and corresponding numbers to the second mobile robot And occupying a time; and determining, when one of the first node regions is identical to one of the second node regions, determining a first occupation time corresponding to the one of the first node regions and the second one of the second Whether there is a coincidence of the second occupied time corresponding to the node area; if yes, marking the one of the second node areas that are coincident with each other as a conflicting node area, and re-being the second mobile in the node resource table
  • the robot assigns the node area ID and the corresponding occupied time.
  • the acquiring the current location and the planned path of each of the plurality of mobile robots comprises: sending a scheduling command to each of the mobile robots, wherein the scheduling command includes target node area information of each mobile robot; and responding to the scheduling Commanding, receiving a planning path from the plurality of mobile robots, wherein the planning path is determined by each of the mobile robots according to respective target node region information and calculated by an A* algorithm.
  • Another aspect of the embodiments of the present invention provides a conflict management system for a multi-mobile robot, including: an initial information acquiring unit configured to acquire a current location and a planned path of each of the plurality of mobile robots, wherein the planned path can bypass the predetermined area The obstacle inside, and the predetermined area includes a plurality of node areas; the path segmentation unit is configured to divide the planned path into a path segment corresponding to a moving state of the robot, wherein the moving state of the robot includes an accelerated state a deceleration state and/or a uniform state; a state transit time determining unit configured to determine a state transit time required by the mobile robot to pass through the one node region in the robot moving state; a node resource table establishing unit configured to Establishing a node resource table according to a current location of the plurality of mobile robots, the state transit time, and the path segment, wherein the node resource table records a mobile robot ID, and a node region through which the path segment passes Correspondence between the node area
  • the path segmentation unit is configured to divide the planned path into a path segment corresponding to a moving state of the robot according to a starting position, a target position, and/or a turning position of the planned path of the mobile robot. a segment of the segment near the initial position, a segment of the path in an accelerated state, and a segment of the segment near the target location and/or the cornering position in a deceleration state, wherein the planned path is removed
  • the path segment of the acceleration state and the remaining segment after the path segmentation of the deceleration state are path segments of the uniform velocity state.
  • the node resource table establishing unit includes: a window time quantity determining module, configured to determine a number of window times required by the mobile robot to pass the planned path corresponding thereto, including: corresponding to the planned path
  • the divided path segments determine the number of node regions through which each path segment passes, and determine that the mobile robot completes according to the number of node regions through which the path segments pass and the corresponding state transit time.
  • the calculation time length required for the planning path is determined according to the calculation duration and the window time of the predetermined length
  • the interval update module is configured to be based on the time interval corresponding to the number of window times, according to the multiple The real-time location of the mobile robot, the state transit time, and the path segment update node resource table.
  • the node resource table establishing unit includes: a resource allocation module, configured to be the first mobile according to a current location of the first mobile robot and the second robot, the state transit time, and the planned path.
  • the robot allocates a plurality of first node areas and corresponding first occupation time, and allocates a plurality of second node areas and corresponding second occupation time to the second mobile robot;
  • the conflict detection module is configured to exist when one of the When the first node area is the same as one of the second node areas, determining whether the first occupied time corresponding to the one of the first node areas and the second occupied time corresponding to the one of the second node areas are There is a coincidence;
  • the conflict resolution module is configured to: if yes, mark the one of the second node regions that are coincident with each other as a conflicting node region, and re-assign the node region to the second mobile robot in the node resource table ID and corresponding occupancy time.
  • the initial information acquiring unit includes: a scheduling command sending module, configured to send a scheduling command to each of the mobile robots, where the scheduling command includes target node area information of each mobile robot; planning a path receiving module, configuring In response to the scheduling command, a planning path is received from the plurality of mobile robots, wherein the planning path is determined by each of the mobile robots according to respective target node area information and calculated by an A* algorithm.
  • a scheduling command sending module configured to send a scheduling command to each of the mobile robots, where the scheduling command includes target node area information of each mobile robot
  • planning a path receiving module configuring In response to the scheduling command, a planning path is received from the plurality of mobile robots, wherein the planning path is determined by each of the mobile robots according to respective target node area information and calculated by an A* algorithm.
  • the plurality of mobile robots are respectively controlled according to the node resource table based on the node resource table in which the mobile robot ID, the node area ID of the node area through which the path segment passes, and the occupation time are recorded.
  • the occupied time corresponding to the respective mobile robot ID in the resource table occupies the node area of the corresponding node area ID, and any two mobile robot IDs in the node resource table do not correspond to the same occupation under the same node area ID. Time; thus, in the scheduling process of the mobile robot, the node resource table including the time variable is introduced, which avoids the situation that two robots are in the same node at the same time point, and solves the problem that the multi-mobile robot performs the planned path.
  • the problem of the path conflict and the collision of the path; and, in the embodiment of the present invention, the maintenance of the node resource table can achieve low consumption of the processor resources, and has a strong real-time performance; It also realizes the rational allocation of resources so that it can be efficiently executed without conflicts. Enclosed area with space resources and increases the number of concurrent tasks, optimize transport efficiency within the space of the mobile robot.
  • the time length consumed by the mobile robot in the mobile unit state through the unit node area is different, so that the corresponding occupation time can be customized for different path states. It ensures the high accuracy of the established node resource table and reduces the probability of collisions.
  • FIG. 2 is a flowchart of a conflict management method for a multi-mobile robot according to an embodiment of the present invention
  • FIG. 3 is a flow chart of a method for acquiring a planned path of a mobile robot according to an embodiment of the present invention
  • FIG. 5 is an example of a node resource table regarding a three-dimensional coordinate axis
  • FIG. 6 is an example of a node resource table according to an embodiment of the present invention.
  • FIG. 7 is a schematic diagram showing a specific execution flow of S204 in the conflict management method of the multiple mobile robot shown in FIG. 2;
  • FIG. 8 is a block diagram showing the structure of a conflict management system for a multi-mobile robot according to an embodiment of the present invention.
  • N1, N2 node 805 control occupied unit
  • a plurality of obstacles B1, B2, etc., a plurality of mobile robots A0, A1, etc., and a plurality of maps are arranged in a map of a dense area of a collision management method for a multi-mobile robot according to an embodiment of the present invention.
  • the dense area may be predetermined according to needs, for example, it may refer to an area in the warehouse, the plurality of mobile robots A0, A1 may refer to a plurality of logistics robots, and through the mobile robots A0, A1 Running the move can carry the goods, but when multiple logistics robots are running at the same time, it may cause conflicts.
  • the sizes of the different node regions N1 and N2 may be equal, which may be formed by equally dividing the map of the dense regions. It should be noted that the conflict management method of the embodiment of the present invention may be performed by a server that centrally manages the plurality of mobile robots.
  • a conflict management method for a multi-mobile robot includes:
  • the manner of obtaining the planned path may be determined by the mobile robot and uploaded to the server by the mobile device, or may be obtained by the server, and all of the above are within the protection scope of the present invention.
  • the mobile robot in the embodiment of the present invention may be an AGV (Automated Guided Vehicle), wherein the obtaining method includes: S301, a server A scheduling command may be transmitted to each mobile robot, wherein the scheduling command includes target node area information of each mobile robot. S302. After each mobile robot receives the respective scheduling command, it calculates respective corresponding planning paths according to the respective target node region information and through the A* algorithm. S303. Each mobile robot sends the respective planned path obtained by the calculation to the server. After the server obtains the planned path sent by each mobile robot, corresponding subsequent processing is performed to ensure that the path conflict does not occur during the execution of the planned path by the mobile robot.
  • AGV Automate Guided Vehicle
  • the mobile robot A0 is receiving After the scheduling command, it is necessary to reach the target node area No. 31 from the node area of the current position 73. At this time, the mobile robot A0 calculates the shortest path to the target node area No. 31 by the A* algorithm, thereby ensuring that the mobile robot A0 can arrive quickly. Target node area.
  • the planned path may be divided into corresponding ones according to a starting position, a target position, and/or a turning position of the planned path of the mobile robot, that is, a starting position, a target position, and a turning position.
  • the path segmentation of the robot moving state wherein the segment near the starting position is the path segment of the acceleration state, and the segment near the target position and/or the turning position is the path segment of the deceleration state, and the acceleration state is removed from the planned path
  • the remaining segments of the path segmentation and the deceleration state of the path segmentation are path segments of the uniform velocity state. As an example, as shown in FIG.
  • the node areas 73 and 63 may be close to the starting point position.
  • the area is determined as the path segment of the acceleration state, and the area in which the node node area 32 and the node area 31 are close to the target point can be determined as the path segment of the deceleration state, and the node position of the turning position 33 can be determined as the path of the deceleration state.
  • the remaining node areas 43 and 53 can be determined as path segments in a uniform state.
  • S203 Determine a state transit time that the mobile robot needs to consume through a node area in a robot moving state.
  • the accelerations of the mobile robots are the same and both are a, but the speeds at which they start, travel, and decelerate are different, so the highest uniform velocity of each mobile robot is V, and the radius of each node region is L.
  • the time that the mobile robot accelerates through a node area is Ta
  • the time that the uniform speed passes is Tv
  • the time that the deceleration passes is Td.
  • the state transit time required for the mobile robot to pass through a node area in the robot moving state can be determined by: Accordingly, the acceleration state and the deceleration state can be assigned the same state transit time through one node region.
  • the node area is managed as an assignable resource, and the occupation time of the node area is introduced as a variable to maintain it, as shown in FIG. 5, in the coordinates, the x and y axes Represents the position in the two-dimensional space, respectively, and the z-axis is the time coordinate.
  • the three-dimensional coordinates of the mobile robot at a certain moment can be calculated according to the planned path of the mobile robot. For example, the mobile robot can be displayed from the current position node region S to the three-dimensional coordinate axis shown in FIG. The trajectory and coordinates of the target node region T at various times.
  • the mobile robot since the mobile robot is a process from entering to leaving a certain node, it takes a period of time, for example, the occupied time may have a certain number of unit time, and thus the occupied time in the node resource table may refer to the time period.
  • the mobile robot A0 in the process in which the mobile robot A0 runs from the current position node area S to the target node area T, it autonomously circumvents the stationary obstacle, but cannot eliminate collision collisions with other running mobile robots;
  • an embodiment of the present invention provides a node resource table, which records a correspondence between a mobile robot ID, a node area ID, and an occupation time, and any two of the plurality of mobile robot IDs are in a node resource.
  • each mobile robot may be configured with a unique mobile robot ID (for example, 10A, 10B, 10C, etc.), and each node area may also be configured with a unique node area ID (as shown in FIG. 4). Shown).
  • the mobile robot may be configured to pass only from the allocated node area. Specifically, the mobile robot may perform the movement only when receiving an instruction about the next allocated node area from the server, even though it may already The operating path is planned independently.
  • the node resource table may be configured to allocate a plurality of first node regions and corresponding first occupation time to the first mobile robot according to respective current positions, state transit times, and planned paths of the first mobile robot and the second robot, And allocating a plurality of second node regions and corresponding second occupation time for the second mobile robot; and determining that one of the first node regions corresponds to when one of the first node regions is identical to one of the second node regions Whether there is a coincidence between the first occupied time and the second occupied time corresponding to one of the second node areas; if yes, one of the second node areas that overlaps with the mark is a conflicting node area, and is second in the node resource table.
  • the mobile robot assigns the node area ID and the corresponding occupied time. Thereby, any two of the plurality of mobile robot IDs can be realized, and the same occupied time under the same node area ID is not collectively associated in the node resource table.
  • the server may determine the node area ID and the corresponding occupied time respectively allocated to the respective mobile robot IDs in the node resource table according to the current position of the plurality of mobile robots, the state transit time, the planned path, and the size of the node area. Specifically, the position of the node area where all the mobile robots are located at any time can be calculated.
  • the corresponding The path segmentation of the acceleration state or the deceleration state allocates 2 unit time for the mobile robot A1
  • the state transit time Tv corresponding to the mobile robot A1 in the uniform state is 1 unit
  • the path segmentation in the uniform state is correspondingly
  • the mobile robot is assigned 1 unit time.
  • FIG. 6 is an example of a node resource table according to an embodiment of the present invention, which is a result obtained by performing a dimensionality reduction process on a node resource table, which exemplarily shows that the current time is 0 in the node area 73.
  • the mobile robot A0 plans the resource allocation situation to the node No. 31 in the target area, and the resource allocation situation of the mobile robot A1 located at node 55 at the current time 0 to the node No. 19 of the target node.
  • each node ID is unique to a resource at a certain time, and can be identified by a hash table, such as node area 73 occupying time 1 and number 73 occupying time 2 Node areas are different resources.
  • the resources allocated for different mobile robots (for example, A0 and A1) do not coincide, that is, any two of the plurality of mobile robot IDs do not collectively correspond to the same node region ID in the node resource table. Take up time.
  • the server may send a control command to the mobile robot, and after receiving the control command, the mobile robot can parse the node area information matching the node resource table and the corresponding occupied time information from the control command. Further, when the planned path is executed after the mobile robot, the mobile robot needs to occupy the corresponding node area in the resolved occupied time.
  • FIG. 7 is a schematic diagram showing a specific execution flow of S204 in FIG. 2, including:
  • S2041 Determine the number of window times required for the mobile robot to pass the corresponding planned path.
  • window time means that an event or thing can be processed or reacted during this time period.
  • the server allocates resources for multiple robots, it is not necessary to calculate every time, that is, every time window, which leads to large resource consumption. Also, in one case.
  • the planning path of the mobile robot is long enough (for example, when the mobile robot needs to move more than 1000 steps)
  • the resource is allocated according to the entire path and the occupied node area is controlled, the calculation amount is too large, and the preset window time quantity is required. For example, if the number of window times allocated to the mobile robot A1 is three, the server can calculate the mobile robot A1 in the second time window and the fifth time window, which can save resource consumption.
  • the server may determine, according to the divided path segments corresponding to the planned path, the number of node regions that each path segment passes, and the number of node regions that pass through each path segment and the corresponding state transit time.
  • the length of calculation required for the mobile robot to complete the planned path is determined, and the number of window times is determined according to the calculation duration and the window time of the predetermined length.
  • the length of a window time is Ts
  • the number of window times Ws can be determined by:
  • the window time can be determined, and the number of window times refers to the time unit in which the calculation is performed in turn. .
  • S2042 Update the node resource table according to the real-time position, the state transit time, and the path segment of the plurality of mobile robots based on the time interval corresponding to the number of window times.
  • the real-time location of the mobile robot at this time may be acquired in real time, and the resource allocation process may be re-executed according to the state transit time, the path segmentation, and the real-time location, which may be specifically referred to above.
  • the description of the embodiment thereby updating the resource allocation situation corresponding to the mobile robot in the node resource table, reducing the consumption of the server resources by the calculation processing, improving the real-time response speed of the server, and improving the transportation efficiency of the mobile robot.
  • a conflict management system 80 for a multi-mobile robot includes: an initial information acquiring unit 801 configured to acquire a current location and a planned path of each of a plurality of mobile robots, wherein the planned path can Surrounding an obstacle in a predetermined area, and the predetermined area includes a plurality of node areas; the path segmentation unit 802 is configured to divide the planned path into path segments corresponding to a robot moving state, wherein the robot The moving state includes an acceleration state, a deceleration state, and/or a uniform state; the state transit time determining unit 803 is configured to determine a state transit time that the mobile robot needs to consume through the one node region in the robot moving state; a table establishing unit 804, configured to establish a node resource table according to a current location of the plurality of mobile robots, the state transit time, and the path segment, wherein the node resource table records a mobile robot ID, the path Between the node area ID and the occupation time of the
  • the path segmentation unit is configured to divide the planned path into a path corresponding to a moving state of the robot according to a starting position, a target position, and/or a turning position of the planned path of the mobile robot.
  • a segment wherein the segment near the starting position is a path segment in an accelerated state, and a segment near the target position and/or the turning position is a path segment in a deceleration state, in the planned path
  • the path segment excluding the acceleration state and the remaining segment after the path segmentation of the deceleration state are path segments in a uniform state.
  • the node resource table establishing unit includes: a window time quantity determining module configured to determine a number of window times required by the mobile robot to pass the planned path corresponding thereto, including: according to the planned path Determining the divided path segments, determining the number of node regions through which each path segment passes, determining the movement according to the number of node regions through which the path segments pass and the corresponding state transit time a calculation duration required by the robot to complete the planning path, determining the number of window times according to the calculation duration and a predetermined length of window time; the interval update module is configured to be based on a time interval corresponding to the number of window times, according to the The real-time location of the plurality of mobile robots, the state transit time, and the path segment update the node resource table.
  • a window time quantity determining module configured to determine a number of window times required by the mobile robot to pass the planned path corresponding thereto, including: according to the planned path Determining the divided path segments, determining the number of node regions through which each path segment passes,
  • the node resource table establishing unit includes: a resource allocation module configured to: according to respective current positions of the first mobile robot and the second robot, the state transit time, and the planned path, a mobile robot assigns a plurality of first node regions and corresponding first occupation time, and allocates a plurality of second node regions and corresponding second occupation time to the second mobile robot; and the conflict detection module is configured to be present therein When the first node area is the same as one of the second node areas, determining a first occupation time corresponding to the one of the first node areas and a second occupation corresponding to the one of the second node areas Whether there is a coincidence time; the conflict resolution module is configured to: if yes, mark the one of the second node areas that are coincident with each other as a conflicting node area, and re-allocate the second mobile robot in the node resource table Node area ID and corresponding occupation time.
  • a resource allocation module configured to: according to respective current positions of the first mobile robot and the second robot, the state
  • the obtained initial information acquiring unit includes: a scheduling command sending module configured to send a scheduling command to each of the mobile robots, wherein the scheduling command includes target node area information of each mobile robot; planning path receiving And a module configured to receive a planning path from the plurality of mobile robots in response to the scheduling command, wherein the planning path is determined by each of the mobile robots according to respective target node region information and calculated by an A* algorithm.
  • system of the embodiments of the present invention may be used to implement the corresponding method embodiments of the present invention, and correspondingly achieve the technical effects achieved by the foregoing method embodiments of the present invention, and details are not described herein again.
  • a related function module can be implemented by a hardware processor.
  • an embodiment of the present invention provides a storage medium having a computer program stored thereon, the program being executed by the processor as a step of a conflict management method of a multi-mobile robot executed by the server.
  • the foregoing storage medium includes: a U disk, a mobile hard disk, a read-only memory (ROM), a random access memory (RAM), a magnetic disk, or an optical disk, and the like. .

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Optics & Photonics (AREA)
  • Electromagnetism (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Manipulator (AREA)

Abstract

本发明实施例提供一种多移动机器人的冲突管理方法及系统，属于机器人技术领域。所述多移动机器人的冲突管理方法包括：获取多个移动机器人各自的当前位置和规划路径；将规划路径划分为对应于机器人移动状态的路径分段，其中机器人移动状态包括加速状态、减速状态和/或匀速状态；确定移动机器人以机器人移动状态通过一个节点区域所需要消耗的状态通行时间；根据多个移动机器人的当前位置、状态通行时间和路径分段建立节点资源表；控制多个移动机器人分别按照节点资源表中各自的移动机器人ID所对应的占用时间，占用相应的节点区域ID的节点区域。由此，保障了所建立的节点资源表的高精确度，并解决了多移动机器人在执行路径时的冲突问题。

Description

多移动机器人的冲突管理方法及系统
相关申请的交叉引用
本申请要求2018年01月19日提交的中国专利申请201810053974.4的权益，该申请的内容通过引用被合并于本文。
技术领域
本发明涉及机器人领域，具体地涉及一种多移动机器人的冲突管理方法及系统。
背景技术
在密集区域(例如物流仓库区域)内布设多个移动机器人，并由这些移动机器人来完成诸如搬运货物的任务，以替代人工劳动，是目前物联网领域的研究重点。
为了避免密集区域中的多个移动机器人之间在作业时候的碰撞，目前一般采用了如下两种不同的处理方案：其一，是通过机器人当前的局部环境信息，让机器人具有良好的冲突消解能力；其二，是集中管理式冲突消解，其主要是通过将机器人的运动路径分段来消除冲突。
但是，本申请的发明人在实践本申请的过程中发现上述现有技术中至少存在如下缺陷：其一，分布式方法虽然运算简单、实时性和灵活性强，但由于会出现局部极点，往往无法完整地完成任务；其二，集中管理式方法能够较精确地执行任务，但极容易导致机器人运行路径冲突，通常要寻找最优解，但计算量很大、实时性差，对此目前业界仍然无法提出较佳的解决方案。
发明内容
本发明实施例的目的是提供一种多移动机器人的冲突管理方法及系统，用以至少解决多移动机器人在密集区域内集中调度所导致的路径冲突问题。
为了实现上述目的，本发明实施例提供一种多移动机器人的冲突管理方法，包括：获取多个移动机器人各自的当前位置和规划路径，其中所述规划路径能够绕开预定区域内的障碍物，以及所述预定区域包括多个节点区域；将所述规划路径划分为对应于机器人移动状态的路径分段，其中所述机器人移动状态包括加速状态、减速状态和/或匀速状态；确定所述移动机器人以所述机器人移动状态通过一个所述节点区域所需要消耗的状 态通行时间；根据所述多个移动机器人的当前位置、所述状态通行时间和所述路径分段建立节点资源表，其中所述节点资源表中记录有移动机器人ID、所述路径分段所经过的节点区域的节点区域ID和占用时间三者之间的对应关系，以及多个所述移动机器人ID中的任意两者在所述节点资源表中不共同对应同一节点区域ID下的同一占用时间；以及控制所述多个移动机器人分别按照所述节点资源表中各自的移动机器人ID所对应的占用时间，占用相应的节点区域ID的节点区域。
可选的，所述将所述规划路径划分为对应于机器人移动状态的路径分段包括：根据所述移动机器人的规划路径的起始位置、目标位置和/或转弯位置，将所述规划路径划分为对应于机器人移动状态的路径分段，其中靠近所述起始位置的分段为加速状态的路径分段，以及靠近所述目标位置和/或所述转弯位置的分段为减速状态的路径分段，所述规划路径中除去所述加速状态的路径分段和所述减速状态的路径分段后的剩余分段为匀速状态的路径分段。
可选的，所述根据所述多个移动机器人的当前位置、所述状态通行时间和所述路径分段建立节点资源表包括：确定移动机器人通过其所对应的所述规划路径时所需要的窗口时间数量，包括：根据所述规划路径所对应的所划分的路径分段，确定各路径分段所通过的节点区域的数量，根据所述各路径分段所通过的节点区域的数量和相应的所述状态通行时间，确定所述移动机器人完成所述规划路径所需要的计算时长，根据所述计算时长和预定长度的窗口时间，确定所述窗口时间数量；基于对应所述窗口时间数量的时间间隔，根据所述多个移动机器人的实时位置、所述状态通行时间和所述路径分段更新节点资源表。
可选的，所述根据所述多个移动机器人的当前位置、所述状态通行时间和所述路径分段建立节点资源表包括：根据第一移动机器人和第二机器人各自的当前位置、所述状态通行时间、所述规划路径，为所述第一移动机器人分配多个第一节点区域及相应的第一占用时间，以及为所述第二移动机器人分配多个第二节点区域及相应的第二占用时间；以及当存在其中一个所述第一节点区域与其中一个所述第二节点区域相同时，判断所述其中一个第一节点区域所对应的第一占用时间与所述其中一个第二节点区域所对应的第二占用时间是否存在重合；若是，则标记所述存在重合的所述其中一个第二节点区域为冲突节点区域，并在所述节点资源表中重新为所述第二移动机器人分配节点区域ID及相应的占用时间。
可选的，所述获取多个移动机器人各自的当前位置和规划路径包括：向各个所述 移动机器人发送调度命令，其中所述调度命令包含各个移动机器人的目标节点区域信息；响应于所述调度命令，从所述多个移动机器人接收规划路径，其中所述规划路径为各个所述移动机器人根据各自的目标节点区域信息并通过A*算法计算所确定的。
本发明实施例另一方面提供一种多移动机器人的冲突管理系统，包括：初始信息获取单元，配置为获取多个移动机器人各自的当前位置和规划路径，其中所述规划路径能够绕开预定区域内的障碍物，以及所述预定区域包括多个节点区域；路径分段划分单元，配置为将所述规划路径划分为对应于机器人移动状态的路径分段，其中所述机器人移动状态包括加速状态、减速状态和/或匀速状态；状态通行时间确定单元，配置为确定所述移动机器人以所述机器人移动状态通过一个所述节点区域所需要消耗的状态通行时间；节点资源表建立单元，配置为根据所述多个移动机器人的当前位置、所述状态通行时间和所述路径分段建立节点资源表，其中所述节点资源表中记录有移动机器人ID、所述路径分段所经过的节点区域的节点区域ID和占用时间三者之间的对应关系，以及多个所述移动机器人ID中的任意两者在所述节点资源表中不共同对应同一节点区域ID下的同一占用时间；控制占用单元，配置为控制所述多个移动机器人分别按照所述节点资源表中各自的移动机器人ID所对应的占用时间，占用相应的节点区域ID的节点区域。
可选的，所述路径分段划分单元配置为根据所述移动机器人的规划路径的起始位置、目标位置和/或转弯位置，将所述规划路径划分为对应于机器人移动状态的路径分段，其中靠近所述起始位置的分段为加速状态的路径分段，以及靠近所述目标位置和/或所述转弯位置的分段为减速状态的路径分段，所述规划路径中除去所述加速状态的路径分段和所述减速状态的路径分段后的剩余分段为匀速状态的路径分段。
可选的，所述节点资源表建立单元包括：窗口时间数量确定模块，配置为确定移动机器人通过其所对应的所述规划路径时所需要的窗口时间数量，包括：根据所述规划路径所对应的所划分的路径分段，确定各路径分段所通过的节点区域的数量，根据所述各路径分段所通过的节点区域的数量和相应的所述状态通行时间，确定所述移动机器人完成所述规划路径所需要的计算时长，根据所述计算时长和预定长度的窗口时间，确定所述窗口时间数量；间隔更新模块，配置为基于对应所述窗口时间数量的时间间隔，根据所述多个移动机器人的实时位置、所述状态通行时间和所述路径分段更新节点资源表。
可选的，所述节点资源表建立单元包括：资源分配模块，配置为根据第一移动机器人和第二机器人各自的当前位置、所述状态通行时间、所述规划路径，为所述第一移 动机器人分配多个第一节点区域及相应的第一占用时间，以及为所述第二移动机器人分配多个第二节点区域及相应的第二占用时间；冲突检测模块，配置为当存在其中一个所述第一节点区域与其中一个所述第二节点区域相同时，判断所述其中一个第一节点区域所对应的第一占用时间与所述其中一个第二节点区域所对应的第二占用时间是否存在重合；冲突解决模块，配置为若是，则标记所述存在重合的所述其中一个第二节点区域为冲突节点区域，并在所述节点资源表中重新为所述第二移动机器人分配节点区域ID及相应的占用时间。
可选的，所述初始信息获取单元包括：调度命令发送模块，配置为向各个所述移动机器人发送调度命令，其中所述调度命令包含各个移动机器人的目标节点区域信息；规划路径接收模块，配置为响应于所述调度命令，从所述多个移动机器人接收规划路径，其中所述规划路径为各个所述移动机器人根据各自的目标节点区域信息并通过A*算法计算所确定的。
通过上述技术方案，一方面，基于记录有移动机器人ID、路径分段所经过的节点区域的节点区域ID和占用时间三者之间的对应关系的节点资源表，控制多个移动机器人分别按照节点资源表中各自的移动机器人ID所对应的占用时间来占用相应的节点区域ID的节点区域，并且在节点资源表中的任意两个移动机器人ID之间不会对应同一节点区域ID下的同一占用时间；由此在对移动机器人的调度过程中，引入了包含时间变量的节点资源表，避免了在同一时间点两个机器人同处一个节点的情形，解决了多移动机器人在执行规划路径时的路径冲突及相碰撞的问题；并且，在本发明实施例中通过对节点资源表的维护能够实现对处理器资源的低消耗，具有较强的实时性；另外，通过本发明实施例的实施，还实现了对资源的合理分配，使得在不发生冲突的前提下，高效地利用密闭区域的空间资源和增加了并发任务的数量，优化了空间内移动机器人的运输效率。另一方面，在建立节点资源表的过程中，考虑到了移动机器人在不同的机器人移动状态通过单位节点区域所消耗的时长的不一样，由此能够针对不同的路径状态定制分配相应的占用时间，保障了所建立的节点资源表的高精确度，并降低了冲突发生的概率。
本发明实施例的其它特征和优点将在随后的具体实施方式部分予以详细说明。
附图说明
附图是用来提供对本发明实施例的进一步理解，并且构成说明书的一部分，与下面的具体实施方式一起用于解释本发明实施例，但并不构成对本发明实施例的限制。在 附图中：
图1是实施本发明一实施例的多移动机器人的冲突管理方法的密集区域的地图的示例；
图2是本发明一实施例的多移动机器人的冲突管理方法的流程图；
图3是本发明一实施例中关于获取移动机器人的规划路径方法的流程图；
图4是本发明一实施例中关于预定区域的节点分布表的示例；
图5是关于三维坐标轴的节点资源表的示例；
图6是本发明一实施例的节点资源表的示例；
图7是图2所示多移动机器人的冲突管理方法中的S204的具体执行流程示意图；
图8是本发明一实施例的多移动机器人的冲突管理系统的结构框图。
附图标记说明
A1、A0     移动机器人            B1、B2     障碍物
N1、N2     节点                   805     控制占用单元
80    冲突管理系统              801     初始信息获取单元
802      路径分段划分单元       803     状态通行时间确定单元
804     节点资源表建立单元
具体实施方式
以下结合附图对本发明实施例的具体实施方式进行详细说明。应当理解的是，此处所描述的具体实施方式仅用于说明和解释本发明实施例，并不用于限制本发明实施例。
如图1所示，在实施本发明一实施例的多移动机器人的冲突管理方法的密集区域的地图中标注了多个障碍物B1、B2等，多个移动机器人A0、A1等，以及多个节点区域N1、N2等。其中，该密集区域可以是根据需要所预定的，例如其可以是指代仓库内的区域，该多个移动机器人A0、A1可以是指代多个物流机器人，以及通过该移动机器人A0、A1的运行移动，可以实现搬运货物，但是在多个物流机器人同时运行的时候，可能会导致冲突。其中，不同的节点区域N1、N2的大小可以是相等的，其可以通过对密集区域的地图作等比例划分所形成的。需说明的是，本发明实施例的冲突管理方法可以是由集中管理该多个移动机器人的服务器所执行的。
如图2所示，本发明一实施例的多移动机器人的冲突管理方法包括：
S201、获取多个移动机器人各自的当前位置和规划路径，其中规划路径能够绕开预定区域内的障碍物，以及预定区域包括多个节点区域。
具体的，关于规划路径的获取方式，可以是由移动机器人所自主确定，并由其上传至服务器的，也可以是服务器通过计算所得出的，且以上都属于本发明的保护范围内。
参见图3示出的是关于规划路径的获取方式的一种可选实施方式，本发明实施例中的移动机器人可以是AGV(Automated Guided Vehicle激光导航车辆)，其中该获取方法包括：S301、服务器可以向各个移动机器人发送调度命令，其中调度命令包含各个移动机器人的目标节点区域信息。S302、在各个移动机器人接收到各自的调度命令之后，其会根据各自的目标节点区域信息并通过A*算法计算各自的相应的规划路径。S303、各个移动机器人会将计算所得到的各自的规划路径发送至服务器。在服务器获取到各个移动机器人所发送的规划路径之后，会执行相应的后续处理，以保障在移动机器人在执行规划路径的过程中不会发生路径冲突。作为示例，在地图上可以具有多个分别具有唯一的节点ID的节点区域(例如图4所示的关于密集区域的节点分布表中的0、1…99号节点区域)，移动机器人A0在接收到调度命令之后，需要从当前位置73号节点区域到达31号目标节点区域，此时移动机器人A0会通过A*算法计算到达31号目标节点区域的最短路径，由此保障移动机器人A0能够迅速到达目标节点区域。但是在此时的计算中并没有考虑到当前空间内的其他移动机器人例如A1的运行移动，其也只会考虑到静态的障碍物节点，而在移动机器人A0运行移动的过程中，空间内的其他移动机器人例如A1相对于这台移动机器人A0都是障碍物，因此需要采取防冲突措施以避开其他移动机器人以防止相撞。关于该冲突管理措施的细节，具体将在下文中展开。
S202、将规划路径划分为对应于机器人移动状态的路径分段，其中机器人移动状态包括加速状态、减速状态和/或匀速状态。
具体的，可以是根据移动机器人的规划路径的起始位置、目标位置和/或转弯位置，也就是起始位置、目标位置和转弯位置其中的一者或多者，将规划路径划分为对应于机器人移动状态的路径分段，其中靠近起始位置的分段为加速状态的路径分段，以及靠近目标位置和/或转弯位置的分段为减速状态的路径分段，规划路径中除去加速状态的路径分段和减速状态的路径分段后的剩余分段为匀速状态的路径分段。作为示例，如图4所示，对于移动机器人A0而言，其被调度从73号节点区域向31号节点区域运行，在一种情况下，可以是将73号、63号节点区域靠近起点位置的区域确定为加速状态的路径 分段，可以将32号节点区域和31号节点区域靠近目标点的区域确定为减速状态的路径分段，可以将转弯位置33号节点区域确定为减速状态的路径分段，可以将剩余的43号和53号节点区域确定为匀速状态的路径分段。
S203、确定移动机器人以机器人移动状态通过一个节点区域所需要消耗的状态通行时间。
具体的，可以假定移动机器人的加速度相同且都为a，但是在其启动、行驶、减速停止的速度不相同，所以每个移动机器人的最高的匀速速度为V，每个节点区域的半径为L，移动机器人加速通过一个节点区域的时间为Ta，匀速通过的时间为Tv，减速通过的时间为Td。由此，可以通过以下方式来确定移动机器人以机器人移动状态通过一个节点区域所需要消耗的状态通行时间：
Figure PCTCN2019072254-appb-000001
据此，可以将加速状态和减速状态通过一个节点区域分配相同的状态通行时间。可选的，可以是为通过转弯位置的节点区域分配特定的状态通行时间，例如Tc。
S204、根据多个移动机器人的当前位置、状态通行时间和路径分段建立节点资源表，其中节点资源表中记录有移动机器人ID、路径分段所经过的节点区域的节点区域ID和占用时间三者之间的对应关系，以及多个移动机器人ID中的任意两者在节点资源表中不共同对应同一节点区域ID下的同一占用时间。
在本发明实施例中，将节点区域作为一种可分配的资源进行管理，并引入了关于节点区域的占用时间作为变量对其进行维护，如图5所示，在坐标中，x、y轴分别表示二维空间中位置，而z轴为时间坐标。随着时间的推移，可以根据移动机器人的规划路径，计算出移动机器人在某一时刻的三维坐标，例如可以在图5所示的三维坐标轴上显示出移动机器人从当前位置节点区域S运行到目标节点区域T在各个时刻下的轨迹及坐标。具体的，由于移动机器人从进入到离开某一个节点是一个过程，需要一段时间进行，例如占用时间可以是具有一定数量的单位时间，因此节点资源表中的占用时间可以是指代时间段。如上所述的，在移动机器人A0从当前位置节点区域S运行到目标节点区域T的过程中，其会自主绕开静止障碍物，但是无法消除与其他运行中的移动机器人之间的碰撞冲突；为此，本发明实施例提供了一种节点资源表，其记录了移动机器人ID、节点区域ID和占用时间三者之间的对应关系，并且多个移动机器人ID中的任意两者在节点资源表中不共同对应同一节点区域ID下的同一占用时间。可以理解的是，每一移动机器人可以是被配置有唯一的移动机器人ID(例如10A、10B、10C等)，以及每一 节点区域也可以是被配置有唯一的节点区域ID(如图4所示的)。其中，移动机器人可以是被配置成只从经分配的节点区域通过，具体的，可以是移动机器人只有从服务器接收到关于下一分配的节点区域的指令时，才会执行移动，即使其可能已经自主规划好了运行路径。
关于节点资源表的建立，可以是根据第一移动机器人和第二机器人各自的当前位置、状态通行时间、规划路径，为第一移动机器人分配多个第一节点区域及相应的第一占用时间，以及为第二移动机器人分配多个第二节点区域及相应的第二占用时间；以及当存在其中一个第一节点区域与其中一个第二节点区域相同时，判断其中一个第一节点区域所对应的第一占用时间与其中一个第二节点区域所对应的第二占用时间是否存在重合；若是，则标记存在重合的其中一个第二节点区域为冲突节点区域，并在节点资源表中重新为第二移动机器人分配节点区域ID及相应的占用时间。由此，能够实现多个移动机器人ID中的任意两者，在节点资源表中不共同对应同一节点区域ID下的同一占用时间。另外，可以是服务器根据多个移动机器人的当前位置、状态通行时间、规划路径以及节点区域的大小，确定在节点资源表中为各个移动机器人ID分别分配的节点区域ID和相应的占用时间。具体的，可以计算出所有的移动机器人在任意时刻所处的节点区域的位置，例如当移动机器人A1在加速或减速状态所对应的状态通行时间Ta、Td为2个单位时间，则相应地在加速状态或减速状态的路径分段为移动机器人A1分配2个单位时间，以及当移动机器人A1在匀速状态所对应的状态通行时间Tv为1个单位，则相应地在匀速状态的路径分段为移动机器人分配1个单位时间。由此，根据路径的机器人状态来分配占用时间，提高了资源分配的精确度。
如图6所示的是本发明一实施例的节点资源表的示例，其是节点资源表进行降维处理之后的所得到的结果，其示例性地表示了当前时间0下位于73号节点区域的移动机器人A0规划前往目标区域31号节点的资源分配情况，以及当前时间0下位于55号节点的移动机器人A1规划前往目标节点19号节点的资源分配情况。从图6中可以看出来，每个节点ID对于某一个时间的资源都是唯一的，其可以通过哈希表进行标识，例如占用时间为1的73号节点区域和占用时间为2的73号节点区域就是不同的资源。并且，为不同的移动机器人之间(例如A0和A1)所分配的资源没有重合的，也就是多个移动机器人ID中的任意两者在节点资源表中不共同对应同一节点区域ID下的同一占用时间。
S205、控制多个移动机器人分别按照节点资源表中各自的移动机器人ID所对应的 占用时间，占用相应的节点区域ID的节点区域。
作为示例，可以是服务器发送控制命令至移动机器人，移动机器人在接收到该控制命令之后，能够从控制命令中解析出匹配于节点资源表的节点区域信息和相应的占用时间信息。进一步的，在移动机器人之后执行规划路径时，移动机器人需要在所解析的占用时间占据相应的节点区域。
参见图7示出的是图2中的S204的具体执行流程示意图，包括：
S2041、确定移动机器人通过其所对应的规划路径时所需要的窗口时间数量。
术语“窗口时间”是指在这一时间段内，可以对事件或事物进行处理或者反应。在服务器为多个机器人分配资源时，没有必要每个时刻、也就是每个时间窗口都去计算，这样会导致较大的资源消耗。另外，在一种情况下。移动机器人的规划路径足够长时(例如移动机器人需要移动1000多步的情况)，如果根据整个路径分配资源并控制占用节点区域，会导致计算量过大，此时就需要预设定窗口时间数量，例如为移动机器人A1分配的窗口时间数量为3，则服务器可以针对移动机器人A1在第2个时间窗口和第5个时间窗口去计算，这样可以节约资源消耗。
具体的，可以是服务器根据规划路径所对应的所划分的路径分段，确定各路径分段所通过的节点区域的数量，根据各路径分段所通过的节点区域的数量和相应的状态通行时间，确定移动机器人完成规划路径所需要的计算时长，根据计算时长和预定长度的窗口时间，确定窗口时间数量。
作为示例，假定一个窗口时间的长度为Ts，我们可以计算移动机器人i以任意运动状态通过一个节点区域所需要的时间Ti，并以该Ti为基础来确定窗口时间数量。
具体的，可以是Ti＝Ta+Td+x*Tv，其中，x表示期望直行通过节点区域的数量，例如如果要计算未来8个节点的路径，x可以被设置为8个。
进一步的，可以是通过以下方式来确定窗口时间数量Ws为：
Ws＝(Ti+Tc)/Ts
其中，可以是在确定了需要预测的移动机器人的未来节点区域的数量(或者移动机器人所行走的步数)后，就可以确定窗口时间了，以及窗口时间数量指的是轮流进行计算的时间单位。
S2042、基于对应窗口时间数量的时间间隔，根据多个移动机器人的实时位置、状态通行时间和路径分段更新节点资源表。
具体的，可以是在窗口数量的窗口时间之后，实时获取移动机器人此时所处的实 时位置，并根据状态通行时间、路径分段和实时位置来重新执行资源分配过程，具体的可以参照上文实施例的描述，由此更新节点资源表中移动机器人所对应的资源分配情况，降低计算处理对服务器资源的消耗，并提高服务器的实时响应速度，提高移动机器人的运输效率。
如图8所示，本发明一实施例的多移动机器人的冲突管理系统80，包括：初始信息获取单元801，配置为获取多个移动机器人各自的当前位置和规划路径，其中所述规划路径能够绕开预定区域内的障碍物，以及所述预定区域包括多个节点区域；路径分段划分单元802，配置为将所述规划路径划分为对应于机器人移动状态的路径分段，其中所述机器人移动状态包括加速状态、减速状态和/或匀速状态；状态通行时间确定单元803，配置为确定所述移动机器人以所述机器人移动状态通过一个所述节点区域所需要消耗的状态通行时间；节点资源表建立单元804，配置为根据所述多个移动机器人的当前位置、所述状态通行时间和所述路径分段建立节点资源表，其中所述节点资源表中记录有移动机器人ID、所述路径分段所经过的节点区域的节点区域ID和占用时间三者之间的对应关系，以及多个所述移动机器人ID中的任意两者在所述节点资源表中不共同对应同一节点区域ID下的同一占用时间；控制占用单元805，配置为控制所述多个移动机器人分别按照所述节点资源表中各自的移动机器人ID所对应的占用时间，占用相应的节点区域ID的节点区域。
在一些实施方式中，所述路径分段划分单元配置为根据所述移动机器人的规划路径的起始位置、目标位置和/或转弯位置，将所述规划路径划分为对应于机器人移动状态的路径分段，其中靠近所述起始位置的分段为加速状态的路径分段，以及靠近所述目标位置和/或所述转弯位置的分段为减速状态的路径分段，所述规划路径中除去所述加速状态的路径分段和所述减速状态的路径分段后的剩余分段为匀速状态的路径分段。
在一些实施方式中，所述节点资源表建立单元包括：窗口时间数量确定模块，配置为确定移动机器人通过其所对应的所述规划路径时所需要的窗口时间数量，包括：根据所述规划路径所对应的所划分的路径分段，确定各路径分段所通过的节点区域的数量，根据所述各路径分段所通过的节点区域的数量和相应的所述状态通行时间，确定所述移动机器人完成所述规划路径所需要的计算时长，根据所述计算时长和预定长度的窗口时间，确定所述窗口时间数量；间隔更新模块，配置为基于对应所述窗口时间数量的时间间隔，根据所述多个移动机器人的实时位置、所述状态通行时间和所述路径分段更新所述节点资源表。
在一些实施方式中，所述节点资源表建立单元包括：资源分配模块，配置为根据第一移动机器人和第二机器人各自的当前位置、所述状态通行时间、所述规划路径，为所述第一移动机器人分配多个第一节点区域及相应的第一占用时间，以及为所述第二移动机器人分配多个第二节点区域及相应的第二占用时间；冲突检测模块，配置为当存在其中一个所述第一节点区域与其中一个所述第二节点区域相同时，判断所述其中一个第一节点区域所对应的第一占用时间与所述其中一个第二节点区域所对应的第二占用时间是否存在重合；冲突解决模块，配置为若是，则标记所述存在重合的所述其中一个第二节点区域为冲突节点区域，并在所述节点资源表中重新为所述第二移动机器人分配节点区域ID及相应的占用时间。
在一些实施方式中，所述获初始信息获取单元包括：调度命令发送模块，配置为向各个所述移动机器人发送调度命令，其中所述调度命令包含各个移动机器人的目标节点区域信息；规划路径接收模块，配置为响应于所述调度命令，从所述多个移动机器人接收规划路径，其中所述规划路径为各个所述移动机器人根据各自的目标节点区域信息并通过A*算法计算所确定的。
上述本发明实施例的系统可用于执行本发明中相应的方法实施例，并相应的达到上述本发明方法实施例所达到的技术效果，这里不再赘述。
本发明实施例中可以通过硬件处理器(hardware processor)来实现相关功能模块。
另一方面，本发明实施例提供一种存储介质，其上存储有计算机程序，该程序被处理器执行如上服务器所执行的多移动机器人的冲突管理方法的步骤。
上述产品可执行本申请实施例所提供的方法，具备执行方法相应的功能模块和有益效果。未在本实施例中详尽描述的技术细节，可参见本申请实施例所提供的方法。
以上结合附图详细描述了本发明实施例的可选实施方式，但是，本发明实施例并不限于上述实施方式中的具体细节，在本发明实施例的技术构思范围内，可以对本发明实施例的技术方案进行多种简单变型，这些简单变型均属于本发明实施例的保护范围。
另外需要说明的是，在上述具体实施方式中所描述的各个具体技术特征，在不矛盾的情况下，可以通过任何合适的方式进行组合。为了避免不必要的重复，本发明实施例对各种可能的组合方式不再另行说明。
本领域技术人员可以理解实现上述实施例方法中的全部或部分步骤是可以通过程序来指令相关的硬件来完成，该程序存储在一个存储介质中，包括若干指令用以使得单片机、芯片或处理器(processor)执行本申请各个实施例所述方法的全部或部分步骤。 而前述的存储介质包括：U盘、移动硬盘、只读存储器(ROM，Read-Only Memory)、随机存取存储器(RAM，Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
此外，本发明实施例的各种不同的实施方式之间也可以进行任意组合，只要其不违背本发明实施例的思想，其同样应当视为本发明实施例所公开的内容。

Claims (10)

  1. 一种多移动机器人的冲突管理方法，包括：
    获取多个移动机器人各自的当前位置和规划路径，其中所述规划路径能够绕开预定区域内的障碍物，以及所述预定区域包括多个节点区域；
    将所述规划路径划分为对应于机器人移动状态的路径分段，其中所述机器人移动状态包括加速状态、减速状态和/或匀速状态；
    确定所述移动机器人以所述机器人移动状态通过一个所述节点区域所需要消耗的状态通行时间；
    根据所述多个移动机器人的当前位置、所述状态通行时间和所述路径分段建立节点资源表，其中所述节点资源表中记录有移动机器人ID、所述路径分段所经过的节点区域的节点区域ID和占用时间三者之间的对应关系，以及多个所述移动机器人ID中的任意两者在所述节点资源表中不共同对应同一节点区域ID下的同一占用时间；以及
    控制所述多个移动机器人分别按照所述节点资源表中各自的移动机器人ID所对应的占用时间，占用相应的节点区域ID的节点区域。
  2. 根据权利要求1所述的方法，其特征在于，所述将所述规划路径划分为对应于机器人移动状态的路径分段包括：
    根据所述移动机器人的规划路径的起始位置、目标位置和/或转弯位置，将所述规划路径划分为对应于机器人移动状态的路径分段，其中靠近所述起始位置的分段为加速状态的路径分段，以及靠近所述目标位置和/或所述转弯位置的分段为减速状态的路径分段，所述规划路径中除去所述加速状态的路径分段和所述减速状态的路径分段后的剩余分段为匀速状态的路径分段。
  3. 根据权利要求1所述的方法，其特征在于，所述根据所述多个移动机器人的当前位置、所述状态通行时间和所述路径分段建立节点资源表包括：
    确定移动机器人通过其所对应的所述规划路径时所需要的窗口时间数量，包括：
    根据所述规划路径所对应的所划分的路径分段，确定各路径分段所通过的节点区域的数量，
    根据所述各路径分段所通过的节点区域的数量和相应的所述状态通行时间，确定所述移动机器人完成所述规划路径所需要的计算时长，
    根据所述计算时长和预定长度的窗口时间，确定所述窗口时间数量；
    基于对应所述窗口时间数量的时间间隔，根据所述多个移动机器人的实时位置、所述状态通行时间和所述路径分段更新所述节点资源表。
  4. 根据权利要求1所述的方法，其特征在于，所述根据所述多个移动机器人的当前位置、所述状态通行时间和所述路径分段建立节点资源表包括：
    根据第一移动机器人和第二机器人各自的当前位置、所述状态通行时间、所述规划路径，为所述第一移动机器人分配多个第一节点区域及相应的第一占用时间，以及为所述第二移动机器人分配多个第二节点区域及相应的第二占用时间；以及
    当存在其中一个所述第一节点区域与其中一个所述第二节点区域相同时，判断所述其中一个第一节点区域所对应的第一占用时间与所述其中一个第二节点区域所对应的第二占用时间是否存在重合；
    若是，则标记所述存在重合的所述其中一个第二节点区域为冲突节点区域，并在所述节点资源表中重新为所述第二移动机器人分配节点区域ID及相应的占用时间。
  5. 根据权利要求1所述的方法，其特征在于，所述获取多个移动机器人各自的当前位置和规划路径包括：
    向各个所述移动机器人发送调度命令，其中所述调度命令包含各个移动机器人的目标节点区域信息；
    响应于所述调度命令，从所述多个移动机器人接收规划路径，其中所述规划路径为各个所述移动机器人根据各自的目标节点区域信息并通过A*算法计算所确定的。
  6. 一种多移动机器人的冲突管理系统，包括：
    初始信息获取单元，配置为获取多个移动机器人各自的当前位置和规划路径，其中所述规划路径能够绕开预定区域内的障碍物，以及所述预定区域包括多个节点区域；
    路径分段划分单元，配置为将所述规划路径划分为对应于机器人移动状态的路径分段，其中所述机器人移动状态包括加速状态、减速状态和/或匀速状态；
    状态通行时间确定单元，配置为确定所述移动机器人以所述机器人移动状态通过一个所述节点区域所需要消耗的状态通行时间；
    节点资源表建立单元，配置为根据所述多个移动机器人的当前位置、所述状态通 行时间和所述路径分段建立节点资源表，其中所述节点资源表中记录有移动机器人ID、所述路径分段所经过的节点区域的节点区域ID和占用时间三者之间的对应关系，以及多个所述移动机器人ID中的任意两者在所述节点资源表中不共同对应同一节点区域ID下的同一占用时间；
    控制占用单元，配置为控制所述多个移动机器人分别按照所述节点资源表中各自的移动机器人ID所对应的占用时间，占用相应的节点区域ID的节点区域。
  7. 根据权利要求6所述的系统，其特征在于，所述路径分段划分单元配置为根据所述移动机器人的规划路径的起始位置、目标位置和/或转弯位置，将所述规划路径划分为对应于机器人移动状态的路径分段，其中靠近所述起始位置的分段为加速状态的路径分段，以及靠近所述目标位置和/或所述转弯位置的分段为减速状态的路径分段，所述规划路径中除去所述加速状态的路径分段和所述减速状态的路径分段后的剩余分段为匀速状态的路径分段。
  8. 根据权利要求6所述的系统，其特征在于，所述节点资源表建立单元包括：
    窗口时间数量确定模块，配置为确定移动机器人通过其所对应的所述规划路径时所需要的窗口时间数量，包括：根据所述规划路径所对应的所划分的路径分段，确定各路径分段所通过的节点区域的数量，根据所述各路径分段所通过的节点区域的数量和相应的所述状态通行时间，确定所述移动机器人完成所述规划路径所需要的计算时长，根据所述计算时长和预定长度的窗口时间，确定所述窗口时间数量；
    间隔更新模块，配置为基于对应所述窗口时间数量的时间间隔，根据所述多个移动机器人的实时位置、所述状态通行时间和所述路径分段更新所述节点资源表。
  9. 根据权利要求6所述的系统，其特征在于，所述节点资源表建立单元包括：
    资源分配模块，配置为根据第一移动机器人和第二机器人各自的当前位置、所述状态通行时间、所述规划路径，为所述第一移动机器人分配多个第一节点区域及相应的第一占用时间，以及为所述第二移动机器人分配多个第二节点区域及相应的第二占用时间；
    冲突检测模块，配置为当存在其中一个所述第一节点区域与其中一个所述第二节点区域相同时，判断所述其中一个第一节点区域所对应的第一占用时间与所述其中一个 第二节点区域所对应的第二占用时间是否存在重合；
    冲突解决模块，配置为若是，则标记所述存在重合的所述其中一个第二节点区域为冲突节点区域，并在所述节点资源表中重新为所述第二移动机器人分配节点区域ID及相应的占用时间。
  10. 根据权利要求6所述的系统，其特征在于，所述获初始信息获取单元包括：
    调度命令发送模块，配置为向各个所述移动机器人发送调度命令，其中所述调度命令包含各个移动机器人的目标节点区域信息；
    规划路径接收模块，配置为响应于所述调度命令，从所述多个移动机器人接收规划路径，其中所述规划路径为各个所述移动机器人根据各自的目标节点区域信息并通过A*算法计算所确定的。
PCT/CN2019/072254 2018-01-19 2019-01-18 多移动机器人的冲突管理方法及系统 WO2019141217A1 (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201810053974.4A CN108287545B (zh) 2018-01-19 2018-01-19 多移动机器人的冲突管理方法及系统
CN201810053974.4 2018-01-19

Publications (1)

Publication Number Publication Date
WO2019141217A1 true WO2019141217A1 (zh) 2019-07-25

Family

ID=62835319

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2019/072254 WO2019141217A1 (zh) 2018-01-19 2019-01-18 多移动机器人的冲突管理方法及系统

Country Status (2)

Country Link
CN (1) CN108287545B (zh)
WO (1) WO2019141217A1 (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117381805A (zh) * 2023-12-13 2024-01-12 成都航空职业技术学院 一种面向冲突应对的机械臂运行控制方法和系统

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108287545B (zh) * 2018-01-19 2021-08-06 广东美的智能机器人有限公司 多移动机器人的冲突管理方法及系统
CN109108973B (zh) * 2018-08-29 2021-05-07 广州安商智能科技有限公司 单向式路径调度方法及系统
TWI676090B (zh) * 2018-10-19 2019-11-01 廣達電腦股份有限公司 用於多個機器人之移動控制方法以及其系統
CN109724612B (zh) * 2019-01-14 2021-06-15 浙江华睿科技有限公司 一种基于拓扑地图的agv路径规划方法及设备
CN111434394B (zh) * 2019-01-14 2024-02-09 北京京东振世信息技术有限公司 一种锁定自动小车行驶路径关键点的方法和装置
CN112699135B (zh) * 2019-10-22 2023-12-05 北京京东乾石科技有限公司 信息更新方法和装置
CN110727272B (zh) * 2019-11-11 2023-04-18 广州赛特智能科技有限公司 一种多台机器人的路径规划调度系统及方法
CN111399451B (zh) * 2020-03-17 2021-06-22 广东博智林机器人有限公司 一种基于调度系统的冲突解决方法、装置和存储介质
CN111736606B (zh) * 2020-06-28 2024-03-19 杭州海康机器人股份有限公司 移动机器人行驶方法、装置及存储介质
CN112788293B (zh) * 2020-12-29 2023-08-25 深圳市朗驰欣创科技股份有限公司 一种信息采集方法、装置、终端设备及存储介质
CN113465621B (zh) * 2021-06-22 2022-09-20 同济大学 一种考虑冲突概率的Dijkstra路径规划方法、装置及存储介质
CN114442607A (zh) * 2021-12-21 2022-05-06 重庆特斯联智慧科技股份有限公司 一种多机器人路径协调方法和系统

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105446343A (zh) * 2016-01-04 2016-03-30 杭州亚美利嘉科技有限公司 一种机器人的调度方法及装置
CN106251016A (zh) * 2016-08-01 2016-12-21 南通大学 一种基于动态时间窗的泊车系统路径规划方法
CN107179078A (zh) * 2017-05-24 2017-09-19 合肥工业大学(马鞍山)高新技术研究院 一种基于时间窗优化的agv路径规划方法
CN108287545A (zh) * 2018-01-19 2018-07-17 广东美的智能机器人有限公司 多移动机器人的冲突管理方法及系统

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106556406B (zh) * 2016-11-14 2020-02-14 北京特种机械研究所 多agv调度方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105446343A (zh) * 2016-01-04 2016-03-30 杭州亚美利嘉科技有限公司 一种机器人的调度方法及装置
CN106251016A (zh) * 2016-08-01 2016-12-21 南通大学 一种基于动态时间窗的泊车系统路径规划方法
CN107179078A (zh) * 2017-05-24 2017-09-19 合肥工业大学(马鞍山)高新技术研究院 一种基于时间窗优化的agv路径规划方法
CN108287545A (zh) * 2018-01-19 2018-07-17 广东美的智能机器人有限公司 多移动机器人的冲突管理方法及系统

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117381805A (zh) * 2023-12-13 2024-01-12 成都航空职业技术学院 一种面向冲突应对的机械臂运行控制方法和系统
CN117381805B (zh) * 2023-12-13 2024-02-27 成都航空职业技术学院 一种面向冲突应对的机械臂运行控制方法和系统

Also Published As

Publication number Publication date
CN108287545B (zh) 2021-08-06
CN108287545A (zh) 2018-07-17

Similar Documents

Publication Publication Date Title
WO2019141217A1 (zh) 多移动机器人的冲突管理方法及系统
WO2019141222A1 (zh) 多移动机器人的冲突管理方法及系统
CN107992060B (zh) 多移动机器人的路径规划方法及系统
CN108267149B (zh) 多移动机器人的冲突管理方法及系统
WO2019141218A1 (zh) 多移动机器人的冲突管理方法及系统
CN109991977B (zh) 机器人的路径规划方法及装置
CN108287547B (zh) 多移动机器人的冲突管理方法及系统
WO2019141223A1 (zh) 移动机器人的路径规划方法及系统
WO2019141221A1 (zh) 多移动机器人的冲突管理方法及系统
WO2019141219A1 (zh) 多移动机器人的调度方法及系统
WO2019141220A1 (zh) 移动机器人的路径规划方法及系统
WO2019141225A1 (zh) 多移动机器人的冲突管理方法及系统
CN110989582A (zh) 基于路径预先占用的多agv自动避让式智能调度方法
WO2019141226A1 (zh) 多移动机器人的冲突管理方法及系统
EP3262475A1 (en) Resolution of route conflict
Lienert et al. No More Deadlocks-Applying The Time Window Routing Method To Shuttle Systems.
CN116700298B (zh) 路径规划方法、系统、设备及存储介质
CN110597261A (zh) 一种预防碰撞冲突的方法及装置
KR20210086400A (ko) 인공지능 기반의 지능형 배차 시스템 및 그 동작 방법
Xu et al. Dynamic spare point application based coordination strategy for multi-AGV systems in a WIP warehouse environment
WO2019228285A1 (zh) 一种任务调度方法及装置
CN116339257A (zh) Agv多车调度系统以及相关调度方法
CN113741470B (zh) 机器人组队控制方法、装置、机器人及调度设备
KR102397338B1 (ko) 자율 주차 로봇 시스템의 작업 계획 관리 장치 및 관리 방법
CN114519480A (zh) 多机器人导航的资源分配方法、设备及存储介质

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 19741344

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

32PN Ep: public notification in the ep bulletin as address of the adressee cannot be established

Free format text: NOTING OF LOSS OF RIGHTS PURSUANT TO RULE 112(1) EPC (EPO FORM 1205A DATED 04/12/2020)

122 Ep: pct application non-entry in european phase

Ref document number: 19741344

Country of ref document: EP

Kind code of ref document: A1