Mobility control assistance device and method
By creating a common travel route and rules for multiple automated systems with different control rules, the system efficiently coordinates their movements, ensuring safety and productivity in shared areas.
Patent Information
- Application Number
- JP2020197027
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2020-11-27
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2040-11-27
AI Technical Summary
Existing systems struggle to efficiently coordinate and integrate multiple automated systems with different rule-based control systems, leading to safety risks and reduced productivity when they operate in the same area, as they do not share common rules or predict each other's behavior accurately.
A system that creates a common travel route and rules for multiple moving objects by estimating their tasks, generating individual rules, and identifying superimposition situations to minimize rule changes, using environmental sensors and computers to manage and coordinate the movement of objects across different systems.
This approach allows for efficient movement of multiple objects while maintaining safety and reducing the need for conservative actions, thereby enhancing productivity by predicting and coordinating the behavior of different systems.
Smart Images

Figure 0007590168000001 
Figure 0007590168000002 
Figure 0007590168000003
Abstract
Description
[Technical field]
[0001] The present invention relates to a technique for controlling the movement of multiple moving objects under different rule-based control systems. That is, the present invention relates to the control of moving objects in multiple systems. In particular, the present invention relates to a technique for supporting the control of moving objects. [Background technology]
[0002] In recent years, there has been active development of automation systems that automate human tasks to reduce manpower and increase efficiency, and many automation systems are expected to be implemented in society in the future. Automation systems control moving objects to perform their tasks. Among these automation systems, autonomous driving of automobiles, industrial vehicles, construction machinery, etc., automates tasks that involve movement, so it is expected that the implementation environment will be wide-ranging and that they will be operated under conditions where multiple automation systems coexist in the same space.
[0003] Here, each automated system has a different purpose and performs a different task, and there is a possibility that the systems are not sufficiently coordinated or that it is difficult to coordinate them. For example, if we assume a scene in which repair work is being carried out on a part of a road, the construction machines performing the work are under the control of an automated construction system, and the work is carried out automatically by planning its actions based on the rules set by the automated construction system. In parallel, an automated vehicle is running on the road, and the automated driving system runs near the work area on the road without knowing the rules or control characteristics of the automated construction system.
[0004] In this case, the automated construction system and the automated driving system share the construction area on the road and its surrounding areas. In the shared area, both systems can recognize each other's presence using object detection technology, but they do not know what purpose each system is performing or what actions it is performing. For this reason, from a safety standpoint, they are forced to take very conservative actions, such as slowing down drastically, and in terms of productivity (e.g., performing tasks efficiently), this may result in less effectiveness than human work.
[0005] Here, if the automated system is small, not complicated, and limited in a limited space, it may be possible to obtain maximum efficiency without compromising safety by integrating multiple systems into one in advance. However, as many automated systems are implemented over a wide area, single integration of the systems is virtually impossible. In such a social background, it becomes important to have a mechanism that mediates between multiple automated systems that have mobility as their basic task and are under different rule-based control systems, and allows each system to coexist while respecting each other. In particular, automated systems such as automobiles and industrial vehicles, whose basic task is mobility, are not easy to integrate and have high safety risks, so there is a high need for cooperation between systems. Even if the automated system is small and not complicated, there are cases where integration is difficult or cooperation between systems is highly necessary.
[0006] In addition, an automated system whose basic task is movement plans a movement route from the current location to the goal location that is the purpose of the task, and is controlled to move along the route. When planning a route, the route may be set in consideration of environmental conditions according to the rules of each system. The rules include, for example, several intermediate points that are candidates for the route, places where driving is allowed or prohibited, and conditions under which driving is allowed or prohibited. In addition, multiple automated systems moving in the same area based on different rules is like laying different virtual roads in the same area and driving. In this case, as mentioned above, conservative control design is made to reduce safety risks, which may be a factor in reducing productivity. For this reason, in a common area where multiple automated systems whose basic task is movement coexist, it is important as a first step to have common rules between the systems, that is, a common virtual route map.
[0007] Patent Document 1 relates to a mobile object movement control system that can smoothly control the movement of multiple mobile objects without performing a huge amount of calculations. That is, Patent Document 1 discloses that the positions of the mobile objects are grasped by cameras installed in the environment, a travel route to the destination is set, and a regulating passage is arranged to regulate the travel order and direction in order to ensure smooth travel. [Prior art documents] [Patent documents]
[0008] [Patent Document 1] International Publication No. 2002 / 023297 Summary of the Invention [Problem to be solved by the invention]
[0009] The mobile object control system in Patent Document 1 allows multiple mobile robots to move simultaneously within one area, and places regulated passages to prevent the mobile robots from colliding with each other. However, these mobile robots are in a single system, and are not placed under different rule-based control systems, and their actions are not planned based on different rules.
[0010] For this reason, in Patent Document 1, when creating a virtual route map that serves as a common rule for multiple moving objects whose actions are planned based on different rules, the following problem exists. In Patent Document 1, it is necessary to respect the rules of each system as much as possible and to minimize changes in planned actions due to rule changes for all systems. This is because in an area outside the common area where only a single system acts, the rules of that system are applied as is, and it is undesirable for actions to change significantly inside and outside the common area.
[0011] As described above, it is difficult to control the moving objects to function in different systems in Patent Document 1. For example, it is difficult to maintain or improve safety and productivity by controlling the moving objects. [Means for solving the problem]
[0012] In order to solve the above problems, the present invention creates rules regarding the movement of moving objects in a common area where moving objects in a plurality of systems coexist, where the rules include a common movement route, which is the route of the moving objects.
[0013] More specifically, in a mobile control assistance device that assists in control of the movement of a mobile object in a common area where mobile objects of a plurality of systems coexist, based on the movement positions of each of the mobile objects, The task is defined by task information including a start position, an arrival position, and a movement history between the start position and the arrival position of the moving object. The method includes a mobile object task estimation unit that estimates a mobile object task in the mobile object, an individual rule generation unit that generates, for each of the mobile object tasks, an individual rule for realizing the mobile object task, and a common area rule creation unit that identifies an overlapping state of the individual rules in the common area and creates a common area rule regarding the movement of the mobile object in the common area using each of the individual rules in accordance with the overlapping state. The individual rule generating unit generates an individual route that minimizes the amount of change in the movement history. This is a mobility control assistance device.
[0014] One aspect of the present invention includes a mobility control assistance method using a mobility control assistance device. This method also includes a processing method in the mobility control assistance device. Furthermore, a computer program for causing the mobility control assistance device to function as a computer and a storage medium storing this program are also included in one aspect of the present invention. Effect of the Invention
[0015] According to the present invention, it is possible to efficiently move a common area while maintaining safety and suppressing the extent to which the rules of a plurality of moving objects under different rule-based control systems are changed. [Brief description of the drawings]
[0016] [Figure 1] Overall diagram of the control system in the first embodiment [Diagram 2] Functional configuration diagram of a mobile system in the first embodiment [Diagram 3] FIG. 1 shows the concept of rules and common travel routes in multiple systems in the first embodiment. [Figure 4] A functional block diagram showing the functions of an environmental sensor and a computer in each embodiment. [Diagram 5] FIG. 1 is a diagram showing a mobile task in the first embodiment. [Figure 6] A flowchart illustrating a process for recording a mobile task in accordance with various embodiments. [Figure 7] A flowchart showing a common movement path creation process in each embodiment. [Figure 8] FIG. 1 is a diagram for explaining the effects of the first embodiment. [Figure 9] FIG. 13 is a diagram showing a mobile task in the second embodiment. [Figure 10] Overall diagram of the control system in the third embodiment [Figure 11] FIG. 13 is a diagram showing the concept of rules and common travel routes in multiple systems in the third embodiment. [Figure 12] Hardware configuration diagram of the control system in each embodiment DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0017] Hereinafter, the embodiments of the present invention (Examples 1 to 3) will be described with reference to the drawings. The following description shows specific examples of the contents of the present invention, and the present invention is not limited to these descriptions. Various changes and modifications are possible by those skilled in the art within the scope of the technical ideas disclosed in this specification. In addition, in all the drawings for explaining the present invention, the same reference numerals are used to indicate parts having the same functions, and repeated explanations may be omitted.
[0018] In addition, the term "mobile body" in this specification may refer to any body that has the function of moving. This movement may be performed autonomously by the mobile body, or may be controlled by a system. Furthermore, the movement of the mobile body may utilize hybrid control, or both autonomous control and control from the system. Thus, in each embodiment, all mobile bodies do not need to be under the control of a control system. EXAMPLES
[0019] First, a control system for multiple moving objects according to a first embodiment will be described with reference to FIGS.
[0020] 1 is an overall diagram showing the configuration of a control system for multiple moving objects in this embodiment. This control system includes one or more environmental sensors 3, a network 4, and one or more computers 5. The environmental sensors 3 and the computers 5 are connected to each other via the network 4 so as to be able to communicate with each other.
[0021] Furthermore, there are a plurality of moving bodies 1 as objects to be controlled by this control system, and a common area 2 as an object area. The moving bodies 1 can be subdivided into, for example, an unmanned machine 1a equipped with an autonomous moving function and moving unmanned, a manned machine 1b operated by a human and moving, and a worker 1c. In this embodiment, an environment is assumed in which two different systems (a truck loading and unloading system A and a warehouse management system system B) both execute moving body tasks within the common area 2. In other words, moving bodies of different systems are mixed within the common area 2. In this embodiment, system A is a truck loading and unloading system A that controls an unmanned machine 1a, and unloads cargo from a truck unmannedly and moves it to a temporary storage area.
[0022] System B is a warehouse management system B that controls manned machines 1b and workers 1c, where the workers inspect the luggage placed in the temporary storage area and the manned machines transport the inspected luggage to the warehouse. Either or both of truck loading / unloading system A and warehouse management system B are referred to as mobile systems. The entire common area 2 is the temporary storage area. Furthermore, the unmanned machines 1a and manned machines 1b include cargo handling vehicles such as so-called forklifts as shown in the figure.
[0023] Next, Fig. 2 is a functional configuration diagram of the mobile body system in this embodiment. The truck loading / unloading system A mainly consists of a management server 601, one or more unmanned machines 1a, and trucks (not shown). In the truck loading / unloading system A, the management server 601 manages the operation of the trucks and the mobile bodies which are the tasks of the unmanned machine 1a. More specifically, first, when the truck arrives at a truck berth near the temporary storage area, the management server 601 issues a mobile body task to the unmanned machine 1a.
[0024] The mobile task is, for example, information on the truck's position and cargo, and information instructing the unloading location in the temporary storage area and the global movement route between them. When the unmanned machine 1a receives its own mobile task, it first moves to the starting position where the mobile task begins (hereinafter, the start point (truck position). Next, the unmanned machine 1a picks up the cargo and moves along the global movement route indicated by the mobile task to the arrival position where the mobile task is completed (hereinafter, the goal point (unloading location)). The unmanned machine 1a then unloads the cargo at the temporary storage area. Note that the global movement route can be any name as long as it is information for controlling movement within the common area 2.
[0025] At this time, the unmanned machine 1a observes surrounding obstacles and other moving objects using one or more sensors 101 mounted on the unmanned machine 1a, and plans a local movement path in a path planning unit 102 so as not to collide with the obstacles or moving objects. Then, the unmanned machine 1a controls an actuator (not shown) using a path following controller 103 so as to follow the local movement path.
[0026] Here, the difference between the global movement path and the local movement path is that the global movement path planned by the management server 601 is an ideal path that does not take into account the positions of obstacles and moving objects, while the local movement path is a path that has been adjusted to further avoid surrounding obstacles and moving objects relative to the global movement path. In this way, the truck loading / unloading system A autonomously moves the truck's cargo to a temporary storage area by the management server 601 and the unmanned machine 1a. As described above, in this embodiment, Although the truck loading / unloading system A manages truck operation independently of the warehouse, this embodiment relates to the common area 2 of the multiple systems. In other words, the operation of trucks is not directly related to this embodiment, so illustrations and explanations are omitted.
[0027] The warehouse management system B mainly includes a management server 602, one or more manned machines 1b, and one or more workers 1c. The management server 602 gives instructions (guidance) on tasks to the operators of the manned machines 1b and the workers 1c, thereby efficiently transporting the goods from the temporary storage area to the warehouse.
[0028] The manned machine 1b is equipped with a monitor 104, which displays instructions for the mobile task (location of the baggage to be transported, the destination location in the warehouse, and the global movement route between them) from the management server 602. The operator of the manned machine 1b executes the mobile task according to the mobile task instructions displayed on the monitor 104. Specifically, the operator performs the mobile task by moving from the current location to the start point (location of the baggage), lifting the baggage, moving from the start point to the goal point (destination of the baggage), and unloading the baggage. Then, when a series of mobile tasks are completed, the operator repeats the work according to the instructions for the next mobile task.
[0029] The worker 1c holds the worker terminal 105, and is presented with instructions for the mobile task (the location of the baggage to be inspected and the global movement route there) from the management server 602. The worker 1c moves from the current location to the goal point (location of the baggage) according to the mobile task instructions displayed on the worker terminal 105, and inspects the baggage. Then, when the worker 1c completes his own mobile task, he repeats the work according to the next mobile task instructions. The operator of the manned machine 1b and the worker 1c visually observe the positions of obstacles and other mobile bodies when moving, and move in a way that avoids collisions. Thus, in this embodiment, a person (worker 1c) is also included in the controlled object.
[0030] 2, each of the mobile systems is connected to a computer 5 via a network 4. The computer 5 will be described later.
[0031] In this embodiment, it is assumed that the truck loading / unloading system A and the warehouse management system B are independent systems, and there is no close information sharing or system cooperation between them. However, when the unmanned machine 1a measures the position of the manned machine 1b or the worker 1c with the sensor 101, or when the operator of the manned machine 1b or the worker 1c visually captures the position of the unmanned machine 1a, it is considered that the unmanned machine 1a has acquired information from the other system. In such an environment, when two systems execute mobile tasks in parallel in the common area 2, for example, the unmanned machine 1a must act so as not to collide with the manned machine 1b or the worker 1c.
[0032] However, even if the current location of the manned machine 1b and the worker 1c can be observed, it is not easy to know where they will move next, so local movement route planning must be done assuming that they will move in all directions. This means that the time to complete the moving object task is extended by slowing down the movement or making a large detour to avoid the moving object, and work efficiency is reduced.
[0033] Here, it is difficult for the manned machine 1b and the worker 1c to predict how the unmanned machine 1a will operate. For this reason, when the unmanned machine 1a is nearby, the manned machine 1b and the worker 1c must continuously observe its behavior and take safety-conscious actions such as slowing down, stopping, and avoiding it, which reduces work efficiency. In this way, in an environment where multiple systems coexist, that is, in an environment such as the common area 2, if the behavior of each system cannot be predicted, safety risks increase, and they are forced to sacrifice work efficiency in order to reduce the risk to an acceptable level.
[0034] Therefore, each system acts according to its own rules (system settings and agreements), but if the rules are not shared between systems, operational issues such as collisions and abnormal close encounters of moving objects will occur. The concept of rules and common movement routes for multiple systems will be explained using Figure 3.
[0035] First, as a premise, each of Fig. 3(a) to (c) shows the common area 2 in the first embodiment. Each common area 2 is divided into a lattice (matrix) by a grid. Fig. 3(a) shows that the basic movement rule of the truck loading / unloading system A is to move counterclockwise around the temporary storage area. Also, Fig. 3(a) shows that the basic movement rule of the warehouse management system B is to move to the destination via the shortest route.
[0036] At this time, a part of the movement route that the warehouse management system B can take (route 702 in FIG. 3(b)) overlaps with the movement route of the truck loading / unloading system A (route 701 in FIG. 3(a)). In other words, parts of the grids overlap. And the movement directions of each moving body are opposite to each other. For this reason, in order to avoid a head-on collision, one or both moving bodies need to take measures such as slowing down, stopping, or detouring, which extends the completion time of the moving body task. Therefore, in this embodiment, a common movement route that serves as a common rule is created for multiple moving bodies under the management of different rule-based systems. This allows each system to act according to the common movement route, making it easier to predict the behavior of moving bodies in other systems, shortening the completion time of moving body tasks while maintaining safety, and preventing a decrease in work efficiency.
[0037] Here, the common movement path shown in FIG. 3(c) is an example of a common movement path for the truck loading / unloading system A and the warehouse management system B in this embodiment. For example, this common movement path focuses on the warehouse management system B, and identifies grids that overlap with the route of the truck loading / unloading system A. Then, the route of the warehouse management system B on the grid where the overlapping number is equal to or less than a certain number (for example, no overlapping) is deleted. Then, the route of the truck loading / unloading system A and the route that complements the mobile body task realized by the deleted route of the warehouse management system B are added to create the common movement path shown in FIG. 3(C). Details of this procedure will be explained later. In this embodiment, the processing is performed in units of a lattice-shaped grid, but other position information such as latitude and longitude information may be used. The reason for using grids is that it is possible to simplify calculations in processing and reduce labor.
[0038] Next, the configuration of each device of the control system in this embodiment and embodiments 2 and 3 will be described with reference to Fig. 4 and Fig. 12. In each embodiment, this configuration is used to create a common movement path for smooth and efficient movement without compromising safety when multiple moving bodies under different rule-based control systems (under system management) move through a common area. Also, in each embodiment, control or guidance is performed so that each system behaves according to the created common movement path.
[0039] First, Fig. 4 is a functional block diagram showing the functions of the environmental sensor 3 and the computer 5 in each embodiment. The functions of each device shown in Fig. 4 are roughly divided into functions executed by the environmental sensor 3 and functions executed by the computer 5. The environmental sensor 3 has a mobile object position measuring unit 301 that measures the position of the mobile object 1, measures the position of the mobile object, and transmits the result to the computer 5 via the network 4.
[0040] The computer 5 has a mobile object task estimation unit 501, a mobile object task recording unit 502, an optimal route generation unit 503, and a common moving route creation unit 504. First, the computer 5 receives a measurement result of the mobile object position from the environmental sensor 3. Then, the mobile object task estimation unit 501 estimates a mobile object task of the mobile object from the received time-series mobile object position information. Note that, as described later, the mobile object task estimation unit 501 may estimate a mobile object task based on the mobile object position information held by the management servers 601 and 602 instead of the measurement result of the environmental sensor 3.
[0041] Moreover, the mobile object task recording unit 502 records the estimated mobile object tasks in the auxiliary storage device 54 described later. Then, the optimal route generating unit 503 generates an optimal route for each mobile object by using task information included in the recorded mobile object tasks.
[0042] In addition, a common movement route creation unit 504 creates a common movement route based on a plurality of optimal routes. Here, the common movement route created by the computer 5 is sent to the management servers (601, 602) of each system and is used for planning a global movement route.
[0043] Next, a hardware configuration diagram of the control system in each embodiment is shown in Fig. 12. As shown in Fig. 1 and Fig. 2, this control system includes an unmanned machine 1a, a manned machine 1b, an environmental sensor 3, a network 4, and a management server 601 and a management server 602. Here, Fig. 12 shows an operator terminal 105 held by an operator 1c as the hardware configuration.
[0044] These devices are connected via a network 4. Here, the unmanned machine 1a and the worker terminal 105 are connected to the network 4 wirelessly, and the others are connected by wire. Note that this is just an example, and each device may be connected to the network 4 regardless of whether it is wired or wireless. Also, while FIG. 12 shows one each of the unmanned machine 1a, the manned machine 1b, the environmental sensor 3, and the worker terminal 105, there may be multiple of each.
[0045] Here, the computer 5 is configured to perform the main processing in each embodiment, and functions as a movement control support device for multiple moving objects. The computer 5 is realized as a so-called server, cloud, etc. For this reason, the computer 5 has a processing unit 51, a communication I / F 52, a main storage device 53, and an auxiliary storage device 54, which are connected to each other via a communication path such as a bus.
[0046] Here, the processing unit 51 is realized by a processor such as a CPU, and executes each process described below according to a program in a main storage device 53. The communication I / F 52 performs communication via the network 4.
[0047] Furthermore, the main storage device 53 is realized by a memory or the like, and the following programs are deployed therein. A mobile object task estimation program 531, a mobile object task recording program 532, an optimal route generation program 533, and a common movement route creation program 534 are deployed in the main storage device 53. Each of these programs is stored in the auxiliary storage device 54 or other storage media, and is deployed in the main storage device 53 when processing is performed by the processing unit 51. Each of these programs may be distributed to the computer 5 via the network 4.
[0048] Here, each program can be realized by a hardware configuration such as a circuit, and has the following correspondence with each unit shown in FIG. Mobile task estimation program 531: Mobile task estimation unit 501 Mobile task recording program 532: Mobile task recording unit 502 Optimal route generation program 533: Optimal route generation unit 503 Common movement route creation program 534: Common movement route creation unit 504 Next, the auxiliary storage device 54 is realized by a storage device such as an HDD (Hard Disk Drive) or an SSD (Solid State Drive), and stores the moving object task 541, the optimal route 542, and the common movement route 543. As described above, it is preferable that the auxiliary storage device 54 stores each program.
[0049] Moreover, it is preferable that each management server (601, 602) stores the mobile object tasks 541 and mobile object positions 544 of the mobile objects that it manages.
[0050] The computer 5 may further include input / output devices such as a keyboard, a mouse, a display device, and a touch panel.
[0051] Next, the processing contents of this embodiment will be described with reference to Figures 5, 6, and 7. Note that, although the processing in the following description will be described using the units in Figure 4 as the subject of the processing, the processing unit 51 will also perform similar processing according to the programs shown in Figure 12. In addition, in this case, when using the configuration shown only in Figure 12, the configuration shown in Figure 12 will also be used as appropriate in the description.
[0052] FIG. 5 shows an example of a mobile task 541 estimated by the mobile task estimation unit 501. In this embodiment, the purpose is to control the movement of a mobile object, and as shown in FIG. 5(a), a basic task is to move with a purpose from a position "Start" which is a starting point to another goal point "Goal". For example, this basic task can be defined as one task (movement task) to move from the current location "Start" to "Goal" where the luggage is placed, and another task (loading task) to lift the luggage and move it to another unloading location. The mobile task 541 showing these basic tasks can be defined with the start point and the goal point as the minimum components. Therefore, if a series of operations of the mobile object 1 is decomposed into tasks and arranged in chronological order, it can be expressed as shown in the table shown in FIG. 5(b). That is, FIG. 5(b) shows the mobile task 541.
[0053] Next, Fig. 6 is a flowchart showing a process for recording a mobile object task. Here, Fig. 6(a) is a flowchart showing a mobile object task recording environmental sensor side process. In this mobile object task recording process, first, the mobile object position measuring unit 301 of the environmental sensor 3 is executed. First, in step S101, the mobile object position measuring unit 301 measures the position (x, y coordinates in this embodiment) of one or more mobile objects in the common area 2. Then, in step S102, the mobile object position measuring unit 301 transmits the mobile object position measured in step S101 to the computer 5 via the network 4.
[0054] In this embodiment, the moving object position is measured using the environmental sensor 3, but if each moving object to be controlled has a self-position estimation function, the self-position may be acquired from each moving object. In this case, a sensor for self-position estimation mounted on each moving object replaces the environmental sensor 3. Also, the computer 5 may specify the position of the moving object using the moving object position 544 included in the global movement route held by each management server (601, 602).
[0055] Next, the mobile object task recording computer side process shown in Fig. 6(b) will be described. First, in step S103, the mobile object task estimation unit 501 of the computer 5 accepts the mobile object position 544 received from the environmental sensor 3 via the communication I / F 52. This mobile object position 544 can use the grid in which the mobile object is moving. However, as described above, other position information such as latitude and longitude may be used for the mobile object position.
[0056] Next, in step S104, the mobile object task estimation unit 501 records the mobile object position 544 in chronological order in a storage area in the computer 5, for example, in the auxiliary storage device .
[0057] Next, in step S105, the mobile object task estimation unit 501 judges whether a series of mobile object tasks 541 for the corresponding mobile object have been completed based on the recorded time-series mobile object position information. For this judgment, for example, there is a method of judging that the mobile object task 541 has ended when the mobile object 1 has stayed in the same position for a certain period of time. There is also a method of receiving a global movement route from the management servers 601 and 602, and judging that the corresponding mobile object task 541 has ended when the mobile object 1 has arrived at the start point and the goal point of the global movement route.
[0058] Here, if it is determined in step S105 that the moving object task has not yet ended (No), the process returns to step S103. Then, step S104 is repeated. If it is determined that the moving object task 541 has ended (Yes), the process proceeds to step S106.
[0059] Then, in step S106, the mobile task estimation unit 501 extracts task information of the mobile task 541 that has been determined to have ended. In this embodiment, the mobile task 541 is represented by two pieces of position information, a start point and a finish point, as shown in FIG. 5. Therefore, in step S106, the task information is extracted by setting the first position in the time axis direction of a series of time-series information as the start point and the last position as the finish point. In other words, each record of the mobile task 541 shown in FIG. 5 indicates task information. In this way, the mobile task estimation unit 501 can acquire the task information of the mobile object.
[0060] Next, in step S107, the mobile object task recording unit 502 records the acquired task information in a storage area in the computer 5, such as the auxiliary storage device 54. Here, in step S107, a unique task number, a start point, and a goal point are recorded as a set for each mobile object, as shown in Fig. 5. The above is the processing content of the mobile object task recording process. Note that this step S107 may be omitted.
[0061] Next, Fig. 7 is a flowchart showing a common travel route creation process executed after the process of Fig. 6. This process is executed at a predetermined time interval (for example, once a day) longer than the mobile task recording process.
[0062] First, in step S201, the optimum route generating unit 503 randomly selects one piece of task information recorded in the storage area in the computer 5 for each moving object and reads it out.
[0063] Next, in step S202, the optimal route generating unit 503 searches for an optimal route 542 for each moving body when the number of moving body tasks executed in parallel is the same as the number of moving bodies. Here, the optimal route 542 is a route that minimizes the task completion time and the number of times the moving bodies approach each other, and can be searched for using a machine learning method such as Q-learning. Note that this embodiment is not limited to the optimal route 542, and may be an individual route for each moving body that satisfies a predetermined condition or is under a predetermined restriction.
[0064] In addition, this embodiment is not limited to creating a route, but can create individual rules for a moving object regarding movement. In other words, the optimal route generating unit 503 can function as an individual rule generating unit. Furthermore, the individual rules for a moving object regarding movement indicate system settings, agreements, and standards regarding movement.
[0065] Next, in step S203, the optimum route generating unit 503 records the optimum route 542 for each moving object 1 obtained in step S202 in a storage area in the computer 5 such as the auxiliary storage device .
[0066] Next, in step S204, the optimum route generating unit 503 judges whether steps S201 to S203 have been executed a predetermined number of times. In this step, the number of times of searching for the optimum route in step S202 may be judged. As a result, if it is judged that the number of times is less than the predetermined number (No), the process returns to step S201 and repeats the process for another piece of task information. If it is judged that the number of times is equal to or greater than the predetermined number (Yes), the process proceeds to step S205.
[0067] The predetermined number of times used in step S204 varies depending on the number and types of recorded tasks, the number of moving objects, etc., but is desirably a number sufficient for selecting various combinations of tasks, such as 1,000 times or 10,000 times. For this reason, it is desirable for the computer 5 to store this number of times in the auxiliary storage device 54 in advance and use it.
[0068] Next, in step S205, the common movement route creation unit 504 reads out the optimal route 542 recorded in step S203.
[0069] Next, in step S206, the common movement path creation unit 504 superimposes the read optimum routes 542. That is, the common movement path creation unit 504 superimposes each optimum route 542.
[0070] Finally, in step S207, the common movement path creation unit 504 creates a common movement path 543 based on the remaining paths after the paths with less than a predetermined number of overlaps are deleted. Among the paths of either the truck loading / unloading system A or the warehouse management system B, paths with a predetermined number of overlaps or more are extracted, and the common movement path 543 is created based on these. Then, the common movement path creation unit 504 creates the common movement path 543 by adding a path that complements the path that accomplishes the mobile body task of the deleted path. Note that this complementation also includes reusing the deleted path. Furthermore, the extracted path may be used as the common movement path itself.
[0071] In this way, the common movement path creation unit 504 extracts a path with a predetermined number of overlaps or more as at least a part of the common movement path 543. In addition, in the example of Fig. 3, the number of overlapping grids is used as the number of overlaps.
[0072] In this manner, in this embodiment, the common movement path creation unit 504 creates a common movement path based on the number of overlaps as an example of the overlapping state. The overlapping state includes the number of overlaps as well as the presence or absence of overlap at a predetermined position (e.g., an important position) in the common area.
[0073] Furthermore, in this embodiment, overlapping situations are used, and these overlapping situations include collision situations, which are situations such as collision between moving bodies when moving according to individual rules or approaching that satisfies a predetermined condition. Here, approaching that satisfies a predetermined condition includes the distance between the moving bodies being equal to or less than a predetermined value, and changes in the moving situation of at least one of the moving bodies, such as deceleration or direction change. The collision situation includes the number of collisions and the presence or absence of a collision at a predetermined position (e.g., an important position) in the common area. Through the above processing, a common movement path 543 for a plurality of moving objects such as the example shown in FIG. 3 can be created.
[0074] The common movement path creation unit 504 is not limited to creating the common movement path 543, but can create a common area rule regarding movement. That is, the common movement path creation unit 504 can function as a common area rule creation unit.
[0075] The common movement route 543 created in this manner is transmitted to the management servers (601, 602) of each system via the communication I / F 52. The management servers 601, 602 that receive this use the common movement route 543 as a route map that can be set when planning a global movement route. In other words, the global movement route planned by the management servers 601, 602 is planned along the common movement route 543. Although not shown in FIG. 12, it is desirable for the management servers (601, 602) to store the global movement route.
[0076] Moreover, the management servers (601, 602) transmit this global movement route to the moving body 1. Then, the unmanned machine 1a plans a local movement route along this global movement route and moves autonomously, while the manned machine 1b and the worker 1c are prompted to move along this route as guidance displayed as a reference route.
[0077] In this way, planning the behavior of the truck loading / unloading system A and the warehouse management system B according to the common rule of the common movement route smooths the movement flow of multiple moving objects 1 and reduces the risk of approaching or colliding. Furthermore, since the common movement route makes it easier to predict the movements of moving objects in other systems, there are fewer situations where moving objects 1 need to slow down or stop due to approaching each other, and as a result, the average moving object task completion time for each moving object 1 is shorter.
[0078] The effect of this embodiment is illustrated in Fig. 8. When the common moving path 543 is not used, there is a trade-off between safety and efficiency (task completion time), and when efficiency is sought, safety decreases as the risk of contact between moving bodies increases. In this case, when safety is sought, the task completion time increases as the moving bodies decelerate and stop more frequently. On the other hand, when a common moving path is used, the task completion time can be shortened while maintaining safety, making it possible to achieve both safety and efficiency.
[0079] In addition, in this embodiment, the optimum route is searched for based on the actual moving object task. Therefore, in this embodiment, the start point and goal point of the moving object task 541 are the same as those of the actual task, and the movement route between them is optimized.
[0080] It should be noted that, although there is a high possibility of obtaining overall optimization by changing the start point and the goal point more dynamically, the operation of each moving body 1 will change significantly. For this reason, there is a risk that the base rules of each system will be significantly changed inside and outside the common area. On the other hand, in this embodiment, a common moving route 543 is created, which is a common rule that takes the sum of the base rules of each system while respecting them. In other words, in this embodiment, safety and efficiency can be optimized without changing the behavior of each system as much as possible, rather than aiming for overall optimization. This concludes the explanation of the first embodiment. EXAMPLES
[0081] Next, a second embodiment of the present invention will be described. The second embodiment differs from the first embodiment in the mobile task 541 (referred to as mobile task 541' in this embodiment). FIG. 9 shows mobile task 541' in the second embodiment. The mobile task 541 in the first embodiment is represented only by a start point and a goal point. In contrast, in the second embodiment, in addition to the start point and goal point, the movement history between them is also extracted as task information in step S106 as mobile task 541'. That is, in step S106, each of the mobile positions 544 in time series is extracted as task information.
[0082] In addition, in step S202, the optimum route generating unit 503 searches for an optimum route that minimizes the amount of change from the movement history of the actual task in addition to the conditions for the optimum route in the first embodiment.
[0083] In this way, in the second embodiment, the obtained common movement route 543 reflects the base rules of each system more closely, and is more effective when it is desired to minimize the range of rule changes. For example, if it is desired to fit the rules of the warehouse management system B while keeping the rules of the truck loading / unloading system A as unchanged as possible, the task information (each movement history) of the second embodiment is used only for the moving body 1 of the truck loading / unloading system A. This makes it possible for the moving body 1 of the warehouse management system B to create a desirable common movement route 543 by using the task information (start point and goal point) of the first embodiment. This concludes the explanation of the second embodiment. EXAMPLES
[0084] Next, a third embodiment of the present invention will be described. The third embodiment assumes a situation in which construction work is being carried out by a construction machine, also a moving body 1, on a part of a road on which an automobile, also a moving body 1, is traveling. The processing content of this embodiment is the same as that of the first or second embodiment, but the common area 2, which is the application environment, is different.
[0085] Fig. 10 is an overall diagram of a control system for multiple moving bodies according to the third embodiment. In Fig. 10, construction machinery and nearby workers are working to block one side of a two-lane road included in a common area 2'. Here, the construction machinery, nearby workers, and a car traveling in the oncoming lane correspond to moving bodies 1. Fig. 11 shows the concept of rules and common movement routes in multiple systems when this embodiment is applied to such an environment.
[0086] First, a system including a group of automobiles driven by humans is defined as System C. System C behaves with the traffic rules set for that location as the base rules. Furthermore, moving objects 1 in System C are connected to a management server 601. These moving objects 1 are assumed to receive global movement routes from the management server 601 and to be automatically driven, automatically assisted driven, or manually driven by an operator. Note that in System C, each moving object 1 may be autonomously controlled. In other words, the management server 601 may be omitted. Furthermore, the environmental sensor 3 may be installed in the moving object 1 or on the road.
[0087] Furthermore, a system including construction machinery operated by an operator is referred to as System D. Construction machinery moves in sequence according to a construction plan while performing construction such as excavation, and the construction plan or rules related to on-site work safety are the base rules. The movement route of each moving body 1 (a car in the case of System C, and construction machinery or workers in the case of System D) in a single system based on the base rules of each of these systems is as shown in Figure 11(a)(b).
[0088] In addition, in FIG. 11, the movement path when system C changes lanes is omitted. When systems C and D are in a common area 2' and each moving body 1 operates in parallel, the two lanes on one side are blocked by the construction machinery, which is the moving body 1 of system D, and surrounding workers, and the moving body 1 of the other system cannot travel. For this reason, the moving body 1 of system C, which is an automobile, continues to stop if the moving body 1 (automobile) traveling in the opposite lane to the lane where the construction machinery and surrounding workers are present is stopped. Then, when there are no moving bodies traveling in the opposite lane, the moving body 1 of system C will use the opposite lane to overtake the moving body 1 of system D. When the traffic volume on both lanes is about the same, congestion occurs on one side, and there is a high possibility that the task completion time will be extended.
[0089] When the present invention is applied to such an environment, that is, the common area 2', for example, the computer 5 creates a common movement path 543 as shown in Fig. 11(c). Then, based on this common movement path 543, the moving object 1 of the system C is autonomously controlled. Alternatively, the display device of the moving object 1 displays guidance. This optimizes safety and efficiency within the common area 2'.
[0090] This concludes the description of each embodiment of the present invention. The moving objects in each embodiment include so-called robots, in addition to the above-mentioned self-driving automobiles (including self-driving support vehicles) and forklifts. Robots include security robots and guide robots in facilities such as buildings, stations, and airports. Furthermore, self-driving automobiles include so-called platooning vehicles such as trucks and buses. [Explanation of symbols]
[0091] 1...mobile body, 1a...unmanned machine, 1b...manned machine, 1c...worker, 2...common area, 3...environmental sensor, 4...network 4, 5...computer, 501...mobile body task estimation unit, 502...mobile body task recording unit, 503...optimal path generation unit 503, common movement path creation unit 504, 601...management server, 602...management server
Claims
1. A mobility control assistance device that assists in controlling the movement of a mobile object in a common area where mobile objects of a plurality of systems coexist, comprising: a mobile object task estimation unit that estimates a mobile object task of the mobile object defined by task information including a start position, an arrival position, and a movement history between the start position and the arrival position of the mobile object based on a movement position of each of the mobile objects; an individual rule generating unit that generates, for each of the mobile tasks, an individual rule for realizing the mobile task; a common area rule creation unit that identifies an overlapping state of the individual rules in the common area, and creates a common area rule regarding the movement of the moving object in the common area by using each of the individual rules in accordance with the overlapping state, The individual rule generation unit is a movement control assistance device that generates an individual route that minimizes an amount of change in the movement history.
2. The movement control assistance device according to claim 1, the individual rule generation unit generates, as the individual rule, an individual route for each of the moving objects; The common area rule creation unit is a movement control support device that creates, as the common area rule, a common movement path, which is a movement path of the moving body in the common area.
3. The movement control assistance device according to claim 2, The common area rule creating unit overlaps each of the individual routes, and A mobility control assistance device that extracts, from among the individual routes, individual routes that have a predetermined number of overlaps or more as at least a part of the common mobility route.
4. The movement control assistance device according to claim 3, The common area rule creation unit uses, as the overlap number, the number of grids on which the individual routes overlap, among the grids that divide the common area into a lattice pattern.
5. A mobility control support method using a mobility control support device that supports control of the movement of a mobile object in a common area where mobile objects of a plurality of systems coexist, comprising: The movement control assistance device, Accepting a moving position of each of the moving objects; Based on the movement position, a mobile object task of the mobile object is estimated, which is defined by task information including a start position, an arrival position, and a movement history between the start position and the arrival position of the mobile object; generating an individual rule for realizing each of the mobile tasks; Identifying an overlapping state of the individual rules in the common area; creating a common area rule regarding the movement of the moving object in the common area by using each of the individual rules according to the overlapping state; transmitting the common area to a management server in each of the plurality of systems; transmitting information for controlling movement in the common area to the mobile object from each of the management servers; enabling the moving object to move in the common area based on information for controlling the movement; The mobility control support method further comprises generating an individual route that minimizes an amount of change in the mobility history in generating the individual rule.
6. The mobility control assistance method according to claim 5, generating an individual route for each of the moving objects as the individual rule; A mobility control support method that creates, as the common area rule, a common movement path that is a movement path of the mobile body in the common area.
7. The mobility control assistance method according to claim 6, A mobility control support method, in which, in creating the common area rule, each of the individual routes is overlapped, and among the individual routes of the plurality of systems, individual routes that have a predetermined number of overlaps or more are extracted as at least a part of the common mobility route.
8. The mobility control assistance method according to claim 7, A mobility control support method, wherein in creating the common area rule, the number of grids that divide the common area into a lattice pattern, on which the individual routes overlap, is used as the overlap number.
Citation Information
Patent Citations
Integration destination path extraction method, path graph creation method, device, and program
JP2015210083A
Autonomous mobile body and control program for the same
JP2019219733A
Autonomous mobile body and control program for the same
JP2019219735A
Automatic parking management device
JP2020129260A
Mobile body movement control system
WO2002023297A1
