EP4184273A1 - Information processing device, information processing method, and program - Google Patents

Information processing device, information processing method, and program Download PDF

Info

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
Application number
EP21842186.5A
Other languages
German (de)
French (fr)
Other versions
EP4184273A4 (en
Inventor
Norifumi Kikkawa
Daisuke Fukunaga
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Sony Group Corp
Original Assignee
Sony Group Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Sony Group Corp filed Critical Sony Group Corp
Publication of EP4184273A1 publication Critical patent/EP4184273A1/en
Publication of EP4184273A4 publication Critical patent/EP4184273A4/en
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • G01C21/206Instruments for performing navigational calculations specially adapted for indoor navigation
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0287Control 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/0291Fleet control
    • G05D1/0297Fleet control by controlling means in a control room
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/38Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3804Creation or updating of map data
    • G01C21/3807Creation or updating of map data characterised by the type of data
    • G01C21/383Indoor data
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control 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
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/0274Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments 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

In an environment in which obstacles are present, a route map generation unit 33 sets a boundary line formed by a group of points having an equal distance from the obstacles between the obstacles in a movable region that is a region in which a mobile body is movable, determines the number of lanes for a boundary line in accordance with a distance from each of the obstacles and a size of the mobile body moving between the obstacles, and generates a route map having number-of-lanes information. Furthermore, the route map generation unit 33 updates the route map according to a change of the movable region. A route planning unit 37 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 on the basis of the route map. A mobile body 20 executes a movement task on the basis of a route plan generated by the route planning unit 37. A plurality of the mobile bodies can be efficiently operated even in an environment in which a passable region of the mobile body changes.

Description

    TECHNICAL FIELD
  • 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.
  • BACKGROUND ART
  • 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.
  • CITATION LIST PATENT DOCUMENT
  • Patent Document 1: WO 2009/102970 A
  • SUMMARY OF THE INVENTION PROBLEMS TO BE SOLVED BY THE INVENTION
  • 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.
  • SOLUTIONS TO PROBLEMS
  • 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.
  • BRIEF DESCRIPTION OF DRAWINGS
    • 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.
    MODE FOR CARRYING OUT THE INVENTION
  • 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
    <1. Configuration of Mobile Body Control System>
  • 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.
  • In the mobile body control system 10, 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).
  • 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.
  • <2. Configurations of Mobile Body and Server>
  • 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 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). 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 surrounding map generation unit 22 and the self-position estimation unit 23. Furthermore, 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). 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 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. Note that 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. 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 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.
  • 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. Furthermore, the communication unit 31 receives mobile body information and outputs the mobile body information to the mobile body information storage unit 35.
    Furthermore, 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. Furthermore, 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. Moreover, 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. 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 route map generation unit 33, and for example, a list sequentially indicating the nodes on a moving route is generated. Furthermore, 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. Moreover, in a case where the route map is updated or in a case where new task assignment information is provided, the route 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, 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.
  • <3. Operations of Mobile body and Server>
  • 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.
  • <3-1. Regarding Generation of Route Map>
  • 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 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. Note that 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.
  • 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 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. Note that 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.
  • 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. 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 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. In Fig. 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 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.
  • 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 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.
    • 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 in Fig. 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 in Fig. 7. Note that (a) of Fig. 8 illustrates a state before processing, and (b) of Fig. 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 of Fig. 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 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.
  • <3-2. Regarding Generation of Route Plan>
  • 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 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.
  • 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, 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.
  • 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 the route 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.
  • <3-3. Regarding Modification Example of Generation of Route Map and Route Plan>
  • 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. MWa + ma = Ka × BW
    Figure imgb0001
    MWb + mb = Kb × BW
    Figure imgb0002
    MWc + mc = Kc × BW
    Figure imgb0003
  • 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 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.
  • 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.
  • <3-4. Regarding Use of Lane Map>
  • 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) 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. 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 in Fig. 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.
  • <4. Application Example>
  • 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. (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. (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. (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. (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. (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. (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. (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. (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. (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. (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. (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. (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. (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. (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. (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. (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. (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.
    REFERENCE SIGNS LIST
  • 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)

  1. 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.
  2. 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.
  3. 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.
  4. 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.
  5. The information processing device according to claim 1, wherein
    the size of the mobile body includes a margin.
  6. 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.
  7. 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.
  8. 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.
  9. 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.
  10. 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.
  11. 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.
  12. 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.
  13. 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.
  14. 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.
  15. 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.
  16. 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.
  17. The information processing device according to claim 15, wherein
    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.
  18. 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; 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.
  19. 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.
  20. 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 a basis of the boundary line and the number of lanes determined for the boundary line.
EP21842186.5A 2020-07-15 2021-06-07 Information processing device, information processing method, and program Pending EP4184273A4 (en)

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)

* Cited by examiner, † Cited by third party
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

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