EP4184273A1 - Information processing device, information processing method, and program - Google Patents
Information processing device, information processing method, and program Download PDFInfo
- Publication number
- EP4184273A1 EP4184273A1 EP21842186.5A EP21842186A EP4184273A1 EP 4184273 A1 EP4184273 A1 EP 4184273A1 EP 21842186 A EP21842186 A EP 21842186A EP 4184273 A1 EP4184273 A1 EP 4184273A1
- Authority
- EP
- European Patent Office
- Prior art keywords
- lanes
- mobile body
- route
- boundary line
- route map
- 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
- 230000010365 information processing Effects 0.000 title claims description 46
- 238000003672 processing method Methods 0.000 title claims description 6
- 238000000034 method Methods 0.000 claims description 18
- 238000000926 separation method Methods 0.000 claims description 12
- 238000012545 processing Methods 0.000 description 53
- 238000004891 communication Methods 0.000 description 27
- 238000005516 engineering process Methods 0.000 description 19
- 238000010586 diagram Methods 0.000 description 13
- 238000005259 measurement Methods 0.000 description 4
- 239000000284 extract Substances 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 230000010267 cellular communication Effects 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000007689 inspection Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 239000004065 semiconductor Substances 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000002730 additional effect Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012552 review Methods 0.000 description 1
- 238000010845 search algorithm Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
-
- 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/0291—Fleet control
- G05D1/0297—Fleet control by controlling means in a control room
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/38—Electronic maps specially adapted for navigation; Updating thereof
- G01C21/3804—Creation or updating of map data
- G01C21/3807—Creation or updating of map data characterised by the type of data
- G01C21/383—Indoor data
-
- 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/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- 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/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Definitions
- This technology relates to an information processing device, an information processing method, and a program, and enables efficient operation of a mobile body even when the density of the mobile bodies is increased in an environment in which a passable region of the mobile body changes.
- a system using a mobile body has been used for various purposes, for example, conveyance of articles, inspection of facilities, security, and the like.
- the mobile body In order for the mobile body to move, it is necessary to reach the destination without colliding with static and dynamic obstacles (including other mobile robots) on environment. Therefore, for example, in Patent Document 1, generation and update of a map indicating an arbitrary environment in which a plurality of robots operates and provision of data used by one or a plurality of the robots in the environment are performed by a manager.
- Patent Document 1 WO 2009/102970 A
- An object of this technology is to provide an information processing device, an information processing method, and a program, which enables efficient operation of a mobile body even when the density of the mobile bodies is increased in an environment in which a passable region of the mobile body changes.
- an information processing device including a route map generation unit configured to, in an environment in which obstacles are present, set a boundary line formed by a group of points having an equal distance from two different obstacles among the obstacles between the obstacles in a movable region that is a region in which a mobile body is movable, and determine the number of lanes for the boundary line in accordance with a distance from each of the obstacles to the boundary line and a size of the mobile body moving in the environment.
- the route map generation unit performs, for example, Voronoi region division on the movable region that is a region in which a mobile body is movable, sets the boundary line formed by a group of points having an equal distance from the obstacle between the obstacles, determines the number of lanes for the boundary line in accordance with a distance from the obstacle and the size of the mobile body moving between the obstacles, and generates a route map having number-of-lanes information on the basis of the boundary line and the number of lanes determined for the boundary line.
- the number of lanes corresponds to the number of mobile bodies that can pass through at the same time, and the size of the mobile body is the maximum value of the mobile body width orthogonal to a moving direction, and may include a margin.
- the route map generation unit sets nodes at a branch point and an end point of the boundary line and at a change point of the number of lanes of the boundary line, and sets new one node between the nodes instead of two nodes between which a distance is shorter than a first threshold in a case where a distance between the nodes is shorter than a first threshold. Furthermore, in a case where the distance between the nodes is greater than a second threshold greater than the first threshold, the route map generation unit newly sets a node on the boundary line between the nodes, and divides an edge between the nodes into edges via the newly set node.
- the route map generation unit newly sets a node on the boundary line between the nodes and divides the edge between the nodes into edges via the newly set node.
- the route map generation unit sets the number of lanes determined for the boundary line as number-of-lanes information of an edge corresponding to the boundary line and sets the minimum number of lanes in the edge connected to the nodes as number-of-lanes information of the node, and generates a topological map, in which the nodes are connected by the edge and which has the number-of-lanes information, as a route map.
- the route map generation unit may provide edges corresponding to the number of lanes determined for the boundary line and set nodes at opposite ends of the edges to generate, as a route map, a lane map in which the number of lanes of the node and the edge is one.
- the route map generation unit updates the route map according to a change of the movable region.
- the information processing device further includes a route planning unit that plans a route of the mobile body by using the route map having the number-of-lanes information, and the route planning unit plans a route for each mobile body such that the number of mobile bodies does not exceed the number of lanes indicated by the number-of-lanes information.
- the route map generation unit may determine the number of lanes by using a base lane width corresponding to a plurality of mobile bodies having different sizes as the size of the mobile body, and the route planning unit may plan a route by using the number of lanes having the base lane width occupied by each mobile body having a plurality of different sizes.
- an information processing method including: in an environment in which obstacles are present, setting a boundary line formed by a group of points having an equal distance from two different obstacles among the obstacles between the obstacles in a movable region that is a region in which a mobile body is movable; and determining the number of lanes for the boundary line in accordance with a distance from each of the obstacles to the boundary line and a size of the mobile body moving in the environment.
- a program causing a computer to generate a route map, the program causing the computer to execute:
- the program of the present technology is, for example, a program that can be provided, to a general-purpose computer capable of executing various program codes, by a storage medium provided in computer-readable format, a communication medium, for example, a storage medium such as an optical disk, a magnetic disk, or a semiconductor memory, or a communication medium such as a network.
- a storage medium for example, a storage medium such as an optical disk, a magnetic disk, or a semiconductor memory, or a communication medium such as a network.
- FIG. 1 illustrates a configuration of a mobile body control system.
- a mobile body control system 10 includes a plurality of mobile bodies 20 and a server 30.
- a movement task performed using the mobile body 20 is received by the server 30, and the server 30 generates a route plan for executing the movement task and provides the route plan to the mobile body 20.
- the mobile body 20 plans a path so as to move along a route indicated by the route plan supplied from the server 30 and executes the movement task.
- the movement task is a task involving movement of the mobile body 20 such as a robot or an automated guided vehicle (AGV), and the movement task may be performed by an arbitrary mobile body, a mobile body having a predetermined function or capability, a designated mobile body, or the like. Furthermore, the movement task may simply be to reach a certain point and perform a task (such as inspection), or may be to perform further movement to another point (such as conveyance).
- AGV automated guided vehicle
- the server 30 performs task planning to determine to which mobile body the movement task input from the user or the like is assigned (or whether to change the existing assignment).
- various methods may be used without particular limitation. For example, in a case where an arbitrary mobile body is used, a method of selecting an empty mobile body closest to the destination of the movement task, a method of selecting a mobile body having the smallest number of assigned tasks in a case where there is no empty mobile body, or the like is used.
- the server 30 When determining the mobile body to which the movement task is assigned, the server 30 generates a route plan on the basis of the route map at that time.
- the route map is expressed as, for example, a topological map including a relay node group as an intermediate destination candidate in the environment and an edge group connecting relay nodes that is directly passable.
- route planning for determining which relay node or edge the mobile body passes through between the current location and the final destination is initially performed, and the movement to the next node is performed in accordance with a path plan, such that the calculation amount for the path is reduced as compared with a case of calculating the path from the current location to the final destination and performing movement without using the node.
- a Dijkstra's algorithm or the like is often used as a route planning method.
- the route plan may be a method of adding a route plan of a target mobile body without changing the route plan of another mobile body, or the entire route plan may be optimized including a review of the route plan of another mobile body.
- Fig. 2 illustrates configurations of the mobile body and the server.
- the mobile body 20 includes a sensor unit 21, a surrounding map generation unit 22, a self-position estimation unit 23, a communication unit 24, a path planning unit 25, a drive control unit 26, and a drive unit 27.
- the sensor unit 21 includes an external sensor and an internal sensor.
- the external sensor of the sensor unit 21 acquires information regarding the surrounding environment of the mobile body (for example, information regarding a surrounding object or the like).
- a distance measurement sensor Light Detection and Ranging, or Laser Imaging Detection and Ranging (LIDAR) sensor, Time Of Flight (TOF), stereo camera, or the like
- LIDAR Laser Imaging Detection and Ranging
- TOF Time Of Flight
- the external sensor generates sensing data (also referred to as "distance measurement data”) indicating a distance to a surrounding object and outputs the sensing data to the surrounding map generation unit 22 and the self-position estimation unit 23.
- the internal sensor of the sensor unit 21 acquires information regarding the mobile body itself (for example, information indicating the position and orientation of the mobile body, a change thereof, and the like).
- the internal sensor for example, a position sensor, an angle sensor, an acceleration sensor, a gyro sensor, or the like is used.
- the internal sensor outputs the generated sensing data (also referred to as "internal sensing data") to the self-position estimation unit 23.
- the surrounding map generation unit 22 generates map information indicating an object located nearby on the basis of the distance measurement data generated by the sensor unit 21.
- the surrounding map generation unit 22 outputs the generated map information to the communication unit 24 and the path planning unit 25.
- the self-position estimation unit 23 estimates a self-position on the basis of the internal sensing data or internal sensing data generated by the sensor unit 21 and the distance measurement data generated by the external sensor, and outputs self-position information indicating the estimated self-position to the communication unit 24 and the path planning unit 25.
- the communication unit 24 is connected to a network and performs wireless communication with the server 30.
- the wireless communication may include, for example, cellular communication using any of LTE, WCDMA (registered trademark), 5G, and the like, and may include near field communication using any of Wi-Fi, Bluetooth (registered trademark), and the like.
- the communication unit 24 performs wireless communication with the server 30, and transmits the map information generated by the surrounding map generation unit 22 and the self-position estimated by the self-position estimation unit 23 to the server 30.
- the communication unit 24 of the mobile body 20 may transmit mobile body information indicating the size, performance, and the like of the mobile body 20 to the server 30.
- the communication unit 24 receives information transmitted from the server 30, for example, a route plan, and outputs the received information to the path planning unit 25.
- the path planning unit 25 plans the path of the mobile body 20 by using map information generated by the surrounding map generation unit 22 and an estimation result of the self-position estimation unit 23 such that the mobile body 20 moves along the route indicated by the route plan supplied from the server 30.
- the nodes to the destination are sequentially indicated on the basis of a route map indicating a route on which the mobile body can pass and a movement task assigned to the mobile body, and the path planning unit 25 determines a path from the current location to a first node and a path from the current node to the next node.
- the path planning unit 25 uses, for example, an A* algorithm or a rapidly-exploring random tree (RRT) algorithm as a path-search algorithm to perform recognition of the surrounding environment of the mobile body 20 and a path search for the next node or the destination, and moving operation can be performed while avoiding collision even when there is a dynamic obstacle by repeating determination of an optimum moving speed, angular velocity, and the like at that time.
- the path planning unit 25 outputs the determined path to the drive control unit 26.
- the drive control unit 26 generates a drive signal such that the mobile body 20 moves on the path determined by the path planning unit 25, and outputs the drive signal to the drive unit 27.
- the drive unit 27 is configured by using wheels, a drive source (for example, a motor), and the like, and drives the wheels with the drive source on the basis of the drive signal from the drive control unit 26 to move the mobile body 20.
- a drive source for example, a motor
- the server 30 includes a communication unit 31, a movable region map generation unit 32, a route map generation unit 33, a map storage unit 34, a mobile body information storage unit 35, a task planning unit 36, and a route planning unit 37.
- the communication unit 31 is configured to be capable of performing wireless communication with the communication unit 24 of the mobile body 20.
- the wireless communication may include cellular communication as described above, or may include near field communication.
- the communication unit 31 performs wireless communication with the mobile body 20, and receives map information generated by the mobile body 20 and self-position information indicating the estimated self-position.
- the communication unit 31 outputs the received map information and self-position information to the movable region map generation unit 32.
- the communication unit 31 receives mobile body information and outputs the mobile body information to the mobile body information storage unit 35.
- the communication unit 31 transmits the route plan generated by the route planning unit 37 to the mobile body 20.
- the movable region map generation unit 32 integrates the map information generated by each mobile body 20 to generate a movable region map indicating a region in which the mobile body 20 can pass in the entire environment.
- the movable region map generation unit 32 outputs the generated movable region map to the route map generation unit 33.
- the movable region map generation unit 32 may generate the movable region map on the basis of sensing data acquired by an external sensor provided separately from the mobile body, or may acquire the movable region map generated in advance from an external device or the like.
- the movable region map generation unit 32 updates the movable region map according to a change of the movable region. For example, the movable region map generation unit 32 automatically updates the movable region map when determining that a movable region in which the mobile body 20 can pass has changed due to installation, movement, removal, or the like of an obstacle.
- the route map generation unit 33 generates a route map having the number-of-lanes information related to a passage and a passage width on the basis of the movable region map generated by the movable region map generation unit 32. Note that details of generation of the route map will be described later. Furthermore, the route map generation unit 33 automatically updates the route map in a case where it is determined that the movable region has changed by the movable region map generation unit 32 and the movable region map is updated.
- the map storage unit 34 stores the route map generated by the route map generation unit 33. Furthermore, the mobile body information storage unit 35 stores mobile body information for each mobile body. The mobile body information may be acquired by communication with the mobile body 20 as described above, or the user may input the mobile body information in advance.
- the task planning unit 36 receives a movement task request made by a user or the like, and determines a mobile body that performs a movement task. Moreover, the task planning unit 36 outputs task assignment information indicating the mobile body and the movement task assigned to the mobile body to the route planning unit 37.
- the route planning unit 37 generates a route plan for performing the assigned movement task for each mobile body.
- a route to the destination is determined on the basis of the passage and number-of-lanes information which are indicated in the route map generated by the route map generation unit 33, and for example, a list sequentially indicating the nodes on a moving route is generated.
- the route planning unit 37 determines a route such that the movement efficiency of the entire system increases in a case where a movement task is performed by a plurality of the mobile bodies.
- the route planning unit 37 performs processing of updating the route plan.
- the route planning unit 37 For example, in a case where the number-of-lanes information of the moving route is updated, or in a case where the moving routes of the mobile body performing newly received movement task overlap, the route planning unit 37 generates a new route plan in consideration of the updated number-of-lanes information, the route of another mobile body, and the like. The route planning unit 37 transmits the route plan generated for each mobile body to the corresponding mobile body 20 via the communication unit 31.
- the server sets a boundary line formed by a group of points having an equal distance from obstacles between the obstacles in the movable region that is a region in which the mobile body is movable, and determines the number of lanes for the boundary line in accordance with a distance from each of the obstacles and a size of the mobile body moving between the obstacles. Furthermore, the server generates a route map having number-of-lanes information on the basis of the boundary line and the number of lanes determined for the boundary line. For example, the server sets nodes at a branch point and an end point of the boundary line and at a change point of the number of lanes of the boundary line, and automatically generates a topological map in which the nodes are connected by an edge as a route map.
- the server selects a mobile body that executes a movement task, sequentially assigns nodes in a traveling direction to the selected mobile body and releases the nodes through which the mobile body passes, and generates a route plan by limiting the number of mobile bodies simultaneously present in accordance with the number of lanes determined by the nodes and edges.
- the server in a case where the route map is updated, the server generates a route plan again on the basis of the updated route map and the current location of each mobile body.
- the server transmits the generated route plan to the mobile body.
- the mobile body plans a path so as to move along a route indicated by the route plan generated by the server and executes the movement task.
- Fig. 3 is a flowchart illustrating operation of generating the route map.
- the movable region map generation unit In Step ST1, the movable region map generation unit generates a movable region map.
- the movable region map generation unit 32 integrates, for example, the map information generated by each mobile body to generate a movable region map indicating a region in which the mobile body can pass in the entire environment, and causes processing to proceed to Step ST2.
- the movable region map generation unit 32 may generate the movable region map on the basis of sensing data acquired by an external sensor provided separately from the mobile body, or may acquire the movable region map from an external device or the like.
- Fig. 4 illustrates the movable region map, and detected obstacle is indicated by a line (or dot).
- the obstacle refers to an object present in the environment, and includes, for example, a mobile body such as a person or an automated mobile robot in addition to a rack, a cardboard box, a desk, and a chair. Furthermore, an object that defines the environment, such as a wall or a column, is also included as the obstacle.
- Step ST2 the route map generation unit extracts a boundary line indicating a skeleton of the movable region.
- the route map generation unit 33 extracts the boundary line indicating the skeleton of the movable region from the movable region map generated in Step ST1.
- the boundary line indicating the skeleton is extracted using, for example, a Voronoi region division method.
- Voronoi region division in two dimensions is a method of dividing a plane into regions on the basis of "which is the closest point" when a plurality of points is disposed in advance on the plane.
- the route map generation unit 33 performs Voronoi region division on the entire movable region, extracts a boundary line, which is formed by a group of points having a feature that distances to two different obstacles are the same, as a boundary line indicating a skeleton, and causes the processing to proceed to Step ST3.
- Fig. 5 illustrates a division result of the Voronoi region division, and is a case where the processing of Step ST2 is performed using the movable region map illustrated in Fig. 4 .
- the route map generation unit In Step ST3, the route map generation unit generates number-of-lanes information.
- the route map generation unit 33 generates, for the boundary line extracted in Step ST2, number-of-lanes information indicating the number of lanes corresponding to the number of mobile bodies that can pass through at the same time. For example, at each point on the boundary line indicating the skeleton, in a case where a distance W to the obstacle is smaller than a value half the size of the mobile body (hereinafter referred to as "size R"), the mobile body cannot pass through. Therefore, the route map generation unit 33 deletes the boundary line through which the mobile body cannot pass.
- the size of the mobile body is the maximum value of the mobile body width orthogonal to the moving direction.
- the mobile body width is a size including an article to be conveyed.
- the size of the mobile body may include a margin.
- the mobile body width including the article to be conveyed can be determined by the assigned movement task, and for example, when it is obvious what kind of article is to be conveyed with the movement task, the mobile body width can be calculated on the basis of the article to be conveyed and the shape of the mobile body.
- the route map generation unit 33 leaves only the boundary line having the longest total distance and deletes the remaining other boundary lines. Moreover, the route map generation unit 33 generates the number-of-lanes information for the remaining boundary lines. For example, in a case where the distance W from the boundary line to the obstacle is equal to or greater than N times the size R and less than (N + 1) times the size R, the route map generation unit 33 sets the number-of-lanes information on the boundary line as the number of lanes N. The route map generation unit 33 assigns the generated number-of-lanes information to the boundary line and causes the processing to proceed to Step ST4.
- Fig. 6 illustrates a boundary line to which the number-of-lanes information is assigned, and illustrates a case where the processing of Step ST3 is performed on the division result of the Voronoi region division illustrated in Fig. 5 .
- the boundary line indicating the passage through which the mobile body cannot pass is deleted, and in a case where the remaining boundary lines are separated, only the boundary line having the longest total distance is left and the other remaining boundary lines are deleted. Note that in Fig. 6 , a boundary line having the number of lanes of "two" is indicated by a thick line, and a boundary line having the number of lanes of "one" is indicated by a thin line.
- Step ST4 the route map generation unit generates a topological map.
- the route map generation unit 33 assigns nodes to the boundary line to which the number-of-lanes information is assigned, and connects the nodes by the edge to generate the topological map.
- the route map generation unit 33 performs the following processing on the boundary line to which the number-of-lanes information is assigned to generate the topological map.
- Fig. 8 is a diagram for explaining a case where processing 4-4 and processing 4-5 are performed on a region AR illustrated in Fig. 7 . Note that (a) of Fig. 8 illustrates a state before processing, and (b) of Fig. 8 illustrates a state after processing.
- a node Nda is newly set on the boundary line between the node Nd1 and the node Nd2, and then the edge connecting the node Nd1 to the node Nd2 is divided into an edge connecting the node Nd1 to the node Nda and an edge connecting the node Nda to the node Nd2.
- a node Ndc is newly set on the boundary line between the node Nd4 and the node Nd5, and then the edge connecting the node Nd4 to the node Nd5 is divided into an edge connecting the node Nd4 to the node Ndc and an edge connecting the node Ndc to the node Nd5.
- a node Ndb is newly set on the boundary line between the node Nd3 and the node Nd4, and then the edge connecting the node Nd3 to the node Nd4 is divided into an edge connecting the node Nd3 to the node Ndb and an edge connecting the node Ndb to the node Nd4.
- nodes Ndd and Nde are newly set on the boundary line between the node Nd6 and the node Nd7 and the boundary line between the node Nd6 and the node Nd8 to perform node division.
- Fig. 10 illustrates processing result obtained in a case where processing 4-6 and processing 4-7 are performed on the processing result illustrated in Fig. 9 .
- the route map generation unit 33 performs processing from Step ST2 to Step ST4 by using the movable region map generated in Step ST1, for example, generates a topological map having the number-of-lanes information illustrated in Fig. 10 , and stores the topological map in the map storage unit 34 as a route map.
- the route map generated by the route map generation unit 33 and stored in the map storage unit 34 is a topological map configured by the nodes and edges, and the edge length is limited to a certain distance or less. Furthermore, in the route map, number-of-lanes information indicating how many mobile bodies can exist at the same time is assigned to each node.
- the route planning unit 37 generates a route plan by using the topological map (route map) generated by the route map generation unit 33 by the number of steps in time series. That is, one of time-series topological maps indicates a topological map at a future time, and the mobile body can move to an adjacent node connected by the edge by continuing to move during one step in time series.
- topological maps of each time-series step are arranged in time series.
- the route planning unit 37 traces the nodes on the time-series topological map in a form of satisfying a restriction that the mobile body always moves to any node on the topological map of the next time-series step in one time-series step, and generates a path plan in a form that the mobile body reaches the node at a position as the destination. Furthermore, the route planning unit 37 sets a route by limiting the number of moving bodies so as not to exceed the number of lanes indicated by the number-of-lanes information assigned to nodes and edges, and releases the nodes through which the mobile body has passed.
- a route plan of a new mobile body is added, as the simplest method, for example, a node on the time-series topological map that has reached the upper limit of the number of lanes due to the route plan of another mobile body is excluded, and a route satisfying the restriction that the mobile body always moves to any node of the topological map of the next time-series step in one time-series step is selected.
- the route planning unit 37 limits only a route satisfying the above-described restriction as a search target.
- route planning for all the mobile bodies may be collectively performed again.
- a route plan is selected by full search or the like, the route plan satisfying a restriction condition that the "mobile body always moves to any node of the topological map of the next time-series step in one time-series step" and a restriction that the "mobile bodies corresponding to the number of lanes or more should not exist on a node of a certain time-series topological map".
- the route planning unit 37 uses a method described in the document " Optimal Multi-Robot Path Planning on Graphs: Complete Algorithms and Effective Heuristics, Jingjin Yu Steven M. LaValle, 2015 ".
- the route planning unit 37 transmits the generated route plan for each mobile body to the corresponding mobile body, and the mobile body performs movement control on the basis of the route plan generated by the route planning unit 37 and completes the movement task.
- the route plan is generated on the basis of the route map having the number-of-lanes information, such that the movement task can be processed without causing a stall or the like even when many mobile bodies are used. Furthermore, not only the route map having the number-of-lanes information is generated, but also the route map is automatically updated in accordance with a change of the movable region. Therefore, it is not necessary to manually reset the route map in accordance with a change of the layout of the obstacle, and efficient operation can be easily performed at low cost.
- a mobile body having a different shape may be used.
- mobile body information of the mobile body having a different shape is stored in the mobile body information storage unit 35, a base lane width is determined from the width of the mobile body having a different shape, and the number of lanes is calculated using the basic lane width.
- the route of the mobile body is planned on the basis of the number of lanes occupied by the mobile bodies having different shapes.
- the number of lanes corresponds to the number of moving bodies that can pass through at the same time, but does not always indicate the number of mobile bodies that can pass through, and the number of lanes calculated using the base lane width is used as the number for enabling calculation of the number of mobile bodies that can pass through at the same time as described later.
- the width of the mobile body MOa is a mobile body width MWa
- the width of the mobile body MOb is a mobile body width MWb
- the width of the mobile body MOc is a mobile body width MWc.
- the margin required at the time of movement of the mobile body MOa is a width ma
- the margin required at the time of movement of the mobile body MOb is a width mb
- the margin required at the time of movement of the mobile body MOc is a width mc.
- the mobile body width is a size including the size of the article to be conveyed as described above.
- a width (MWa + ma) is occupied when the mobile body MOa moves.
- a width (MWb + mb) is occupied when the mobile body MOb moves, and a width (MWc + mc) is occupied when the mobile body MOc moves. Therefore, a base lane width BW satisfying Equations (1), (2), and (3) is calculated.
- the numbers of occupied lanes Ka, Kb, and Kc are natural numbers, and the widths ma, mb, and mc of the margin are values smaller than the base lane width BW.
- width (MWa + ma) 40 cm
- width (MWb + mb) 60 cm
- width (MWc + mc) 100 cm
- 20 cm which is the greatest common divisor of each width is set as the base lane width BW.
- the route map generation unit 33 calculates the number of lanes of each node on the basis of the base lane width BW determined on the basis of the mobile body information for each mobile body, which is stored in the mobile body information storage unit 35. Specifically, in Step ST3 of Fig. 3 , the number of lanes N is calculated with a size half the base lane width BW as the size R.
- the route planning unit 37 sets the number of occupied lanes for each mobile body and generates a route plan such that the total number of occupied lanes at each node does not exceed the number of lanes at any timing.
- the base lane width BW is 20 cm
- the number of occupied lanes of the mobile body MOc is five lines.
- the route planning unit 37 sets a route on the basis of the number of occupied lanes for each mobile body so as not to exceed the number of lanes of the node. For example, in a case where route planning for the mobile body MOb is newly performed, when the number of occupied lanes of the mobile body MOb is three lines, a route is searched while excluding nodes having two or less empty lanes, and a route plan is generated.
- Fig. 11 is a diagram for explaining generation of a lane map, in which (a) of Fig. 11 illustrates a topological map in which number-of-lanes information is assigned to nodes and edges, and (b) of Fig. 11 illustrates a lane map corresponding to the topological map.
- processing 5-1 and processing 5-2 are performed on the topological map in which the number-of-lanes information is assigned to the node and the edge, a lane map in which the number of lanes of the WP and the edge is "one" can be generated.
- Fig. 12 illustrates the lane map generated using the route map illustrated in Fig. 10 .
- one edge is provided for a passage in which the number of lanes is "one"
- two edges are provided for a passage in which the number of lanes is "two".
- the route planning unit 37 plans a route by using the lane map in a similar manner to the case of using the route map including the number-of-lanes information.
- the route planning unit 37 In a case where the route planning unit 37 generates a route plan on the basis of the route map (in a case where the lane map is not used), since a route is determined such that N or less mobile bodies can pass through a node having the number of lanes N, it is guaranteed that there is a space required for parallel running of N or less mobile bodies or for passing of N or less mobile bodies with each other. However, in actual parallel running or passing with each other, it is necessary to perform control such that contact or collision does not occur due to the path plan of the mobile body.
- the mobile body in the case of passing with each other, when the mobile body detects the presence of another mobile body while passing through the center of the passage, the mobile body needs to perform a collision avoidance operation by deceleration or a direction change, which causes a decrease in a moving speed or the like.
- the route planning unit 37 can designate a lane on which each mobile body passes such that parallel running or passing with each other is possible. Therefore, the mobile body is less likely to perform deceleration operation or avoidance operation so as not to cause contact or collision due to the path plan, and the moving speed is less decreased as compared with the route plan not using the lane map, and the movement task can be efficiently processed.
- the technology according to the present disclosure can be applied to various fields.
- the technology according to the present disclosure may be realized as a device mounted on any type of mobile body such as an automobile, an electric vehicle, a hybrid electric vehicle, a motorcycle, a bicycle, a personal mobility, a ship, and a robot.
- the technology according to the present disclosure may be realized as a device mounted on an equipment used in a production process in a factory, an equipment used in a construction field, or an equipment used in agriculture, forestry, or the like.
- work or the like can be efficiently performed using a plurality of equipments even in an environment in which a passable region of a mobile body changes according to a work situation.
- a series of processing described in the specification can be executed by hardware, software, or a combined configuration of both the software and the hardware.
- processing is executed by software
- a program in which a processing sequence is recorded is installed and executed in a memory in a computer incorporated in dedicated hardware.
- the program can be installed and executed in a general-purpose computer capable of executing various types of processing.
- the program can be recorded in advance in a hard disk, a solid state drive (SSD), or a read only memory (ROM) as a recording medium.
- the program can be temporarily or permanently stored (recorded) in a removable recording medium such as a flexible disk, a compact disc read only memory (CD-ROM), a magneto optical (MO) disk, a digital versatile disc (DVD), a Blu-ray disc (BD) (registered trademark), a magnetic disk, or a semiconductor memory card.
- a removable storage medium can be provided as so-called package software.
- the program may be transferred from a download site to the computer wirelessly or by wire via a network such as a local area network (LAN) or the Internet.
- LAN local area network
- the program transferred as described above can be received and installed in a recording medium such as a built-in hard disk.
- the information processing device of the present technology can also have the following configurations.
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Instructional Devices (AREA)
- Navigation (AREA)
Abstract
Description
- This technology relates to an information processing device, an information processing method, and a program, and enables efficient operation of a mobile body even when the density of the mobile bodies is increased in an environment in which a passable region of the mobile body changes.
- In the related art, a system using a mobile body has been used for various purposes, for example, conveyance of articles, inspection of facilities, security, and the like. In order for the mobile body to move, it is necessary to reach the destination without colliding with static and dynamic obstacles (including other mobile robots) on environment. Therefore, for example, in
Patent Document 1, generation and update of a map indicating an arbitrary environment in which a plurality of robots operates and provision of data used by one or a plurality of the robots in the environment are performed by a manager. - Patent Document 1:
WO 2009/102970 A - By the way, in a route map generated by an existing method, it is not possible to determine whether passing with each other is possible. Therefore, for example, in a case where another mobile body approaches from the opposite direction on a narrow straight road, or in a case where at an orthogonal narrow intersection, another mobile body suddenly comes up and simultaneously enters the intersection from the side, a situation occurs in which two mobile bodies cannot move while facing each other (also referred to as a stall).
- An object of this technology is to provide an information processing device, an information processing method, and a program, which enables efficient operation of a mobile body even when the density of the mobile bodies is increased in an environment in which a passable region of the mobile body changes.
- According to a first aspect of the present technology, there is provided an information processing device including a route map generation unit configured to, in an environment in which obstacles are present, set a boundary line formed by a group of points having an equal distance from two different obstacles among the obstacles between the obstacles in a movable region that is a region in which a mobile body is movable, and determine the number of lanes for the boundary line in accordance with a distance from each of the obstacles to the boundary line and a size of the mobile body moving in the environment.
- In the technology, in the environment in which obstacles are present, the route map generation unit performs, for example, Voronoi region division on the movable region that is a region in which a mobile body is movable, sets the boundary line formed by a group of points having an equal distance from the obstacle between the obstacles, determines the number of lanes for the boundary line in accordance with a distance from the obstacle and the size of the mobile body moving between the obstacles, and generates a route map having number-of-lanes information on the basis of the boundary line and the number of lanes determined for the boundary line. The number of lanes corresponds to the number of mobile bodies that can pass through at the same time, and the size of the mobile body is the maximum value of the mobile body width orthogonal to a moving direction, and may include a margin.
- The route map generation unit sets nodes at a branch point and an end point of the boundary line and at a change point of the number of lanes of the boundary line, and sets new one node between the nodes instead of two nodes between which a distance is shorter than a first threshold in a case where a distance between the nodes is shorter than a first threshold. Furthermore, in a case where the distance between the nodes is greater than a second threshold greater than the first threshold, the route map generation unit newly sets a node on the boundary line between the nodes, and divides an edge between the nodes into edges via the newly set node. Moreover, in a case where a maximum separation distance between the edge between the nodes and the boundary line is greater than a separation distance threshold, the route map generation unit newly sets a node on the boundary line between the nodes and divides the edge between the nodes into edges via the newly set node. The route map generation unit sets the number of lanes determined for the boundary line as number-of-lanes information of an edge corresponding to the boundary line and sets the minimum number of lanes in the edge connected to the nodes as number-of-lanes information of the node, and generates a topological map, in which the nodes are connected by the edge and which has the number-of-lanes information, as a route map. Furthermore, the route map generation unit may provide edges corresponding to the number of lanes determined for the boundary line and set nodes at opposite ends of the edges to generate, as a route map, a lane map in which the number of lanes of the node and the edge is one. The route map generation unit updates the route map according to a change of the movable region.
- Furthermore, the information processing device further includes a route planning unit that plans a route of the mobile body by using the route map having the number-of-lanes information, and the route planning unit plans a route for each mobile body such that the number of mobile bodies does not exceed the number of lanes indicated by the number-of-lanes information. Furthermore, the route map generation unit may determine the number of lanes by using a base lane width corresponding to a plurality of mobile bodies having different sizes as the size of the mobile body, and the route planning unit may plan a route by using the number of lanes having the base lane width occupied by each mobile body having a plurality of different sizes.
- According to a second aspect of the present technology, there is provided an information processing method including: in an environment in which obstacles are present, setting a boundary line formed by a group of points having an equal distance from two different obstacles among the obstacles between the obstacles in a movable region that is a region in which a mobile body is movable; and determining the number of lanes for the boundary line in accordance with a distance from each of the obstacles to the boundary line and a size of the mobile body moving in the environment.
- According to a third aspect of the present technology, there is provided a program causing a computer to generate a route map, the program causing the computer to execute:
- a procedure of, in an environment in which obstacles are present, setting a boundary line formed by a group of points having an equal distance from two different obstacles among the obstacles between the obstacles in a movable region that is a region in which a mobile body is movable;
- a procedure of determining the number of lanes for the boundary line in accordance with a distance from each of the obstacles to the boundary line and a size of the mobile body moving in the environment; and
- a procedure of generating a route map having number-of-lanes information on the basis of the boundary line and the number of lanes determined for the boundary line.
- Note that the program of the present technology is, for example, a program that can be provided, to a general-purpose computer capable of executing various program codes, by a storage medium provided in computer-readable format, a communication medium, for example, a storage medium such as an optical disk, a magnetic disk, or a semiconductor memory, or a communication medium such as a network. By providing such a program in computer-readable format, processing corresponding to the program is implemented on the computer.
-
-
Fig. 1 is a diagram illustrating a configuration of a mobile body control system. -
Fig. 2 is a diagram illustrating configurations of a mobile body and a server. -
Fig. 3 is a flowchart illustrating operation of generating a route map. -
Fig. 4 is a diagram illustrating a movable region map. -
Fig. 5 is a diagram illustrating a division result of Voronoi region division. -
Fig. 6 is a diagram illustrating a boundary line to which number-of-lanes information is assigned. -
Fig. 7 is a diagram illustrating a processing result in a case where processing 4-1 and processing 4-3 are performed. -
Fig. 8 is a diagram for explaining a case where processing 4-4 and processing 4-5 are performed on a region AR. -
Fig. 9 is a diagram illustrating a processing result in a case where processing 4-4 and processing 4-5 are performed. -
Fig. 10 is a diagram illustrating a processing result in a case where processing 4-6 and processing 4-7 are performed. -
Fig. 11 is a diagram for explaining generation of a lane map. -
Fig. 12 is a diagram illustrating a lane map. - Hereinafter, modes for carrying out the present technology will be described. Note that the description will be given in the following order.
- 1. Configuration of mobile body control system
- 2. Configurations of mobile body and server
- 3. Operations of mobile body and server
- 3-1. Regarding generation of route map
- 3-2. Regarding generation of route plan
- 3-3. Regarding modification example of generation of route map and route plan
- 3-4. Regarding use of lane map
- 4. Application example
-
Fig. 1 illustrates a configuration of a mobile body control system. A mobilebody control system 10 includes a plurality ofmobile bodies 20 and aserver 30. - In the mobile
body control system 10, a movement task performed using themobile body 20 is received by theserver 30, and theserver 30 generates a route plan for executing the movement task and provides the route plan to themobile body 20. Themobile body 20 plans a path so as to move along a route indicated by the route plan supplied from theserver 30 and executes the movement task. - The movement task is a task involving movement of the
mobile body 20 such as a robot or an automated guided vehicle (AGV), and the movement task may be performed by an arbitrary mobile body, a mobile body having a predetermined function or capability, a designated mobile body, or the like. Furthermore, the movement task may simply be to reach a certain point and perform a task (such as inspection), or may be to perform further movement to another point (such as conveyance). - The
server 30 performs task planning to determine to which mobile body the movement task input from the user or the like is assigned (or whether to change the existing assignment). In the task planning, various methods may be used without particular limitation. For example, in a case where an arbitrary mobile body is used, a method of selecting an empty mobile body closest to the destination of the movement task, a method of selecting a mobile body having the smallest number of assigned tasks in a case where there is no empty mobile body, or the like is used. - When determining the mobile body to which the movement task is assigned, the
server 30 generates a route plan on the basis of the route map at that time. The route map is expressed as, for example, a topological map including a relay node group as an intermediate destination candidate in the environment and an edge group connecting relay nodes that is directly passable. In the method using the route map, route planning for determining which relay node or edge the mobile body passes through between the current location and the final destination is initially performed, and the movement to the next node is performed in accordance with a path plan, such that the calculation amount for the path is reduced as compared with a case of calculating the path from the current location to the final destination and performing movement without using the node. A Dijkstra's algorithm or the like is often used as a route planning method. The route plan may be a method of adding a route plan of a target mobile body without changing the route plan of another mobile body, or the entire route plan may be optimized including a review of the route plan of another mobile body. - Next, configurations of the mobile body (for example, a trackless automated guided vehicle) and the server will be described.
Fig. 2 illustrates configurations of the mobile body and the server. - The
mobile body 20 includes asensor unit 21, a surroundingmap generation unit 22, a self-position estimation unit 23, acommunication unit 24, apath planning unit 25, adrive control unit 26, and adrive unit 27. - The
sensor unit 21 includes an external sensor and an internal sensor. The external sensor of thesensor unit 21 acquires information regarding the surrounding environment of the mobile body (for example, information regarding a surrounding object or the like). As the external sensor, for example, a distance measurement sensor (Light Detection and Ranging, or Laser Imaging Detection and Ranging (LIDAR) sensor, Time Of Flight (TOF), stereo camera, or the like) is used. The external sensor generates sensing data (also referred to as "distance measurement data") indicating a distance to a surrounding object and outputs the sensing data to the surroundingmap generation unit 22 and the self-position estimation unit 23. Furthermore, the internal sensor of thesensor unit 21 acquires information regarding the mobile body itself (for example, information indicating the position and orientation of the mobile body, a change thereof, and the like). As the internal sensor, for example, a position sensor, an angle sensor, an acceleration sensor, a gyro sensor, or the like is used. The internal sensor outputs the generated sensing data (also referred to as "internal sensing data") to the self-position estimation unit 23. - The surrounding
map generation unit 22 generates map information indicating an object located nearby on the basis of the distance measurement data generated by thesensor unit 21. The surroundingmap generation unit 22 outputs the generated map information to thecommunication unit 24 and thepath planning unit 25. - The self-
position estimation unit 23 estimates a self-position on the basis of the internal sensing data or internal sensing data generated by thesensor unit 21 and the distance measurement data generated by the external sensor, and outputs self-position information indicating the estimated self-position to thecommunication unit 24 and thepath planning unit 25. - The
communication unit 24 is connected to a network and performs wireless communication with theserver 30. The wireless communication may include, for example, cellular communication using any of LTE, WCDMA (registered trademark), 5G, and the like, and may include near field communication using any of Wi-Fi, Bluetooth (registered trademark), and the like. Thecommunication unit 24 performs wireless communication with theserver 30, and transmits the map information generated by the surroundingmap generation unit 22 and the self-position estimated by the self-position estimation unit 23 to theserver 30. Note that thecommunication unit 24 of themobile body 20 may transmit mobile body information indicating the size, performance, and the like of themobile body 20 to theserver 30. Thecommunication unit 24 receives information transmitted from theserver 30, for example, a route plan, and outputs the received information to thepath planning unit 25. - The
path planning unit 25 plans the path of themobile body 20 by using map information generated by the surroundingmap generation unit 22 and an estimation result of the self-position estimation unit 23 such that themobile body 20 moves along the route indicated by the route plan supplied from theserver 30. In the route plan, as will be described later, the nodes to the destination are sequentially indicated on the basis of a route map indicating a route on which the mobile body can pass and a movement task assigned to the mobile body, and thepath planning unit 25 determines a path from the current location to a first node and a path from the current node to the next node. Thepath planning unit 25 uses, for example, an A* algorithm or a rapidly-exploring random tree (RRT) algorithm as a path-search algorithm to perform recognition of the surrounding environment of themobile body 20 and a path search for the next node or the destination, and moving operation can be performed while avoiding collision even when there is a dynamic obstacle by repeating determination of an optimum moving speed, angular velocity, and the like at that time. Thepath planning unit 25 outputs the determined path to thedrive control unit 26. - The
drive control unit 26 generates a drive signal such that themobile body 20 moves on the path determined by thepath planning unit 25, and outputs the drive signal to thedrive unit 27. - The
drive unit 27 is configured by using wheels, a drive source (for example, a motor), and the like, and drives the wheels with the drive source on the basis of the drive signal from thedrive control unit 26 to move themobile body 20. - The
server 30 includes acommunication unit 31, a movable regionmap generation unit 32, a routemap generation unit 33, amap storage unit 34, a mobile bodyinformation storage unit 35, atask planning unit 36, and aroute planning unit 37. - The
communication unit 31 is configured to be capable of performing wireless communication with thecommunication unit 24 of themobile body 20. The wireless communication may include cellular communication as described above, or may include near field communication. Thecommunication unit 31 performs wireless communication with themobile body 20, and receives map information generated by themobile body 20 and self-position information indicating the estimated self-position. Thecommunication unit 31 outputs the received map information and self-position information to the movable regionmap generation unit 32. Furthermore, thecommunication unit 31 receives mobile body information and outputs the mobile body information to the mobile bodyinformation storage unit 35.
Furthermore, thecommunication unit 31 transmits the route plan generated by theroute planning unit 37 to themobile body 20. - The movable region
map generation unit 32 integrates the map information generated by eachmobile body 20 to generate a movable region map indicating a region in which themobile body 20 can pass in the entire environment. The movable regionmap generation unit 32 outputs the generated movable region map to the routemap generation unit 33. Furthermore, the movable regionmap generation unit 32 may generate the movable region map on the basis of sensing data acquired by an external sensor provided separately from the mobile body, or may acquire the movable region map generated in advance from an external device or the like. Moreover, the movable regionmap generation unit 32 updates the movable region map according to a change of the movable region. For example, the movable regionmap generation unit 32 automatically updates the movable region map when determining that a movable region in which themobile body 20 can pass has changed due to installation, movement, removal, or the like of an obstacle. - The route
map generation unit 33 generates a route map having the number-of-lanes information related to a passage and a passage width on the basis of the movable region map generated by the movable regionmap generation unit 32. Note that details of generation of the route map will be described later. Furthermore, the routemap generation unit 33 automatically updates the route map in a case where it is determined that the movable region has changed by the movable regionmap generation unit 32 and the movable region map is updated. - The
map storage unit 34 stores the route map generated by the routemap generation unit 33. Furthermore, the mobile bodyinformation storage unit 35 stores mobile body information for each mobile body. The mobile body information may be acquired by communication with themobile body 20 as described above, or the user may input the mobile body information in advance. - The
task planning unit 36 receives a movement task request made by a user or the like, and determines a mobile body that performs a movement task. Moreover, thetask planning unit 36 outputs task assignment information indicating the mobile body and the movement task assigned to the mobile body to theroute planning unit 37. - The
route planning unit 37 generates a route plan for performing the assigned movement task for each mobile body. In the generation of the route plan, a route to the destination is determined on the basis of the passage and number-of-lanes information which are indicated in the route map generated by the routemap generation unit 33, and for example, a list sequentially indicating the nodes on a moving route is generated. Furthermore, theroute planning unit 37 determines a route such that the movement efficiency of the entire system increases in a case where a movement task is performed by a plurality of the mobile bodies. Moreover, in a case where the route map is updated or in a case where new task assignment information is provided, theroute planning unit 37 performs processing of updating the route plan. For example, in a case where the number-of-lanes information of the moving route is updated, or in a case where the moving routes of the mobile body performing newly received movement task overlap, theroute planning unit 37 generates a new route plan in consideration of the updated number-of-lanes information, the route of another mobile body, and the like. Theroute planning unit 37 transmits the route plan generated for each mobile body to the correspondingmobile body 20 via thecommunication unit 31. - In an environment in which the obstacles are present, the server sets a boundary line formed by a group of points having an equal distance from obstacles between the obstacles in the movable region that is a region in which the mobile body is movable, and determines the number of lanes for the boundary line in accordance with a distance from each of the obstacles and a size of the mobile body moving between the obstacles. Furthermore, the server generates a route map having number-of-lanes information on the basis of the boundary line and the number of lanes determined for the boundary line. For example, the server sets nodes at a branch point and an end point of the boundary line and at a change point of the number of lanes of the boundary line, and automatically generates a topological map in which the nodes are connected by an edge as a route map.
- Furthermore, the server selects a mobile body that executes a movement task, sequentially assigns nodes in a traveling direction to the selected mobile body and releases the nodes through which the mobile body passes, and generates a route plan by limiting the number of mobile bodies simultaneously present in accordance with the number of lanes determined by the nodes and edges. Moreover, in a case where the route map is updated, the server generates a route plan again on the basis of the updated route map and the current location of each mobile body. The server transmits the generated route plan to the mobile body. The mobile body plans a path so as to move along a route indicated by the route plan generated by the server and executes the movement task.
- Next, generation of a route map including number-of-lanes information will be described.
Fig. 3 is a flowchart illustrating operation of generating the route map. - In Step ST1, the movable region map generation unit generates a movable region map. The movable region
map generation unit 32 integrates, for example, the map information generated by each mobile body to generate a movable region map indicating a region in which the mobile body can pass in the entire environment, and causes processing to proceed to Step ST2. Note that the movable regionmap generation unit 32 may generate the movable region map on the basis of sensing data acquired by an external sensor provided separately from the mobile body, or may acquire the movable region map from an external device or the like. Note thatFig. 4 illustrates the movable region map, and detected obstacle is indicated by a line (or dot). The obstacle refers to an object present in the environment, and includes, for example, a mobile body such as a person or an automated mobile robot in addition to a rack, a cardboard box, a desk, and a chair. Furthermore, an object that defines the environment, such as a wall or a column, is also included as the obstacle. - In Step ST2, the route map generation unit extracts a boundary line indicating a skeleton of the movable region. The route
map generation unit 33 extracts the boundary line indicating the skeleton of the movable region from the movable region map generated in Step ST1. The boundary line indicating the skeleton is extracted using, for example, a Voronoi region division method. Voronoi region division in two dimensions is a method of dividing a plane into regions on the basis of "which is the closest point" when a plurality of points is disposed in advance on the plane. The routemap generation unit 33 performs Voronoi region division on the entire movable region, extracts a boundary line, which is formed by a group of points having a feature that distances to two different obstacles are the same, as a boundary line indicating a skeleton, and causes the processing to proceed to Step ST3. Note thatFig. 5 illustrates a division result of the Voronoi region division, and is a case where the processing of Step ST2 is performed using the movable region map illustrated inFig. 4 . - In Step ST3, the route map generation unit generates number-of-lanes information. The route
map generation unit 33 generates, for the boundary line extracted in Step ST2, number-of-lanes information indicating the number of lanes corresponding to the number of mobile bodies that can pass through at the same time. For example, at each point on the boundary line indicating the skeleton, in a case where a distance W to the obstacle is smaller than a value half the size of the mobile body (hereinafter referred to as "size R"), the mobile body cannot pass through. Therefore, the routemap generation unit 33 deletes the boundary line through which the mobile body cannot pass. Note that the size of the mobile body is the maximum value of the mobile body width orthogonal to the moving direction. Furthermore, in a case where the mobile body is a trackless automatic guided vehicle (AGV) or the like, the mobile body width is a size including an article to be conveyed. Moreover, the size of the mobile body may include a margin. Note that the mobile body width including the article to be conveyed can be determined by the assigned movement task, and for example, when it is obvious what kind of article is to be conveyed with the movement task, the mobile body width can be calculated on the basis of the article to be conveyed and the shape of the mobile body. - In a case where the boundary lines are separated, the route
map generation unit 33 leaves only the boundary line having the longest total distance and deletes the remaining other boundary lines. Moreover, the routemap generation unit 33 generates the number-of-lanes information for the remaining boundary lines. For example, in a case where the distance W from the boundary line to the obstacle is equal to or greater than N times the size R and less than (N + 1) times the size R, the routemap generation unit 33 sets the number-of-lanes information on the boundary line as the number of lanes N. The routemap generation unit 33 assigns the generated number-of-lanes information to the boundary line and causes the processing to proceed to Step ST4. -
Fig. 6 illustrates a boundary line to which the number-of-lanes information is assigned, and illustrates a case where the processing of Step ST3 is performed on the division result of the Voronoi region division illustrated inFig. 5 . InFig. 6 , the boundary line indicating the passage through which the mobile body cannot pass is deleted, and in a case where the remaining boundary lines are separated, only the boundary line having the longest total distance is left and the other remaining boundary lines are deleted. Note that inFig. 6 , a boundary line having the number of lanes of "two" is indicated by a thick line, and a boundary line having the number of lanes of "one" is indicated by a thin line. - In Step ST4, the route map generation unit generates a topological map. The route
map generation unit 33 assigns nodes to the boundary line to which the number-of-lanes information is assigned, and connects the nodes by the edge to generate the topological map. The routemap generation unit 33 performs the following processing on the boundary line to which the number-of-lanes information is assigned to generate the topological map. - Processing 4-1: Nodes are set at an end point, branch point, and change point of the number of lanes of the boundary line.
- Processing 4-2: Instead of the boundary line between the nodes, an edge connecting the nodes with a straight line is set.
Fig. 7 illustrates a processing result obtained in a case where processing 4-1 and processing 4-2 are performed, and illustrates a case where the processing is performed on the boundary line having the number-of-lanes information illustrated inFig. 6 . - Processing 4-3: In a case where the distance between the nodes is shorter than a first threshold Lth1, node combination processing is performed by setting new one node between the nodes instead of two nodes between which a distance is shorter than the first threshold Lth1. Note that the first threshold Lth1 is a distance at which the difference in the moving route of the mobile body is smaller than a predetermined amount even when the two nodes are combined into one.
- Processing 4-4: In a case where the maximum separation distance between the edge between the nodes and the boundary line is greater than a separation distance threshold DSth, a node is newly set on the boundary line between the nodes and the edge between the nodes is divided into edges via the newly set node.
- Processing 4-5: In a case where an edge length is longer than a second threshold Lth2 (Lth1<Lth2), a node is newly set on the boundary line between the nodes, and an edge between the nodes is divided into edges via the newly set node. Note that the second threshold Lth2 is set to, for example, a value slightly greater than the mobile body width such that the moving route can be finely set.
-
Fig. 8 is a diagram for explaining a case where processing 4-4 and processing 4-5 are performed on a region AR illustrated inFig. 7 . Note that (a) ofFig. 8 illustrates a state before processing, and (b) ofFig. 8 illustrates a state after processing. For example, in a case where the maximum separation distance between the edge connecting a node Nd1 to a node Nd2 and the boundary line is a distance DSa and is greater than the separation distance threshold DSth, a node Nda is newly set on the boundary line between the node Nd1 and the node Nd2, and then the edge connecting the node Nd1 to the node Nd2 is divided into an edge connecting the node Nd1 to the node Nda and an edge connecting the node Nda to the node Nd2. Furthermore, in a case where the maximum separation distance between the edge connecting a node Nd4 to a node Nd5 and the boundary line is a distance DSc and is greater than the separation distance threshold DSth, a node Ndc is newly set on the boundary line between the node Nd4 and the node Nd5, and then the edge connecting the node Nd4 to the node Nd5 is divided into an edge connecting the node Nd4 to the node Ndc and an edge connecting the node Ndc to the node Nd5. - Furthermore, for example, in a case where the edge connecting a node Nd3 to the node Nd4 is longer than the second threshold Lth2, a node Ndb is newly set on the boundary line between the node Nd3 and the node Nd4, and then the edge connecting the node Nd3 to the node Nd4 is divided into an edge connecting the node Nd3 to the node Ndb and an edge connecting the node Ndb to the node Nd4. Similarly, in a case where the edge connecting a node Nd6 to a node Nd7 and the edge connecting the node Nd6 to a node Nd8 are longer than the second threshold Lth2, nodes Ndd and Nde are newly set on the boundary line between the node Nd6 and the node Nd7 and the boundary line between the node Nd6 and the node Nd8 to perform node division.
- Therefore, when processing 4-4 and processing 4-5 are performed on the processing result of
Fig. 7 , the processing result ofFig. 9 is obtained. - Processing 4-6: Number-of-lanes information of each edge is set to the number of lanes N determined for the boundary line corresponding to the edge.
- Processing 4-7: Number-of-lanes information of each node is set to the minimum number of lanes in the edge connected to the nodes.
-
Fig. 10 illustrates processing result obtained in a case where processing 4-6 and processing 4-7 are performed on the processing result illustrated inFig. 9 . - The route
map generation unit 33 performs processing from Step ST2 to Step ST4 by using the movable region map generated in Step ST1, for example, generates a topological map having the number-of-lanes information illustrated inFig. 10 , and stores the topological map in themap storage unit 34 as a route map. - Next, generation of the route plan will be described. As described above, the route map generated by the route
map generation unit 33 and stored in themap storage unit 34 is a topological map configured by the nodes and edges, and the edge length is limited to a certain distance or less. Furthermore, in the route map, number-of-lanes information indicating how many mobile bodies can exist at the same time is assigned to each node. - The
route planning unit 37 generates a route plan by using the topological map (route map) generated by the routemap generation unit 33 by the number of steps in time series. That is, one of time-series topological maps indicates a topological map at a future time, and the mobile body can move to an adjacent node connected by the edge by continuing to move during one step in time series. - In the route plan, topological maps of each time-series step are arranged in time series.
- Topological maps are connected by a new edge connecting nodes corresponding to the same position of the original topological map between the adjacent topological maps. In this case, it indicates that the mobile body waits at the same node during one time-series step.
- Topological maps are connected by a new edge connecting adjacent nodes connected by the edge of the original topological map. In this case, it indicates that the mobile body moves to the adjacent node during one time-series step.
- In this manner, by connecting the topological maps adjacent in a time direction with the edge as described above, it is possible to configure a time-series topological map formed by combining the topological maps in each time-series step.
- The
route planning unit 37 traces the nodes on the time-series topological map in a form of satisfying a restriction that the mobile body always moves to any node on the topological map of the next time-series step in one time-series step, and generates a path plan in a form that the mobile body reaches the node at a position as the destination. Furthermore, theroute planning unit 37 sets a route by limiting the number of moving bodies so as not to exceed the number of lanes indicated by the number-of-lanes information assigned to nodes and edges, and releases the nodes through which the mobile body has passed. - In a case where a route plan of a new mobile body is added, as the simplest method, for example, a node on the time-series topological map that has reached the upper limit of the number of lanes due to the route plan of another mobile body is excluded, and a route satisfying the restriction that the mobile body always moves to any node of the topological map of the next time-series step in one time-series step is selected. For example, when searching a route by using a Dijkstra's algorithm, the
route planning unit 37 limits only a route satisfying the above-described restriction as a search target. - Furthermore, as another method for adding a route plan of a new mobile body, route planning for all the mobile bodies may be collectively performed again. Specifically, a route plan is selected by full search or the like, the route plan satisfying a restriction condition that the "mobile body always moves to any node of the topological map of the next time-series step in one time-series step" and a restriction that the "mobile bodies corresponding to the number of lanes or more should not exist on a node of a certain time-series topological map". For example, the
route planning unit 37 uses a method described in the document "Optimal Multi-Robot Path Planning on Graphs: Complete Algorithms and Effective Heuristics, Jingjin Yu Steven M. LaValle, 2015". - The
route planning unit 37 transmits the generated route plan for each mobile body to the corresponding mobile body, and the mobile body performs movement control on the basis of the route plan generated by theroute planning unit 37 and completes the movement task. - As described above, when the route map having number-of-lanes information is generated, even in an environment in which the layout of the obstacle dynamically changes and the passable region of the mobile body changes, the route plan is generated on the basis of the route map having the number-of-lanes information, such that the movement task can be processed without causing a stall or the like even when many mobile bodies are used. Furthermore, not only the route map having the number-of-lanes information is generated, but also the route map is automatically updated in accordance with a change of the movable region. Therefore, it is not necessary to manually reset the route map in accordance with a change of the layout of the obstacle, and efficient operation can be easily performed at low cost.
- By the way, in a case where a plurality of mobile bodies is used, a mobile body having a different shape may be used. In this case, mobile body information of the mobile body having a different shape is stored in the mobile body
information storage unit 35, a base lane width is determined from the width of the mobile body having a different shape, and the number of lanes is calculated using the basic lane width. Moreover, in route planning, the route of the mobile body is planned on the basis of the number of lanes occupied by the mobile bodies having different shapes. In this case, the number of lanes corresponds to the number of moving bodies that can pass through at the same time, but does not always indicate the number of mobile bodies that can pass through, and the number of lanes calculated using the base lane width is used as the number for enabling calculation of the number of mobile bodies that can pass through at the same time as described later. - Next, a case where, for example, three types of mobile bodies MOa, MOb, and MOc are used in the mobile
body control system 10 will be described. The width of the mobile body MOa is a mobile body width MWa, the width of the mobile body MOb is a mobile body width MWb, and the width of the mobile body MOc is a mobile body width MWc. The margin required at the time of movement of the mobile body MOa is a width ma, the margin required at the time of movement of the mobile body MOb is a width mb, and the margin required at the time of movement of the mobile body MOc is a width mc. Note that the mobile body width is a size including the size of the article to be conveyed as described above. In this case, a width (MWa + ma) is occupied when the mobile body MOa moves. Similarly, a width (MWb + mb) is occupied when the mobile body MOb moves, and a width (MWc + mc) is occupied when the mobile body MOc moves. Therefore, a base lane width BW satisfying Equations (1), (2), and (3) is calculated. Note that the numbers of occupied lanes Ka, Kb, and Kc are natural numbers, and the widths ma, mb, and mc of the margin are values smaller than the base lane width BW. - For example, in a case where width (MWa + ma) = 40 cm, width (MWb + mb) = 60 cm, and width (MWc + mc) = 100 cm, 20 cm which is the greatest common divisor of each width is set as the base lane width BW. In this case, two lines (Ka = 2) are occupied in the movement of the mobile body MOa, three lines (Kb = 3) are occupied in the movement of the mobile body MOb, and five lines (Kc = 5) are occupied in the movement of the mobile body MOc.
- In a case where the mobile body having a different shape is used, the route
map generation unit 33 calculates the number of lanes of each node on the basis of the base lane width BW determined on the basis of the mobile body information for each mobile body, which is stored in the mobile bodyinformation storage unit 35. Specifically, in Step ST3 ofFig. 3 , the number of lanes N is calculated with a size half the base lane width BW as the size R. - In a case where the mobile body having a different shape is used, the
route planning unit 37 sets the number of occupied lanes for each mobile body and generates a route plan such that the total number of occupied lanes at each node does not exceed the number of lanes at any timing. - Specifically, as described above, the base lane width BW is 20 cm, the number of occupied lanes of the mobile body MOa is two lines (Ka = 2), the number of occupied lanes of the mobile body MOb is three lines (Kb = 3), and the number of occupied lanes of the mobile body MOc is five lines. In this case, in the node having six lanes, three mobile bodies MOa (the total number of occupied lanes = 2 × 3 lines), two mobile bodies MOb (the total number of occupied lanes = 3 × 2 lines), one mobile body MOc (the total number of occupied lanes = 1 × 5 lines), or one mobile body MOa and one mobile body MOb (the total number of occupied lanes = 2 + 3 lines) can be present. However, the mobile body MOc and the other mobile bodies MOa and MOb cannot be present at the same time (the total number of occupied lanes > 6 lines). Therefore, the
route planning unit 37 sets a route on the basis of the number of occupied lanes for each mobile body so as not to exceed the number of lanes of the node. For example, in a case where route planning for the mobile body MOb is newly performed, when the number of occupied lanes of the mobile body MOb is three lines, a route is searched while excluding nodes having two or less empty lanes, and a route plan is generated. - By the way, in the above-described embodiment, a case where the topological map in which the number-of-lanes information is assigned to the nodes and the edges is generated as the route map has been described. However, it is also possible to generate a route plan by providing the same number of edges as the number of lanes to set the nodes at opposite ends, and using the lane map in which the number of lanes of the nodes and the edges is one as the route map.
- In the generation of the lane map, the following processing is performed.
- Processing 5-1: New N nodes (hereinafter referred to as "way point (WP)") are generated in the vicinity of opposite end nodes of the edge having the number of lanes N, and the number of lanes is set to "one" by connecting the WPs with the edge.
- Processing 5-2: WPs are connected in mesh by edges (connected by edges in a round-robin manner) and the number of lanes is set to "one".
-
Fig. 11 is a diagram for explaining generation of a lane map, in which (a) ofFig. 11 illustrates a topological map in which number-of-lanes information is assigned to nodes and edges, and (b) ofFig. 11 illustrates a lane map corresponding to the topological map. When processing 5-1 and processing 5-2 are performed on the topological map in which the number-of-lanes information is assigned to the node and the edge, a lane map in which the number of lanes of the WP and the edge is "one" can be generated. -
Fig. 12 illustrates the lane map generated using the route map illustrated inFig. 10 . In the number-of-lanes information of the route map, one edge is provided for a passage in which the number of lanes is "one", and two edges are provided for a passage in which the number of lanes is "two". - The
route planning unit 37 plans a route by using the lane map in a similar manner to the case of using the route map including the number-of-lanes information. - In a case where the
route planning unit 37 generates a route plan on the basis of the route map (in a case where the lane map is not used), since a route is determined such that N or less mobile bodies can pass through a node having the number of lanes N, it is guaranteed that there is a space required for parallel running of N or less mobile bodies or for passing of N or less mobile bodies with each other. However, in actual parallel running or passing with each other, it is necessary to perform control such that contact or collision does not occur due to the path plan of the mobile body. For example, in the case of passing with each other, when the mobile body detects the presence of another mobile body while passing through the center of the passage, the mobile body needs to perform a collision avoidance operation by deceleration or a direction change, which causes a decrease in a moving speed or the like. - However, in a case of generating a route plan on the basis of the lane map, the
route planning unit 37 can designate a lane on which each mobile body passes such that parallel running or passing with each other is possible. Therefore, the mobile body is less likely to perform deceleration operation or avoidance operation so as not to cause contact or collision due to the path plan, and the moving speed is less decreased as compared with the route plan not using the lane map, and the movement task can be efficiently processed. - The technology according to the present disclosure can be applied to various fields. For example, the technology according to the present disclosure may be realized as a device mounted on any type of mobile body such as an automobile, an electric vehicle, a hybrid electric vehicle, a motorcycle, a bicycle, a personal mobility, a ship, and a robot. Furthermore, the technology according to the present disclosure may be realized as a device mounted on an equipment used in a production process in a factory, an equipment used in a construction field, or an equipment used in agriculture, forestry, or the like. When the technology according to the present disclosure is applied to such a field, work or the like can be efficiently performed using a plurality of equipments even in an environment in which a passable region of a mobile body changes according to a work situation.
- A series of processing described in the specification can be executed by hardware, software, or a combined configuration of both the software and the hardware. In a case where processing is executed by software, a program in which a processing sequence is recorded is installed and executed in a memory in a computer incorporated in dedicated hardware. Alternatively, the program can be installed and executed in a general-purpose computer capable of executing various types of processing.
- For example, the program can be recorded in advance in a hard disk, a solid state drive (SSD), or a read only memory (ROM) as a recording medium. Alternatively, the program can be temporarily or permanently stored (recorded) in a removable recording medium such as a flexible disk, a compact disc read only memory (CD-ROM), a magneto optical (MO) disk, a digital versatile disc (DVD), a Blu-ray disc (BD) (registered trademark), a magnetic disk, or a semiconductor memory card. Such a removable storage medium can be provided as so-called package software.
- Furthermore, in addition to installing the program from the removable recording medium to the computer, the program may be transferred from a download site to the computer wirelessly or by wire via a network such as a local area network (LAN) or the Internet. In the computer, the program transferred as described above can be received and installed in a recording medium such as a built-in hard disk.
- Note that the effects described in the present specification are merely examples and are not limited, and additional effects not described may be provided. Furthermore, the present technology should not be construed as being limited to the embodiment of the technology described above. The embodiment of the technology disclose the present technology in the form of exemplification, and it is obvious that those skilled in the art can make a modification and substitution of the embodiment without departing from the gist of the present technology. That is, in order to determine the gist of the present technology, the claims should be taken into consideration.
- Furthermore, the information processing device of the present technology can also have the following configurations.
- (1) An information processing device including a route map generation unit configured to, in an environment in which obstacles are present, set a boundary line formed by a group of points having an equal distance from two different obstacles among the obstacles between the obstacles in a movable region that is a region in which a mobile body is movable, and determine the number of lanes for the boundary line in accordance with a distance from each of the obstacles to the boundary line and a size of the mobile body moving in the environment.
- (2) The information processing device according to (1), in which the number of lanes corresponds to the number of mobile bodies that is capable of passing through at the same time.
- (3) The information processing device according to (1) or (2), in which the route map generation unit performs Voronoi region division on the movable region and sets the boundary line.
- (4) The information processing device according to any one of (1) to (3), in which the size of the mobile body is a maximum value of a mobile body width orthogonal to a moving direction.
- (5) The information processing device according to any one of (1) to (4), in which the size of the mobile body includes a margin.
- (6) The information processing device according to any one of (1) to (5), in which the route map generation unit generates a route map including number-of-lanes information on the basis of the boundary line and the number of lanes determined for the boundary line.
- (7) The information processing device according to any one of (1) to (6), in which the route map generation unit sets a node at a branch point and an end point of the boundary line and at a change point of the number of lanes of the boundary line, and generates a topological map in which the nodes are connected by an edge as the route map.
- (8) The information processing device according to (7), in which in a case where a distance between the nodes is shorter than a first threshold, the route map generation unit sets new one node between the nodes instead of two nodes between which a distance is shorter than the first threshold.
- (9) The information processing device according to (7) or (8), in which in a case where a maximum separation distance between the edge between the nodes and the boundary line is greater than a separation distance threshold, the route map generation unit newly sets a node on the boundary line between the nodes and divides the edge between the nodes into edges via the newly set node.
- (10) The information processing device according to (8) or (9), in which in a case where the distance between the nodes is longer than a second threshold longer than the first threshold, the route map generation unit newly sets a node on the boundary line between the nodes and divides the edge between the nodes into edges via the newly set node.
- (11) The information processing device according to any one of (7) to (10), in which the route map generation unit sets the number of lanes determined for the boundary line as number-of-lanes information of the edge corresponding to the boundary line.
- (12) The information processing device according to any one of (7) to (11), in which the route map generation unit sets the minimum number of lanes in the edge connected to the node as number-of-lanes information of the node.
- (13) The information processing device according to any one of (7) to (10), in which the route map generation unit provides the same number of edges as the number of lanes determined for the boundary line and sets nodes at opposite ends of the edge to generate, as the route map, a lane map in which the number of lanes of the node and the edge is one.
- (14) The information processing device according to any one of (6) to (13), in which the route map generation unit updates the route map in accordance with a change of the movable region.
- (15) The information processing device according to any one of (6) to (14), further including a route planning unit configured to plan a route of the mobile body by using the route map including the number-of-lanes information.
- (16) The information processing device according to (15), in which the route planning unit plans a route for each mobile body such that the number of mobile bodies does not exceed the number of lanes indicated by the number-of-lanes information.
- (17) The information processing device according to (15) or (16), in which the route map generation unit determines the number of lanes by using a base lane width corresponding to the mobile bodies having a plurality of different sizes as the size of the mobile body, and
the route planning unit plans the route by using the number of lanes having the base lane width occupied by each mobile body having a plurality of the different sizes. -
- 10
- Mobile body control system
- 20
- Mobile body
- 21
- Sensor unit
- 22
- Surrounding map generation unit
- 23
- Self-position estimation unit
- 24, 31
- Communication unit
- 25
- Path planning unit
- 26
- Drive control unit
- 27
- Drive unit
- 30
- Server
- 32
- Movable region map generation unit
- 33
- Route map generation unit
- 34
- Map storage unit
- 35
- Mobile body information storage unit
- 36
- Task planning unit
- 37
- Route planning unit
Claims (20)
- An information processing device comprising
a route map generation unit configured to, in an environment in which obstacles are present, set a boundary line formed by a group of points having an equal distance from two different obstacles among the obstacles between the obstacles in a movable region that is a region in which a mobile body is movable, and determine the number of lanes for the boundary line in accordance with a distance from each of the obstacles to the boundary line and a size of the mobile body moving in the environment. - The information processing device according to claim 1, wherein
the number of lanes corresponds to the number of mobile bodies that is capable of passing through at the same time. - The information processing device according to claim 1, wherein
the route map generation unit performs Voronoi region division on the movable region and sets the boundary line. - The information processing device according to claim 1, wherein
the size of the mobile body is a maximum value of a mobile body width orthogonal to a moving direction. - The information processing device according to claim 1, wherein
the size of the mobile body includes a margin. - The information processing device according to claim 1, wherein
the route map generation unit generates a route map including number-of-lanes information on a basis of the boundary line and the number of lanes determined for the boundary line. - The information processing device according to claim 1, wherein
the route map generation unit sets a node at a branch point and an end point of the boundary line and at a change point of the number of lanes of the boundary line, and generates a topological map in which the nodes are connected by an edge as the route map. - The information processing device according to claim 7, wherein
in a case where a distance between the nodes is shorter than a first threshold, the route map generation unit sets new one node between the nodes instead of two nodes between which a distance is shorter than the first threshold. - The information processing device according to claim 7, wherein
in a case where a maximum separation distance between the edge between the nodes and the boundary line is greater than a separation distance threshold, the route map generation unit newly sets a node on the boundary line between the nodes and divides the edge between the nodes into edges via the newly set node. - The information processing device according to claim 8, wherein
in a case where a distance between the nodes is longer than a second threshold longer than the first threshold, the route map generation unit newly sets a node on the boundary line between the nodes and divides the edge between the nodes into edges via the newly set node. - The information processing device according to claim 7, wherein
the route map generation unit sets the number of lanes determined for the boundary line as number-of-lanes information of the edge corresponding to the boundary line. - The information processing device according to claim 7, wherein
the route map generation unit sets the minimum number of lanes in the edge connected to the node as number-of-lanes information of the node. - The information processing device according to claim 7, wherein
the route map generation unit provides the same number of edges as the number of lanes determined for the boundary line and sets nodes at opposite ends of the edge to generate, as the route map, a lane map in which the number of lanes of the node and the edge is one. - The information processing device according to claim 6, wherein
the route map generation unit updates the route map in accordance with a change of the movable region. - The information processing device according to claim 6, further comprising
a route planning unit configured to plan a route of the mobile body by using the route map including the number-of-lanes information. - The information processing device according to claim 15, wherein
the route planning unit plans a route for each mobile body such that the number of mobile bodies does not exceed the number of lanes indicated by the number-of-lanes information. - The information processing device according to claim 15, whereinthe route map generation unit determines the number of lanes by using a base lane width corresponding to the mobile bodies having a plurality of different sizes as the size of the mobile body, andthe route planning unit plans the route by using the number of lanes having the base lane width occupied by each mobile body having a plurality of the different sizes.
- An information processing method comprising:in an environment in which obstacles are present, setting a boundary line formed by a group of points having an equal distance from two different obstacles among the obstacles between the obstacles in a movable region that is a region in which a mobile body is movable; anddetermining the number of lanes for the boundary line in accordance with a distance from each of the obstacles to the boundary line and a size of the mobile body moving in the environment.
- The information processing method according to claim 18, further comprising
generating a route map including number-of-lanes information on a basis of the determined number of lanes. - A program causing a computer to generate a route map, the program causing the computer to execute:a procedure of, in an environment in which obstacles are present, setting a boundary line formed by a group of points having an equal distance from two different obstacles among the obstacles between the obstacles in a movable region that is a region in which a mobile body is movable;a procedure of determining the number of lanes for the boundary line in accordance with a distance from each of the obstacles to the boundary line and a size of the mobile body moving in the environment; anda procedure of generating a route map having number-of-lanes information on a basis of the boundary line and the number of lanes determined for the boundary line.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020121176A JP2022018224A (en) | 2020-07-15 | 2020-07-15 | Information processing device, information processing method, and program |
PCT/JP2021/021522 WO2022014200A1 (en) | 2020-07-15 | 2021-06-07 | Information processing device, information processing method, and program |
Publications (2)
Publication Number | Publication Date |
---|---|
EP4184273A1 true EP4184273A1 (en) | 2023-05-24 |
EP4184273A4 EP4184273A4 (en) | 2024-01-10 |
Family
ID=79555131
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
EP21842186.5A Pending EP4184273A4 (en) | 2020-07-15 | 2021-06-07 | Information processing device, information processing method, and program |
Country Status (5)
Country | Link |
---|---|
US (1) | US20230280164A1 (en) |
EP (1) | EP4184273A4 (en) |
JP (1) | JP2022018224A (en) |
CN (1) | CN115968457A (en) |
WO (1) | WO2022014200A1 (en) |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20090077547A (en) * | 2008-01-11 | 2009-07-15 | 삼성전자주식회사 | Method and apparatus of path planning for a mobile robot |
EP2245858B1 (en) | 2008-02-13 | 2018-04-11 | Seegrid Corporation | Distributed multi-robot system |
JP6498542B2 (en) * | 2015-06-17 | 2019-04-10 | 日立建機株式会社 | Control control system and in-vehicle terminal device |
CN110554688B (en) * | 2018-05-30 | 2024-01-16 | 北京京东乾石科技有限公司 | Method and device for generating topological map |
JP2020004342A (en) * | 2018-07-02 | 2020-01-09 | 株式会社Soken | Mobile body controller |
CN110060470A (en) * | 2019-03-27 | 2019-07-26 | 江苏大学 | A kind of RSU coverage area division methods based on section connected probability |
-
2020
- 2020-07-15 JP JP2020121176A patent/JP2022018224A/en active Pending
-
2021
- 2021-06-07 CN CN202180048230.3A patent/CN115968457A/en active Pending
- 2021-06-07 WO PCT/JP2021/021522 patent/WO2022014200A1/en unknown
- 2021-06-07 EP EP21842186.5A patent/EP4184273A4/en active Pending
- 2021-06-07 US US18/004,395 patent/US20230280164A1/en active Pending
Also Published As
Publication number | Publication date |
---|---|
EP4184273A4 (en) | 2024-01-10 |
JP2022018224A (en) | 2022-01-27 |
WO2022014200A1 (en) | 2022-01-20 |
CN115968457A (en) | 2023-04-14 |
US20230280164A1 (en) | 2023-09-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11585935B2 (en) | Low quality pose lane associator | |
KR102211299B1 (en) | Systems and methods for accelerated curve projection | |
CN107436148B (en) | Robot navigation method and device based on multiple maps | |
US11255679B2 (en) | Global and local navigation for self-driving | |
JP6664813B2 (en) | Driving support device and driving support method | |
WO2017144350A1 (en) | Method for motion planning for autonomous moving objects | |
US11621025B1 (en) | Map creation from hybrid data | |
US11529951B2 (en) | Safety system, automated driving system, and methods thereof | |
CN113867347A (en) | Robot path planning method, device, management system and computer storage medium | |
WO2021157194A1 (en) | Course planning device, course planning method, and course planning program | |
US20230273621A1 (en) | Information processing apparatus, information processing method, and program | |
EP4184273A1 (en) | Information processing device, information processing method, and program | |
US11782446B2 (en) | Route planning apparatus, route planning method, and computer-readable recording medium | |
US20220041165A1 (en) | Information processing device, information processing method, computer program product, information processing system, and vehicle control system | |
US11783178B2 (en) | Systems and methods for corridor intent prediction | |
CN113885507A (en) | Obstacle determination method and device | |
JP2022121839A (en) | Route guidance program and route guide device | |
US11798411B2 (en) | Systems and methods for transforming high-definition geographical map data into messages for vehicle communications | |
JP6951672B2 (en) | Road travel speed estimation device and road travel speed estimation program | |
US11999344B2 (en) | System and method for selecting an intermediate parking goal in autonomous delivery | |
US20230264687A1 (en) | System and method for selecting an intermediate parking goal in autonomous delivery | |
US20230092531A1 (en) | Mobile object control apparatus, mobile object control method, and computer-readable recording medium | |
US20230399026A1 (en) | State Identification For Road Actors With Uncertain Measurements Based On Compliant Priors | |
JP2024024555A (en) | Collision condition providing device, method, program, and path generation device | |
CN112055859A (en) | Method, computer-readable medium, system and vehicle for determining support points for estimating a course of a lane edge structure |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE INTERNATIONAL PUBLICATION HAS BEEN MADE |
|
PUAI | Public reference made under article 153(3) epc to a published international application that has entered the european phase |
Free format text: ORIGINAL CODE: 0009012 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: REQUEST FOR EXAMINATION WAS MADE |
|
17P | Request for examination filed |
Effective date: 20230203 |
|
AK | Designated contracting states |
Kind code of ref document: A1 Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MK MT NL NO PL PT RO RS SE SI SK SM TR |
|
DAV | Request for validation of the european patent (deleted) | ||
DAX | Request for extension of the european patent (deleted) | ||
A4 | Supplementary search report drawn up and despatched |
Effective date: 20231211 |
|
RIC1 | Information provided on ipc code assigned before grant |
Ipc: G01C 21/34 20060101ALI20231205BHEP Ipc: G09B 29/10 20060101ALI20231205BHEP Ipc: G09B 29/00 20060101ALI20231205BHEP Ipc: G05D 1/02 20200101AFI20231205BHEP |