WO2022124374A1 - 移動体システム及びその制御方法 - Google Patents
移動体システム及びその制御方法 Download PDFInfo
- Publication number
- WO2022124374A1 WO2022124374A1 PCT/JP2021/045378 JP2021045378W WO2022124374A1 WO 2022124374 A1 WO2022124374 A1 WO 2022124374A1 JP 2021045378 W JP2021045378 W JP 2021045378W WO 2022124374 A1 WO2022124374 A1 WO 2022124374A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- node
- communication processing
- processing unit
- moving
- moving body
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 30
- 238000004891 communication Methods 0.000 claims abstract description 264
- 238000012545 processing Methods 0.000 claims abstract description 229
- 230000008859 change Effects 0.000 claims abstract description 35
- 239000000463 material Substances 0.000 claims description 18
- 230000032258 transport Effects 0.000 claims description 9
- 230000033001 locomotion Effects 0.000 abstract description 39
- 238000007726 management method Methods 0.000 description 51
- 230000008569 process Effects 0.000 description 14
- 238000010586 diagram Methods 0.000 description 12
- 230000006870 function Effects 0.000 description 8
- 238000010276 construction Methods 0.000 description 4
- 230000001052 transient effect Effects 0.000 description 4
- 230000005540 biological transmission Effects 0.000 description 3
- 239000004566 building material Substances 0.000 description 2
- 238000007796 conventional method Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000001934 delay Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000010295 mobile communication Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
Definitions
- the present invention relates to a mobile system and a control method thereof.
- This application claims priority based on Japanese Patent Application No. 2020-204268 filed in Japan on December 9, 2020, the contents of which are incorporated herein by reference.
- the present invention has been made in view of such circumstances, and an object thereof is a moving body capable of continuing the movement of the moving body even when the number of moving bodies to be operated in the area increases. It is to provide a system and a control method.
- One aspect of the present invention corresponds to a mobile body that can move between a plurality of nodes in an area and can change its operation in the node, and can communicate with the mobile body, and corresponds to each of the nodes.
- the mobile body includes a plurality of communication processing units provided in the above-mentioned communication processing unit, and the mobile body communicates with the communication processing unit corresponding to the node to be passed through, and the communication processing unit has a plurality of the above-mentioned communication processing units. It is a mobile body system that instructs at least one or more of the plurality of mobile bodies to temporarily wait or change a route based on the communication with the mobile body.
- the mobile body calculates the scheduled passage time to pass through the scheduled passage node, and passes through the scheduled passage node at the scheduled passage time as the communication.
- a reservation application is made to the communication processing unit corresponding to the transit scheduled node, and the communication processing unit overlaps a part or all of the scheduled passage times for which reservation applications are made from each of the plurality of moving objects.
- at least one of the plurality of moving bodies may be instructed to temporarily wait or change the route.
- the communication processing unit determines a type of collision that is assumed when a part or all of the scheduled passage times overlaps. And, depending on the determination result of the determination unit, the instruction unit for instructing at least one or more of the plurality of moving objects to temporarily wait or change the route may be provided.
- the indicating unit is a collision in which the type of collision determined by the determination unit is a collision in which the collision can be avoided by the temporary standby of any of the moving bodies. May instruct the moving body to temporarily wait, whichever is the later of the plurality of reservation applications having a time zone in which the reservation application is partially or completely overlapped.
- the scheduled passage time Of the plurality of the moving bodies for which the reservation application is made in part or all of the above at least one of the moving bodies may be instructed to change the route.
- the planned passage node is the node through which the mobile body passes from the present to a predetermined time ahead, and the predetermined time. May be set within an allowable range of an error between the scheduled passage time and the passage time in which the moving object actually passes.
- the communication processing unit corresponding to the entry / exit management node limits the number of the moving objects that can enter the second path to the number that can avoid collisions between the moving objects in the second path. You may.
- a temporary evacuation destination which is a node capable of avoiding a collision with the other moving body, may be instructed to the one moving body based on the destination information of the other moving body.
- the mobile system according to any one of (1) to (9) above, and the mobile body may be a robot that transports materials.
- One aspect of the present invention corresponds to a mobile body that can move between a plurality of nodes in an area and can change its operation in the node, and can communicate with the mobile body, and corresponds to each of the nodes.
- a method for controlling a mobile system including a plurality of communication processing units provided in the above, wherein the mobile body communicates with the communication processing unit corresponding to the node to be passed, which is the node to be passed.
- the communication processing unit is a control method for instructing at least one or more of the plurality of mobile bodies to temporarily wait or change a route based on the communication with the plurality of the mobile bodies. ..
- a reservation application for calculating the scheduled passage time for the moving body to pass through the scheduled passage node and passing through the scheduled passage node at the scheduled passage time as the communication Is performed for the communication processing unit corresponding to the planned passage node, and the communication processing unit overlaps a part or all of the scheduled passage times for which reservation applications are made from each of the plurality of moving objects. May instruct at least one or more of the plurality of moving bodies to temporarily wait or change the route.
- the communication processing unit corresponding to the management node may limit the number of the moving bodies that can enter the second path to a number that can avoid collisions between the moving bodies in the second path.
- FIG. 1 is a schematic configuration diagram of the mobile system 1 according to the first embodiment.
- a plurality of mobile bodies 10-1 to 10-n (n is an integer of 2 or more) and a plurality of communication processing units 11-1 to 11-k (k is 2 or more). Integer).
- moving body 10 When each of the plurality of moving bodies 10-1 to 10-n is not distinguished, it is referred to as "moving body 10".
- communication processing unit 11 When each of the plurality of communication processing units 11-1 to 11-k is not distinguished, it is referred to as "communication processing unit 11".
- the plurality of moving bodies 10 move within a certain area.
- the moving body 10 of the first embodiment will be described by exemplifying a transport vehicle for transporting building materials and the like, but the present invention is not limited to this, and any mobile body 10 may be movable within a certain area.
- the moving body 10 may be a small flying object such as a drone.
- the moving body 10 may be a robot used for civil engineering work or construction work, and may be, for example, a heavy transport vehicle, a shovel car, a bulldozer, or a crane car.
- the mobile body 10 may be manned or unmanned. A movement route is set in advance for each moving body 10.
- the mobile body 10 moves between a plurality of nodes 12 in the area, and the operation can be changed at the node 12.
- the change of the operation is to change the moving direction of the moving body 10 or to suspend the movement. In this way, the mobile body 10 moves to a designated destination while moving between the nodes 12.
- FIG. 2 is a diagram illustrating the node 12 according to the first embodiment.
- FIG. 2 is a view of the area as viewed from directly above.
- Nodes 12 are set in various places in the area.
- the mobile body 10 transports the material to the destination while moving between the nodes 12, or moves to the material storage place to load the material.
- the node 12 may be a virtual area provided in the area as well as an area in the area where the presence / absence of the mobile body 10 can be detected by a sensor or a communication terminal.
- Each communication processing unit 11 can communicate with each mobile body 10 via the communication network NW, and is provided corresponding to each node 12.
- the communication processing unit 11 may be arranged at a set position or may be arranged at a different position from each node 12.
- the code below the hyphen (or the code consisting of the first hyphen followed by a number or symbol) indicating which node 12-m corresponds to may be omitted.
- the communication processing unit 11-m transmits and receives information via the mobile body 10 and the communication network NW, and the mobile body 10 passing through the node 12-m and the time during which the mobile body 10 passes through the node 12-m (hereinafter referred to as). , "Scheduled transit time") and manage transit management. That is, the communication processing unit 11-m manages which mobile body 10 passes through the node 12-m at what time zone.
- the scheduled transit time indicates a certain time zone. For example, the scheduled passage time of the node 12-m is the node from the node 12- (m-1) on the assumption that the moving body 10 moves from the node 12- (m-1) toward the node 12-m.
- the communication processing unit 11-m instructs the moving body 10 to change the operation so that the scheduled passage times passing through the node 12-m do not overlap among the plurality of moving bodies 10.
- FIG. 3 is a diagram illustrating passage management according to the first embodiment.
- the mobile body 10-1 is located at the node 12-1, and the mobile body 10-2 is located at the node 12-2. Then, in the example shown in FIG. 3, the moving body 10-1 moves from the node 12-1 to the node 12-2 in the time zone from 5 seconds to 10 seconds after the moving body 10-1 based on the preset movement path.
- the moving body 10-1 moves from node 12-1 to node 12-3 in the time zone from 10 seconds to 15 seconds later, and moving from node 12-3 to node 12-4 in the time zone from 15 seconds to 20 seconds later. calculate.
- the mobile body 10-1 makes a reservation application including the identification information of the mobile body 10-1 and the scheduled passage time (5 to 10 seconds) to the communication processing unit 11-2. Further, the mobile body 10-1 makes a reservation application including the identification information of the mobile body 10-1 and the scheduled passage time (10 seconds to 15 seconds) to the communication processing unit 11-3. Further, the mobile body 10-1 makes a reservation application including the identification information of the mobile body 10-1 and the scheduled passage time (15 seconds to 20 seconds) to the communication processing unit 11-4.
- the moving body 10-2 moves from node 12-2 to node 12-3 in a time zone from 4 seconds to 9 seconds, and from 9 seconds to 14 seconds, based on a preset movement path. It is calculated to move from node 12-3 to node 12-4 in the time zone of.
- the moving body 10-2 makes a reservation application including the identification information of the moving body 10-2 and the scheduled passage time (4 seconds to 9 seconds later) to the communication processing unit 11-3.
- the mobile body 10-2 makes a reservation application including the identification information of the mobile body 10-2 and the scheduled passage time (after 9 seconds to 14 seconds) to the communication processing unit 11-4.
- the communication processing unit 11-2 manages the information that the mobile body 10-1 passes through the node 12-2 in the scheduled passage time (5 seconds to 10 seconds later). Further, in the communication processing unit 11-3, the moving body 10-2 passes through the node 12-3 at the scheduled passing time (4 seconds to 9 seconds later), and the moving body 10-1 passes through the scheduled passing time (10 seconds later). It manages the information that it passes through the node 12-3 (15 seconds after the operation). Further, in the communication processing unit 11-4, the moving body 10-2 passes through the node 12-4 at the scheduled passing time (9 seconds to 14 seconds later), and the moving body 10-1 passes through the scheduled passing time (15 seconds later). 20 seconds after the operation), the information that the node 12-4 is passed is managed. It should be noted that passing through the node 12 at the scheduled passage time is synonymous with occupying the node 12 over the scheduled passage time.
- the communication network NW may be a wireless communication transmission line (for example, a wireless LAN), or may be a combination of a wireless communication transmission line and a wired communication transmission line.
- the communication network NW may be a mobile communication network such as a mobile phone line network, a wireless packet communication network, the Internet and a dedicated line, or a combination thereof.
- the communication network NW may use a low-power wide-area network (LPWAN), or may use short-range wireless communication standards such as ZigBee (registered trademark), WiFi (registered trademark), and BLE. You may use it.
- LPWAN low-power wide-area network
- FIG. 4 is a diagram showing a configuration example of the mobile body 10 according to the first embodiment.
- the mobile body 10 includes a communication unit 20, a storage unit 21, and a control unit 22. These components are realized, for example, by a hardware processor such as a CPU (Central Processing Unit) executing a program (software). In addition, some or all of these components are hardware such as LSI (Large Scale Integrated circuit), ASIC (Application Specific Integrated Circuit), FPGA (Field-Programmable Gate Array), and GPU (Graphics Processing Unit). It may be realized by the circuit part (including circuitry), or it may be realized by the cooperation of software and hardware.
- a hardware processor such as a CPU (Central Processing Unit) executing a program (software).
- LSI Large Scale Integrated circuit
- ASIC Application Specific Integrated Circuit
- FPGA Field-Programmable Gate Array
- GPU Graphics Processing Unit
- the program may be stored in advance in a storage device (a storage device including a non-transient storage medium) such as an HDD (Hard Disk Drive) or a flash memory, or a removable storage such as a DVD or a CD-ROM. It is stored in a medium (non-transient storage medium), and may be installed in the storage device by mounting the storage medium in the drive device.
- a storage device is composed of, for example, an HDD, a flash memory, an EEPROM (Electrically Erasable Programmable Read Only Memory), a ROM (Read Only Memory), a RAM (Random Access Memory), or the like.
- the communication unit 20 sends and receives information to and from each communication processing unit 11-m via the communication network NW.
- the storage unit 21 stores in advance the movement route to which the moving body 10 moves.
- This movement route is, for example, information indicating which node 12 of the plurality of nodes 12 passes through to reach the destination, and is an operation plan of the moving body 10.
- the movement route is information such as a node 12 scheduled to pass (hereinafter, referred to as “a node scheduled to pass”) and which node to pass through in what order.
- the storage unit 21 stores identification information (for example, ID (identification)) that can identify the moving body 10.
- ID identification information
- the control unit 22 controls the operation of the moving body 10.
- the control unit 22 autonomously causes the moving body 10 to travel to the destination while moving between the nodes 12 based on the movement route stored in the storage unit 21.
- the control unit 22 calculates the scheduled passage time to pass through the planned passage node based on the movement route stored in the storage unit 21.
- the control unit 22 makes a reservation application for passing through the planned passage node to the communication processing unit 11 corresponding to the planned passage node, respectively.
- the reservation application includes the identification information stored in the storage unit 21 and the scheduled transit time.
- control unit 22 may calculate the scheduled passage time of all the scheduled passage nodes, or calculate the scheduled passage time of only the scheduled passage node through which the moving body 10 passes from the present to a predetermined time ahead. May be good. This predetermined time is set by an experiment or the like within a range in which an error between the scheduled passage time and the passage time actually passed by the moving body 10 can be tolerated.
- the control unit 22 calculates the scheduled passage time only for each scheduled passage node (hereinafter referred to as “target node”) that passes within a few seconds ahead, and passes the target node at the calculated scheduled passage time.
- a reservation application is made to each of the communication processing units 11 corresponding to each target node.
- FIG. 5 is a diagram illustrating a target node of the first embodiment.
- the node 12-2, the node 12-3, and the node 12-4 are described as the planned passage nodes of the mobile body 10-1 occupying the node 12-1.
- the scheduled passage time of the node 12-2 is 2 seconds to 10 seconds later
- the scheduled passage time of the node 12-3 is 10 seconds to 18 seconds later
- the scheduled passage time of the node 12-4 is The scheduled passage time is 20 to 26 seconds later. Therefore, the target nodes are only node 12-2 and node 12-3.
- the moving body 10-1 makes a reservation application including the identification information of the moving body 10-1 and the scheduled passage time (after 2 seconds to 10 seconds) to the communication processing unit 11-2 via the communication network NW.
- a reservation application including the identification information of the moving body 10-1 and the scheduled passage time (10 seconds to 18 seconds later) is submitted to the communication processing unit 11-3 via the communication network NW.
- the mobile body 10-1 moves to the node 12-2 or the node 12-3, the mobile body 10-1 newly determines the target node and makes a reservation application to the target node.
- the control unit 22 controls the operation of the moving body 10 so as to pass through the scheduled passage node on the scheduled passage time.
- the control unit 22 changes the operation of the mobile body 10 according to the instruction.
- FIG. 6 is a diagram showing a configuration example of the communication processing unit 11 according to the first embodiment.
- each configuration of the communication processing unit 11-m may be distinguished from others by adding "-m".
- the communication processing unit 11 includes a communication unit 30, a storage unit 31, a determination unit 32, and an instruction unit 33.
- These components are realized by, for example, a hardware processor such as a CPU executing a program (software). Further, some or all of these components may be realized by hardware such as LSI, ASIC, FPGA, GPU (circuit unit; including circuitry), or realized by collaboration between software and hardware. May be done.
- the program may be stored in advance in a storage device such as an HDD or a flash memory (a storage device including a non-transient storage medium), or a removable storage medium (non-transient) such as a DVD or a CD-ROM.
- the storage device is composed of, for example, an HDD, a flash memory, an EEPROM, a ROM, a RAM, or the like.
- the communication processing unit 11 may be arranged as a device including a small microcomputer or the like at an actual site, or may be virtually configured as a management node on the cloud.
- the communication unit 30 transmits / receives information to / from the communication unit 20 of each mobile body 10 via the communication network NW.
- the storage unit 31 stores the reservation application information (hereinafter referred to as "reservation information") received by the communication processing unit 11.
- the determination unit 32 determines whether or not there is a time zone in which some or all of the scheduled passage times for which reservations have been applied from each of the plurality of moving objects 10 overlap. For example, the determination unit 32 receives the reservation application applied from the mobile body 10 via the communication unit 30. The determination unit 32 confirms whether or not the scheduled passage time of the received reservation application does not overlap with the scheduled passage time of the reservation information stored in the storage unit 31 (hereinafter, referred to as “reserved time”). ..
- “duplicate” means that at least a part, that is, a part or a whole overlaps.
- the determination unit 32 determines that the moving bodies 10 may collide with each other, the determination unit 32 performs a collision type determination for determining an assumed collision type.
- the types of collisions are, for example, a soft conflict in which a collision can be avoided by a temporary standby of one of a plurality of colliding moving bodies 10, and a hard conflict in which a collision cannot be avoided by the temporary waiting. Is either.
- the determination unit 32 acquires information on each movement path from a plurality of moving bodies 10 that may collide, and determines the type of collision depending on whether or not the moving body 10 of the collision partner exists on the moving path. You may judge.
- the instruction unit 33 temporarily refers to at least one or more moving bodies 10 among the plurality of moving bodies 10 having the possibility of collision. Instruct to wait or change route.
- the instruction unit 33 instructs the moving body 10 whose reservation application is late to wait temporarily.
- the instruction unit 33 refers to at least one or more moving objects 10 among the plurality of moving objects 10 that may collide with each other. Instruct to change the route.
- the instruction unit 33 may determine the moving body 10 to execute the route change, or may determine between the moving bodies 10.
- the instruction unit 33 may instruct the moving body 10 whose reservation application is late to change the route.
- the instruction unit 33 notifies the plurality of moving bodies 10 that may collide with information instructing the change of the moving route, and the moving body 10 that changes the route among the plurality of moving bodies 10. May be decided.
- the moving bodies 10 communicate with each other, and one of the moving bodies 10 changes the moving route according to a preset rule.
- FIG. 7 is a diagram illustrating a collision determination according to the first embodiment.
- the storage unit 21-4 of the communication processing unit 11-4 contains the identification information of the moving body 10-1 and the scheduled passage time t1 of the node 12-4 (40 seconds after the present). It is assumed that the reservation information having is stored.
- the scheduled transit time t1 (40 seconds after the present) is a reserved time.
- the mobile body 10-2 calculates the scheduled passage time t2 (18 seconds to 26 seconds later) of the node 12-4 from the movement route, and makes a reservation application to the communication processing unit 11-4.
- the determination unit 32-4 compares the scheduled passage time t1 stored in the storage unit 21-4 with the scheduled passage time t2 from the moving body 10-2, and checks whether the times overlap each other. Judge whether or not. In this example, since the scheduled passage time t2 overlaps with the scheduled passage time t1, the determination unit 32-4 determines that a collision between the moving body 10-1 and the moving body 10-2 may occur. do.
- FIG. 8A shows an example of a soft conflict.
- FIG. 8A shows an example of a hard conflict.
- the solid line indicates the movement path of the moving body 10-1, and the dotted line indicates the moving path of the moving body 10-2.
- three patterns as shown in FIG. 8A can be considered.
- any pattern there is a possibility that the moving body 10-1 and the moving body 10-2 collide with each other at the node 12-1, but if any node 12 temporarily waits on the spot, the collision can be avoided. Is. That is, if the scheduled passage time of the node 12-1 in the moving body 10-1 and the scheduled passing time of the node 12-1 in the moving body 10-2 can be shifted without overlapping, the moving body 10-1 and the moving body 10-1 can be moved. It is possible to avoid a collision with the body 10-2-.
- three patterns as shown in FIG. 8B can be considered.
- the colliding partner's moving body 10 exists on each other's moving path.
- the collision cannot be avoided as long as the moving body 10 of the collision partner exists on the moving path. Therefore, for example, among the moving body 10-1 and the moving body 10-2, the event that the moving body 10 of the collision partner exists on each other's moving body by changing the moving body 10 of the moving body 10 Eliminate. This makes it possible to avoid a collision between the moving body 10-1 and the moving body 10-2.
- FIG. 9 is a diagram illustrating a flow in which the moving body 10 carries materials.
- the flow shown in FIG. 9 may be, for example, a case where a plurality of moving bodies 10 and an elevator 100 in the site cooperate to transport materials to various floors.
- the user operates a communication information terminal (for example, a computer, a smartphone, a tablet terminal, etc.) to set a plurality of materials to be carried by the mobile body 10 (FIG. 9A). Then, the user operates the communication information terminal to select which mobile body 10 carries which material from the set plurality of materials (FIG. 9 (b)).
- the mobile body 10 to which the material transportation task is assigned loads the designated material (FIG. 9 (c)), moves along the movement route to the destination, and transports the designated material to the destination.
- the moving body 10 on the 1st floor carries the material to the elevator 100 (FIG. 9 (d)).
- the elevator 100 rises to, for example, the 4th floor (FIG.
- the elevator 100 When the elevator 100 arrives at the 4th floor, the elevator 100 directly or indirectly notifies the moving body 10 on the 4th floor. Upon receiving the notification, the mobile body 10 on the 4th floor loads the materials from the elevator 100 and transports them to the destination (FIG. 9 (f)). The moving body 10 that has finished transporting executes the task if a new task is assigned, and returns to the waiting place if it is not assigned.
- FIG. 10 is a flowchart of the operation of the moving body 10 according to the first embodiment.
- the moving body 10 calculates the scheduled passage time of only the target node, which is the node 12 through which the moving body 10 passes from the present to a predetermined time ahead (step S101). .. Then, the mobile body 10 makes a reservation application for passing through the target node at the calculated scheduled passage time to each of the communication processing units 11 corresponding to each target node (step S102). After making the reservation application, the mobile body 10 determines whether or not there is an instruction from the communication processing unit 11 (step S103).
- the mobile body 10 After making a reservation application, the mobile body 10 starts moving or continues moving according to the moving route if there is no instruction from the communication processing unit 11 (step S104).
- the mobile body 10 receives an instruction from the communication processing unit 11 after making a reservation application, the mobile body 10 changes its operation according to the instruction. For example, when the mobile body 10 receives an instruction from the communication processing unit 11, the mobile body 10 determines whether the instruction is a temporary standby instruction or an instruction to change the movement route (step 105).
- the mobile body 10 receives an instruction for temporary standby from the communication processing unit 11 after making a reservation application, the mobile body 10 temporarily waits on the spot (step S106).
- the temporary wait instruction may include a wait time. In this case, the moving body 10 moves according to the moving route after waiting until the waiting time included in the instruction elapses.
- the moving body 10 returns to step S101 and performs a process of making a reservation application.
- the moving body 10 When the moving body 10 receives an instruction to change the movement from the communication processing unit 11 after making a reservation application, the moving body 10 communicates with the moving body 10 of the collision partner to determine the moving body 10 to change the movement.
- the movement change instruction from the communication processing unit 11 includes information (for example, identification information) indicating the moving body 10 of the collision partner, and the moving body 10 moves the collision partner based on this information.
- the body 10 can be identified. For example, the moving body 10 communicates with the moving body 10 of the collision partner and determines whether or not to change the moving route based on a predetermined rule.
- this predetermined rule is not particularly limited as long as it can determine the moving body 10 for which the moving route is changed, and the content of the rule is not particularly limited.
- the collision partner changes the movement path
- the moving body 10 continues to move on its own movement path.
- the moving body 10 changes the moving route stored in the storage unit 21 to a moving route for avoiding a collision (step S107), and based on the changed moving route. Apply for a reservation again.
- FIG. 11 is a flowchart of the operation of the communication processing unit 11 according to the first embodiment.
- step S201 When the communication processing unit 11-m receives the reservation application from the moving body 10 (step S201), whether or not the scheduled passage time of the reservation application overlaps with the reserved time stored in the storage unit 21-m. Is determined (step S202). When the scheduled passage time of the reservation application does not overlap with the reserved time, the communication processing unit 11-m accepts the reservation application and stores the reservation application information in the storage unit 21-m (step S203). When the scheduled passage time of the reservation application overlaps with the reserved time, the communication processing unit 11-m reserves the passage of the moving body 10 that made the reservation application and the node 12-m at the reserved time. It is determined that there is a possibility of collision with the moving body 10 (step S204), and the type of the collision is determined (step S205).
- step S205 the communication processing unit 11-m acquires information on the movement paths of the two moving bodies 10 that may collide with each other via the network NW, and the moving body 10 of the collision partner is on the moving path. Determines if is present.
- the communication processing unit 11-m may use the moving body 10-1 and the moving body 10-.
- the current position of 2 and the movement path of the moving body 10-1 (hereinafter referred to as "first moving path") and the moving path of the moving body 10-2 (hereinafter referred to as "second moving path") are referred to. get.
- the current position is information on the node 12 on which the moving body 10 is located.
- the communication processing unit 11-m (determination unit 32-m) has a first determination process for determining whether or not the moving body 10-2 exists on the first moving path, and a moving body 10 on the second moving path.
- the second determination process of determining whether or not -1 exists is executed.
- the communication processing unit 11-m determines that the moving body 10-2 exists on the first moving path and the moving body 10-1 exists on the second moving path. If it is determined, it is determined that the collision is a hard conflict, and if it is not, it is determined that the collision is a soft conflict.
- the communication processing unit 11-m determines that the type of collision is a soft conflict
- the communication processing unit 11-m instructs the moving body 10 of the person who applied for the reservation later to temporarily wait (step S206).
- the communication processing unit 11-m determines that the type of collision is a hard conflict
- the communication processing unit 11-m instructs two moving bodies 10 that may collide to change the movement route (step S207).
- the mobile system 1 includes a plurality of mobile bodies 10 and a plurality of communication processing units 11.
- the mobile body 10 moves between a plurality of nodes 12 in a certain area, and the operation can be changed at the node 12.
- the communication processing unit 11 can communicate with the mobile body 10 and is provided corresponding to each node 12. Then, the mobile body 10 communicates with the communication processing unit 11 corresponding to the node scheduled to pass, which is the node scheduled to pass 12. More specifically, the scheduled passage time to pass through the scheduled passage node is calculated, and the reservation application (communication) for passing through the scheduled passage node at the scheduled passage time is sent to the communication processing unit 11 corresponding to the scheduled passage node. conduct.
- the communication processing unit 11 instructs at least one or more of the plurality of moving bodies 10 to temporarily wait or change the route based on each scheduled passage time for which reservation is applied from each of the plurality of moving bodies 10. do.
- each of the plurality of moving bodies 10 autonomously determines the action, the movement of the moving body can be continued without setting a limit on the number.
- the management and control of the movements of the plurality of robots can be centrally managed by a computer or the like, and each of the plurality of moving bodies 10 can act autonomously to avoid a collision. Even if one moving body 10 fails, the operation of the moving body 10 can be continued.
- the mobile system 1 may make a reservation application only to the planned transit nodes scheduled to pass from the present to a predetermined time ahead, instead of all the planned transit nodes. good.
- the scheduled passage time exceeding the predetermined time may deviate from the actual passage time due to an error in the operation of the moving body 10. Therefore, the mobile system 1 can perform more accurate passage management of the mobile body 10 by limiting the planned passage nodes for which reservation applications are made to a predetermined time ahead.
- FIG. 12 is a schematic configuration diagram of the mobile system 1A according to the second embodiment.
- the mobile system 1A includes a plurality of mobile bodies 10A-1 to 10A-n and a plurality of communication processing units 11A-1 to 11A-k.
- moving body 10A When each of the plurality of moving bodies 10A-1 to 10A-n is not distinguished, it is referred to as "moving body 10A".
- communication processing unit 11A When each of the plurality of communication processing units 11A-1 to 11A-k is not distinguished, it is referred to as "communication processing unit 11A".
- the moving body system 1A determines the number of moving bodies 10A that can enter the second path R2 that cannot be patrolled from the patrollable first path R1 among the paths that the moving body 10A can move, as compared with the first embodiment. It differs in that it has a limiting function.
- FIG. 13 is a diagram illustrating the first path R1 and the second path R2.
- nodes 12-1 to 12-10 are arranged in a certain area.
- the first path R1 is formed by the nodes 12-1 to 12-7.
- the first route R1 is a route without a terminal node and can be patrolled by the mobile body 10.
- the terminal node is a node 12 to which only one node 12 is connected.
- the first path R1 is a collection of nodes 12 that can form a detour.
- the second path R2 is formed by the node 12-1, the node 12-8, the node 12-9, and the node 12-10.
- the second route R2 is a route having a terminal node and cannot be patrolled by the mobile body 10A.
- the second path R2 is a collection of nodes 12 that cannot form a detour.
- the terminal nodes are node 12-9 and node 12-10.
- the mobile system 1A of the second embodiment limits the number of mobile bodies 10A that can enter the second path R2 to a number that can avoid collisions between the mobile bodies 10A. Thereby, the mobile body system 1A can suppress the collision between the moving bodies in the second path R2.
- a configuration example of the mobile system 1A according to the second embodiment will be described.
- the plurality of moving bodies 10A move in a certain area in the same manner as the moving body 10.
- the moving body 10A will be described by exemplifying a transport vehicle for transporting building materials and the like, but the present invention is not limited to this, and any mobile body 10A may be used as long as it can move within a certain area.
- the mobile body 10A may be a small flying object such as a drone.
- the moving body 10A may be a robot used for civil engineering work or construction work, and may be, for example, a heavy-duty vehicle, a shovel car, a bulldozer, or a crane car.
- the mobile body 10A may be manned or unmanned.
- a movement route (destination information) to a target place is set in advance in each moving body 10A.
- the mobile body 10A When the mobile body 10A enters the second route R2, it transmits an entrance request to the communication processing unit 11A corresponding to the node 12 of the second route R2. The mobile body 10A enters the second route R2 when the transmitted admission request is permitted.
- Each communication processing unit 11A has a function of passing management of the communication processing unit 11 described in the first embodiment.
- the communication processing unit 11A can communicate with each mobile body 10A via the communication network NW, and is provided corresponding to each node 12.
- the installation position of the communication processing unit 11A is the same as that of the communication processing unit 11 described in the first embodiment.
- the communication processing unit 11A identifies the second path R2 where the dead end of the mobile body 10A occurs.
- the communication processing unit 11A corresponding to the node 12 (hereinafter referred to as “entrance / exit management node”) connected from the first route R1 to the second route R2 determines the number of moving objects 10A that can enter the specified second route R2.
- the entrance / exit management is performed to limit the number of collisions between the moving bodies 10A in the second path R2 to an avoidable number.
- the entrance / exit management node is node 12-1.
- the number of mobile bodies 10A that can avoid collisions is, for example, less than or equal to the number of terminal nodes included in one second path R2. In the example shown in FIG. 13, the number of moving bodies 10A that can avoid collisions is 2 or less.
- the identification of the second path R2 is executed, for example, before the movement of the moving body 10A is started.
- the communication processing unit 11A in the second path R2 determines that the two moving bodies 10A in the second path R2 may collide with each other, one of the two moving bodies 10A
- the first evacuation process for moving one moving body 10A in a direction avoiding a collision with the other moving body 10A is executed.
- the communication processing unit 11A moves one to a temporary evacuation destination, which is a node 12 capable of avoiding a collision with the other moving object 10A based on the destination information of the other moving object 10A.
- the second evacuation process for moving the body 10A is executed.
- the communication processing unit 11A-m has a node 12- with respect to the communication processing unit 11A corresponding to the node 12 connected adjacent to the terminal node.
- a notification indicating that m is a dead-end node (hereinafter referred to as "dead-end notification") is performed.
- the dead-end node is a node 13 that forms a route that cannot be detoured. This dead end node contains the terminating node.
- the dead end notification may include the identification information of the node 12 which is a dead end node.
- the terminal nodes are dead-end nodes 12-9 and nodes 12-10.
- Nodes 12-9 are adjacent to and connected to nodes 12-8. Therefore, the communication processing unit 11A-9 notifies the communication processing unit 11A-8 of the dead end of the node 12-9.
- Nodes 12-10 are adjacent to and connected to nodes 12-8. Therefore, the communication processing unit 11A-10 notifies the communication processing unit 11A-8 of the dead end of the node 12-10.
- the communication processing unit 11A-8 Upon receiving the dead-end notification, the communication processing unit 11A-8 determines whether or not there are two or more nodes 12 that are not dead-end nodes among the connection destinations of the nodes 12-8 that have a one-to-one correspondence. Make a dead end node judgment.
- the connection destination of the node 12 is a node 12 connected adjacent to the node 12-8. In the example shown in FIG. 13, only node 12-1 is connected to node 12-8 as a node 12 that is not a dead end node. Therefore, node 12-8 is a dead end node. In this case, the communication processing unit 11A-8 notifies the communication processing unit 11A-1 corresponding to the node 12-1 of a dead end.
- the communication processing unit 11A-1 When the communication processing unit 11A-1 receives the dead end notification, as with the communication processing unit 11A-8, whether or not there are two or more nodes 12 that are not dead end nodes in the connection destination of the node 12-1. Is determined. In the example shown in FIG. 13, node 12-2 and node 12-7 are connected to node 12-1 as a node 12 that is not a dead end node.
- the communication processing unit 11A-1 sets the node 12-1 as an entry / exit management node. In this case, the dead end node and the entrance / exit management node are set as the second path R2.
- node 12-10, node 12-9, node 12-8 and node 12-1 are grouped as one second path R2.
- the information of the second path R2 may be stored in a plurality of communication processing units 11A-1 and 11A-8 to 11A-10 corresponding to each of all the nodes 12 constituting the second path R2 on a one-to-one basis. ..
- the plurality of communication processing units 11A-1 may transmit information on the second path R2 to the communication processing units 11A-8 to 11A-10.
- node 12-20 and node 12-21 are terminal nodes.
- the communication processing unit 11A-20 transmits a dead end notification of the node 12-20 to the communication processing unit 11A-22 corresponding to the node 12-22 connected adjacent to the node 12-20.
- the communication processing unit 11A-22 determines the dead end node for the node 12-22.
- Nodes 12-22 are connected only to nodes 12-24 as nodes other than dead-end nodes. Therefore, node 12-22 is a dead end node.
- the communication processing unit 11A-22 transmits a dead end notification to the nodes 12-24.
- the communication processing unit 11A-21 transmits a dead end notification to the communication processing unit 11A-23 corresponding to the node 12-23 connected adjacent to the node 12-21.
- the communication processing unit 11A-23 determines the dead end node for the nodes 12-23.
- the node 12-23 two nodes 12 of the node 12-24 and the node 12-23 are connected as a node other than the dead end node. Therefore, the nodes 12-23 are determined to be entry / exit management nodes. That is, the node 12-21 and the node 12-23 are set as a group constituting one second path R2-1.
- the communication processing unit 11A-22 transmits a dead end notification to the communication processing unit 11A-24 corresponding to the node 12-24. Upon receiving the dead end notification, the communication processing unit 11A-24 determines the entry / exit management node for the nodes 12-24. Node 12-24 is a dead-end node to which only node 12-23 is connected as a node other than the dead-end node. The communication processing unit 11A-24 transmits a dead end notification of the node 12-24 to the communication processing unit 11A-23 corresponding to the node 12-23.
- the communication processing unit 11A-23 determines the dead end node for the node 12-23.
- node 12-21 and node 12-24 are dead-end nodes. Therefore, the communication processing unit 11A-23 determines that only the node 12-25 is connected to the node 12-23 as a node other than the dead end node. That is, the communication processing unit 11A-23 determines that the node 12-23 is a dead-end node.
- the communication processing unit 11A-23 has already been set as the second path R2-1 because the node 12-23 is not a dead-end node. Therefore, the communication processing unit 11A-23 eliminates the group of the second path R2-1. The communication processing unit 11A-23 notifies the communication processing unit 11A-25 of the dead end of the node 12-23.
- the communication processing unit 11A-25 determines the dead end node of the node 12-25.
- the communication processing unit 11A-25 determines that only the node 12-26 is connected to the node 12-25 as the node 12 other than the dead-end node. In other words, the communication processing unit 11A-25 determines that the node 12-25 is a dead end node.
- the communication processing unit 11A-25 notifies the communication processing unit 11A-26 of the dead end of the node 12-25.
- the communication processing unit 11A-26 determines the dead-end node for the node 12-26.
- Nodes 12-27 and 12-29 are connected to nodes 12-26 as nodes other than dead-end nodes. Therefore, the communication processing unit 11A-26 determines that the nodes 12-26 are not dead-end nodes. In other words, the communication processing unit 11A-26 determines that the nodes 12-26 are entry / exit management nodes.
- the nodes 12-20 to the nodes 12-20, which have been determined as dead-end nodes, and the node 12-26, which is an entrance / exit management node are set as a group constituting one second path R2-2.
- FIG. 15 is a flowchart of the communication processing unit 11A that has received the dead end notification.
- the communication processing unit 11A determines whether or not there are two or more nodes 12 that are not dead-end nodes among the connection destinations of the nodes 12 that have a one-to-one correspondence. (Step S301). When the communication processing unit 11A determines that there are no two or more nodes 12 that are not dead-end nodes, the communication processing unit 11A determines that the node 12 having a one-to-one correspondence is a dead-end node. Only one node 12, which is not a dead-end node, is connected to the dead-end node.
- the communication processing unit 11A When the node 12 having a one-to-one correspondence is a dead-end node, the communication processing unit 11A notifies the communication processing unit 11A of the node 12 which is not a dead-end node connected to the node 12 of the dead-end. Is transmitted (step S302).
- the communication processing unit 11A determines that the node 12 having a one-to-one correspondence is the entry / exit management node. In this case, the node 12 from the terminal node to the entry / exit management node is grouped, and the grouped node group is set as the second path R2 (step S303).
- the nodes 12-30 to 12-33 are grouped as the second path R2-3.
- Nodes 12-33 are entry / exit management nodes for the second route R2-3.
- the communication processing unit 11A-34 controls the number of mobile bodies 10A existing in the second path R2-3.
- the communication processing unit 11A-33 manages the mobile body 10A that enters the second route R2-3 and the mobile body 10A that exits from the second route R2-3.
- the communication processing unit 11A-33 manages the number of moving bodies 10A existing in the second path R2-3, and the number of moving bodies 10A entering in the second path R2-3 becomes a certain number or more. Is being prevented.
- the communication processing unit 11A-33 may also manage the identification information of the mobile body 10A existing in the second path R2-3.
- the communication processing unit 11A-33 determines whether or not the mobile body 10A permits entry to the second path R2-3 when the mobile body 10A enters the second path R2-3. As an example, the communication processing unit 11A-33 allows only one mobile body 10A to input to the second path R2-3. When one mobile body 10A exists in the second path R2-3, the communication processing unit 11A-33 refuses to enter the second and subsequent mobile bodies 10A-3. For example, as illustrated in FIG. 16, the mobile body 10A-1 exists in the second path R2-3.
- the communication processing unit 11A-33 manages the number of mobile bodies 10A existing in the second path R2-3. Upon receiving the admission request from the mobile body 10A-2 to the second route R2-3, the communication processing unit 11A-33 confirms the number of the mobile body 10A existing in the second route R2-3.
- the admission request may be, for example, a reservation application.
- the communication processing unit 11A-33 refuses the moving body 10A-2 to enter the second path R2-3 and moves. Have body 10A-2 wait in front of the second path R2-3.
- the communication processing unit 11A-33 communicates with the mobile body 10A-2 and has the node 12-34 stand by.
- the communication processing unit 11A-33 permits the mobile body 10A-2 to enter.
- the communication processing unit 11A-33 allows the moving body 10A-2 to enter the second path R2-3.
- a permission signal indicating that permission is permitted is transmitted to the moving body 10A-2. Upon receiving the permission signal, the mobile body 10A-2 starts entering the second path R2-3.
- the moving body 10A-2 when the moving body 10A-2 exists in the second path R2-3, the moving body 10A-2 is a communication processing unit if the moving body 10A goes through the second path R2-3 instead of entering the second path R2-3. It is not necessary to receive the permission signal from 11A-33. That is, the mobile body 10A-2 can move without transmitting an entrance request if it only passes through the entrance / exit management node. In the example shown in FIG. 16, if the moving body 10A-2 passes through the node 12-34, the node 12-33, and the node 12-36 in this order, the admission request is not transmitted to the communication processing unit 11A-33. It may go through nodes 12-33.
- the communication processing unit 11A-33 may allow not only one mobile body 10A but also a plurality of mobile bodies 10A to enter the second path R2-3.
- the communication processing unit 11A-33 may allow the entry of a plurality of mobile bodies 10A up to the number of terminal nodes in the second path R2-3.
- a node 12 where the two paths intersect hereinafter referred to as "intersection node"
- the communication processing unit 11A corresponding to)) can manage the entry / exit of the moving body 10A with respect to the crossing node.
- entry / exit management of an intersection node is to control the number of moving bodies 10A passing through the intersection node and the direction of passage.
- FIG. 17 is a flowchart of the operation of entrance management by the communication processing unit 11A of the entrance / exit management node.
- the communication processing unit 11A determines whether or not an admission request has been received from the mobile body 10A (step S401). If the communication processing unit 11A has not received the admission request from the mobile body 10A, the communication processing unit 11A returns to the processing of step S401.
- the communication processing unit 11A receives an admission request from the mobile body 10A, whether or not the number of mobile bodies 10A existing in the second path R2 is smaller than the number of terminal nodes in the second path R2. Is determined (step S402).
- the communication processing unit 11A permits entry of the mobile body 10A (step S403). ..
- the communication processing unit 11A refuses to enter the mobile body 10A (step S404).
- the second path R2-4 shown in FIG. 18 has four terminal nodes of node 12-44, node 12-47, node 12-52, and node 12-53.
- the entry / exit management node of the second route R2-4 is the node 12-41.
- the communication processing unit 11A-41 of the node 12-41 receives an admission request from the moving body 10A into the second path R2-4
- the moving body 10A in the second path R2-4 is the second path.
- the admission of the moving body 10A is permitted on condition that the number of nodes is less than the number of terminal nodes in R2-4. Therefore, up to four mobile bodies 10A can exist at the same time in the second path R2-4.
- the intersecting nodes of the second route R2-4 are nodes 12-43, nodes 12-45, and nodes 12-49. Therefore, the communication processing unit 11A-43, the communication processing unit 11A-45, and the communication processing unit 11A-49 each execute the entry / exit management of the corresponding node 12 on a one-to-one basis.
- the communication processing unit 11A of the crossing node manages the entrance / exit of the crossing node according to the number of terminal nodes after the connection destination of the crossing node.
- the communication processing unit 11-43 manages the number of moving bodies 10A that are allowed to go to the node 12-44 on the left side to one, and the moving body 10A that is allowed to go to the node 12-45 on the upper side. Manage the number to 3 units.
- FIG. 19 is a flowchart of the operation of admission management by the communication processing unit 11A at the intersection node.
- the communication processing unit 11A-m has a direction in which the moving body 10A can leave from the node 12-m, which is an intersection node (hereinafter, referred to as "exiting direction"), and an upper limit of the number of moving bodies 10A that can move in the leaving direction. Information is stored in advance for each exit direction.
- the communication processing unit 11A-m determines whether or not an admission request to the crossing node has been received from the mobile body 10A (step S501). When the communication processing unit 11A receives an entry request from the mobile body 10A to the crossing node, the communication processing unit 11A reads the exit direction of the mobile body 10A from the entrance request.
- the communication processing unit 11A-m determines whether or not the number of moving bodies 10A read in the exit direction is less than the upper limit of the number of moving bodies 10A in the exit direction (step S502). When the number of moving objects 10A in the exit direction read is less than the upper limit of the number of moving objects 10A in the exit direction, the communication processing unit 11A-m permits entry to the intersection node ( Step S503). When the number of moving objects 10A in the exit direction read reaches the upper limit of the number of moving objects 10A in the exit direction, the communication processing unit 11A-m refuses to enter the crossing node (step S504). ).
- the communication processing unit 11A-69 in the second path R2 detects a hard conflict by using the method described in the first embodiment.
- the communication processing unit 11A-69 asks the moving body 10A-2 to move to the node 12-71 which is an intersection node.
- the first evacuation process requested to is executed.
- the mobile body 10A-2 starts moving to the node 12-71.
- the communication processing unit 11A-71 transmits a temporary evacuation destination capable of avoiding a collision with the moving body 10A-1 to the moving body 10A-2. 2 Execute the save process.
- the communication processing unit 11A-71 may determine, for example, a temporary evacuation destination of the mobile body 10A-2 based on the movement path of the mobile body 10A-1.
- the temporary evacuation destination is, for example, nodes 12-72.
- the mobile body 10A-2 Upon receiving the information on the temporary evacuation destination, the mobile body 10A-2 starts moving to the temporary evacuation destination.
- the moving body 10A-1 moves to a target location (for example, node 12-76) while the moving body 10A-2 is moving to the temporary evacuation destination or after the moving body 10A-2 is moved to the temporary evacuation destination. Moving.
- the mobile body 10A can reach the destination based on the movement route.
- FIG. 21 is a flowchart of the operation of the save process.
- the communication processing unit 11A determines whether or not there is a possibility of collision between the moving bodies 10A in the second path R2 (step S601). When the communication processing unit 11A determines that there is a possibility of collision between the moving bodies 10A in the second path R2, one of the two moving bodies 10A that may collide is the moving body 10A. An interrupt instruction is given to (step S602).
- One mobile body 10A is, for example, a mobile body 10A far from the entrance / exit management node.
- One of the moving bodies 10A that has received the interrupt instruction moves to the node 12 (for example, the crossing node) located in the direction of avoiding the collision.
- the communication processing unit 11A corresponding to the crossing node of the moving destination determines the temporary evacuation destination of the one moving body 10A based on the information of the moving route of the other moving body 10A (step S603). Then, after the one moving body 10A moves to the crossing node in the direction of avoiding the collision with the other moving body 10A, the communication processing unit 11A of the crossing node temporarily evacuates to the one moving body 10A. The previous information is transmitted (step S604). As a result, one of the moving bodies 10A can move to the temporary evacuation destination, and collisions between the moving bodies 10A are avoided.
- the mobile system 1A according to the second embodiment is the same as the mobile system 1 of the first embodiment, and the mobile body 10A is a communication corresponding to the node to be passed, which is the node to be passed. Communicates with the processing unit 11A. Then, the communication processing unit 11A instructs at least one or more moving bodies 10A among the plurality of moving bodies 10A to temporarily wait or change the route based on the communication with the plurality of moving bodies 10A. More specifically, the number of mobile bodies 10A that the communication processing unit 11A corresponding to the entry / exit management node connected to the first path R1 to the second path R2 can enter in the second path R2 is determined in the second path R2. In, the number is limited to the number in which collisions between moving bodies 10A can be avoided. With such a configuration, the mobile system 1A can avoid collisions and plan a more efficient movement path in the second path R2.
- ... part described in the specification means a unit for processing at least one function or operation, which may be embodied as hardware or software, or hardware and software. It may be embodied in combination.
- the computer may include a processor such as a CPU and GPU and a computer-readable recording medium. Then, a program for realizing all or a part of the functions of the mobile system 1 on the computer is recorded on the computer-readable recording medium, and the program recorded on the recording medium is read by the processor. It may be realized by executing it.
- the "computer-readable recording medium” refers to a portable medium such as a flexible disk, a magneto-optical disk, a ROM, or a CD-ROM, or a storage device such as a hard disk built in a computer system.
- a "computer-readable recording medium” is a communication line for transmitting a program via a network such as the Internet or a communication line such as a telephone line, and dynamically holds the program for a short period of time. It may also include a program that holds a program for a certain period of time, such as a volatile memory inside a computer system that is a server or a client in that case. Further, the above program may be for realizing a part of the above-mentioned functions, and may be further realized for realizing the above-mentioned functions in combination with a program already recorded in the computer system. It may be realized by using a programmable logic device such as FPGA.
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
エリア内の複数のノードの間を移動し、前記ノードにおいて動作の変更が可能な移動体と、前記移動体と通信可能であり、各前記ノードに対応して設けられた複数の通信処理部と、を備え、前記移動体は、通過予定の前記ノードである通過予定ノードに対応する前記通信処理部と通信を行い、前記通信処理部は、複数の前記移動体との前記通信に基づき、前記複数の移動体のうち、少なくとも一つ以上の前記移動体に対して一時待機又は経路変更を指示する、移動体システムである。
Description
本発明は、移動体システム及びその制御方法に関する。
本願は、2020年12月9日に、日本に出願された特願2020-204268に基づき優先権を主張し、その内容をここに援用する。
本願は、2020年12月9日に、日本に出願された特願2020-204268に基づき優先権を主張し、その内容をここに援用する。
施工現場の省人化を目指して、様々なロボットの開発を進められている。これらのロボットを現場に導入する際には、複数のロボットが同じ現場に配置され、これらが協力しながら施工を進めていくシステムが考えられる。
このようなシステムでは、ロボットの増加に伴いシステムの大規模化や複雑化が生じ得る。そのため、複数のロボットの動作の管理・制御をコンピュータなどで中央集権的に一元管理する従来の手法では、コンピュータの計算コスト、デバイス間の通信コストや通信遅延などによりロボット同士の衝突などを回避することができず、ロボットの動作を継続させることができない事象が起こり得る。なお、このような問題は、ロボットに限定されず、エリア内を移動可能な種々な移動体に共通する問題である。
本発明は、このような事情に鑑みてなされたもので、その目的は、エリア内で動作させる移動体の数が増加した場合であっても、移動体の動作を継続することができる移動体システム及び制御方法を提供することである。
(1)本発明の一態様は、エリア内の複数のノードの間を移動し、前記ノードにおいて動作の変更が可能な移動体と、前記移動体と通信可能であり、各前記ノードに対応して設けられた複数の通信処理部と、を備え、前記移動体は、通過予定の前記ノードである通過予定ノードに対応する前記通信処理部と通信を行い、前記通信処理部は、複数の前記移動体との前記通信に基づき、前記複数の移動体のうち、少なくとも一つ以上の前記移動体に対して一時待機又は経路変更を指示する、移動体システムである。
(2)上記(1)の移動体システムであって、前記移動体は、前記通過予定ノードを通過する通過予定時間を計算し、前記通信として前記通過予定時間に前記通過予定ノードを通るための予約申請を当該通過予定ノードに対応する前記通信処理部に対して行い、前記通信処理部は、複数の前記移動体のそれぞれから予約申請された各前記通過予定時間のうち一部又は全部が重複する場合には、前記複数の移動体のうち、少なくとも一つ以上の前記移動体に対して一時待機又は経路変更を指示してもよい。
(3)上記(2)の移動体システムであって、前記通信処理部は、各前記通過予定時間のうち一部又は全部が重複する場合には、想定される衝突の種類を判定する判定部と、前記判定部の判定結果に応じて前記複数の移動体のうち、少なくとも一つ以上の前記移動体に対して一時待機又は経路変更を指示する指示部と、を備えてもよい。
(4)上記(3)の移動体システムであって、前記指示部は、前記判定部が判定した衝突の種類が、いずれかの前記移動体の一時待機で衝突が回避できる衝突である場合には、前記一部又は全部が重複する時間帯がある前記複数の予約申請のうち、前記予約申請を行った時間が遅い方の前記移動体に一時待機を指示してもよい。
(5)上記(4)の移動体システムであって、前記指示部は、前記判定部が判定した衝突の種類が、前記一時待機で衝突が回避できない衝突である場合には、前記通過予定時間の一部又は全部が重複する前記予約申請を行った複数の前記移動体のうち、少なくとも一つ以上の前記移動体に対して経路変更を指示してもよい。
(6)上記(2)から上記(5)のいずれかの移動体システムであって、前記通過予定ノードは、現在から所定時間先までにおいて前記移動体が通過する前記ノードであり、前記所定時間は、前記通過予定時間と前記移動体が実際に通過する通過時間との誤差が許容できる範囲内に設定されてもよい。
(7)上記(1)から上記(6)のいずれかの移動体システムであって、前記移動体が移動可能な経路のうち、巡回可能な第1経路から巡回できない第2経路につながる前記ノードである入退場管理ノードに対応する前記通信処理部は、前記第2経路内に入場できる前記移動体の数を、前記第2経路内において前記移動体同士の衝突を回避可能な数に制限してもよい。
(8)上記(7)の移動体システムであって、前記通信処理部は、前記第2経路内の2台の前記移動体の各前記通過予定時間のうち一部又は全部が重複する場合には、前記2台の前記移動体のうち一方の前記移動体に対して、割込み指示を行うことで他方の前記移動体との衝突を回避する方向に前記一方の前記移動体を移動させてもよい。
(9)上記(8)の移動体システムであって、前記通信処理部は、前記一方の前記移動体が、前記他方の前記移動体との衝突を回避する方向にある前記ノードに移動した場合には、前記他方の前記移動体の行先情報に基づいて、前記他方の前記移動体との衝突を回避可能な前記ノードである一時退避先を前記一方の前記移動体に指示してもよい。
(10)上記(1)から上記(9)のいずれかの移動体システムであって、前記移動体は、資材を運搬するロボットであってもよい。
(11)本発明の一態様は、エリア内の複数のノードの間を移動し、前記ノードにおいて動作の変更が可能な移動体と、前記移動体と通信可能であり、各前記ノードに対応して設けられた複数の通信処理部と、を備える移動体システムの制御方法であって、前記移動体は、通過予定の前記ノードである通過予定ノードに対応する前記通信処理部と通信を行い、前記通信処理部は、複数の前記移動体との前記通信に基づき、前記複数の移動体のうち、少なくとも一つ以上の前記移動体に対して一時待機又は経路変更を指示する、制御方法である。
(12)上記(11)の制御方法であって、前記移動体が、前記通過予定ノードを通過する通過予定時間を計算し、前記通信として通過予定時間に前記通過予定ノードを通るための予約申請を当該通過予定ノードに対応する前記通信処理部に対して行い、前記通信処理部が、複数の前記移動体のそれぞれから予約申請された各前記通過予定時間のうち一部又は全部が重複する場合には、前記複数の移動体のうち、少なくとも一つ以上の前記移動体に対して一時待機又は経路変更を指示してもよい。
(13)上記(11)又は上記(12)の制御方法であって、前記移動体が移動可能な経路のうち、巡回可能な第1経路から巡回できない第2経路につながる前記ノードである入退場管理ノードに対応する前記通信処理部は、前記第2経路内に入場できる前記移動体の数を、前記第2経路内において前記移動体同士の衝突を回避可能な数に制限してもよい。
以上説明したように、本発明によれば、現場で動作させる移動体の数が増加した場合であっても、移動体の動作を継続することができる。
以下、発明の実施の形態を通じて本発明を説明するが、以下の実施形態は特許請求の範囲にかかる発明を限定するものではない。また、実施形態の中で説明されている特徴の組み合わせの全てが発明の解決手段に必須であるとは限らない。なお、図面において、同一又は類似の部分には同一の符号を付して、重複する説明を省く場合がある。また、図面における要素の形状及び大きさなどはより明確な説明のために誇張されることがある。
明細書の全体において、ある部分がある構成要素を「含む」、「有する」や「備える」とする時、これは、特に反対の記載がない限り、他の構成要素を除くものではなく、他の構成要素をさらに含むことができるということを意味する。
<第1の実施形態>
図1は、第1の実施形態に係る移動体システム1の概略構成図である。第1の実施形態に係る移動体システム1は、複数の移動体10-1~10-n(nは2以上の整数)及び複数の通信処理部11-1~11-k(kは2以上の整数)を備える。なお、複数の移動体10-1~10-nのそれぞれを区別しない場合には、「移動体10」と称する。また、複数の通信処理部11-1~11-kのそれぞれを区別しない場合には、「通信処理部11」と称する。
図1は、第1の実施形態に係る移動体システム1の概略構成図である。第1の実施形態に係る移動体システム1は、複数の移動体10-1~10-n(nは2以上の整数)及び複数の通信処理部11-1~11-k(kは2以上の整数)を備える。なお、複数の移動体10-1~10-nのそれぞれを区別しない場合には、「移動体10」と称する。また、複数の通信処理部11-1~11-kのそれぞれを区別しない場合には、「通信処理部11」と称する。
複数の移動体10は、あるエリア内を移動する。第1の実施形態の移動体10は、建材などを運搬する運搬車を例に説明するが、これに限定されず、あるエリア内を移動可能であればよい。例えば、移動体10は、ドローンなどの小型の飛行体であってもよい。また、移動体10は、土木工事や建築工事に使用されるロボットであってもよく、例えば、重運搬車両、ショベルカー、ブルドーザあるいはクレーン車であってもよい。移動体10は、有人であってもよいし、無人であってもよい。各移動体10には、予め移動経路が設定されている。
移動体10は、エリア内の複数のノード12の間を移動し、ノード12において動作の変更が可能である。動作の変更とは、移動体10の移動方向を変更したり、移動を一時停止したりすることである。このように、移動体10は、ノード12の間を移動しながら指定された目的の場所へ移動する。
図2は、第1の実施形態に係るノード12を説明する図である。図2は、エリアを真上から見た図である。ノード12は、エリア内の各所に設定されている。移動体10は、ノード12の間を移動しながら資材を目的地まで運搬したり、資材置き場に移動して資材を積み込んだりする。ノード12は、センサーや通信端末で移動体10の有無を検知できるエリア内の領域の他、エリア内に設けられた仮想の領域でもよい。
各通信処理部11は、各移動体10と通信ネットワークNWを介して通信可能であり、各ノード12に対応して設けられる。通信処理部11は、各ノード12が設定された位置に配置されてもよいし、異なった位置に配置されてもよい。通信処理部11-m(m=1、2、…、k)は、ノード12-mに対応しても設けられる。なお、以下の説明において、いずれのノード12-mに対応するかを示すハイフン以下の符号(あるいは最初のハイフンと続く数字または記号からなる符号)を省略する場合がある。
通信処理部11-mは、移動体10と通信ネットワークNWを介して情報を送受しながら、ノード12-mを通過する移動体10とその移動体10がノード12-mを通過する時間(以下、「通過予定時間」という。)とを管理する通過管理を行う。すなわち、通信処理部11-mは、いつの時間帯にどの移動体10がノード12-mを通過するかを管理する。なお、通過予定時間とは、ある時間帯を示すものである。例えば、ノード12-mの通過予定時間とは、移動体10がノード12-(m-1)からノード12-mに向けて移動することを仮定すると、ノード12-(m-1)からノード12-mに向けて移動を開始する時間からノード12-mに到着するまでの時間帯である。通信処理部11-mは、複数の移動体10の間においてノード12-mを通過する通過予定時間が一部でも重複しないように移動体10に対して動作の変更を指示したりする。
以下、第1の実施形態の通過管理について、図3を用いて説明する。図3は、第1の実施形態の通過管理を説明する図である。移動体10-1がノード12-1に位置しており、移動体10-2がノード12-2に位置している。そして、図3に示す例では、移動体10-1は、予め設定された移動経路に基づいて、5秒後から10秒後までの時間帯においてノード12-1からノード12-2に移動し、10秒後から15秒後までの時間帯においてノード12-2からノード12-3に移動し、15秒後から20秒後までの時間帯においてノード12-3からノード12-4に移動すると計算する。この場合には、移動体10-1は、移動体10-1の識別情報と通過予定時間(5秒から10秒)とを含む予約申請を通信処理部11-2に対して行う。また、移動体10-1は、移動体10-1の識別情報と通過予定時間(10秒から15秒)とを含む予約申請を通信処理部11-3に対して行う。また、移動体10-1は、移動体10-1の識別情報と通過予定時間(15秒から20秒)とを含む予約申請を通信処理部11-4に対して行う。
移動体10-2は、予め設定された移動経路に基づいて、4秒後から9秒後までの時間帯においてノード12-2からノード12-3に移動し、9秒後から14秒後までの時間帯においてノード12-3からノード12-4に移動すると計算する。この場合には、移動体10-2は、移動体10-2の識別情報と通過予定時間(4秒後から9秒後)とを含む予約申請を通信処理部11-3に対して行う。また、移動体10-2は、移動体10-2の識別情報と通過予定時間(9秒後から14秒後)とを含む予約申請を通信処理部11-4に対して行う。
これにより、通信処理部11-2は、移動体10-1が通過予定時間(5秒後から10秒後)においてノード12-2を通過するという情報を管理する。また、通信処理部11-3は、移動体10-2が通過予定時間(4秒後から9秒後)においてノード12-3を通過し、移動体10-1が通過予定時間(10秒後から15秒後)においてノード12-3を通過するという情報を管理する。また、通信処理部11-4は、移動体10-2が通過予定時間(9秒後から14秒後)においてノード12-4を通過し、移動体10-1が通過予定時間(15秒後から20秒後)においてノード12-4を通過するという情報を管理する。なお、通過予定時間においてノード12を通過するとは、通過予定時間にわたってノード12を占有することと同義である。
通信ネットワークNWは、無線通信の伝送路(例えば、無線LAN)であってもよく、無線通信の伝送路及び有線通信の伝送路の組み合わせであってもよい。通信ネットワークNWは、携帯電話回線網などの移動体通信網、無線パケット通信網、インターネット及び専用回線又はそれらの組み合わせであってもよい。例えば、通信ネットワークNWは、省電力広域ネットワーク(LPWAN:Low-power Wide-area)を用いてもよいし、短距離無線通信規格であるZigBee(登録商標)、WiFi(登録商標)、BLE等を用いてもよい。
以下において、第1の実施形態に係る移動体10の構成例について、図4を用いて説明する。図4は、第1の実施形態に係る移動体10の構成例を示す図である。
移動体10は、通信部20、格納部21及び制御部22を備える。これらの構成要素は、例えば、CPU(Central Processing Unit)等のハードウェアプロセッサがプログラム(ソフトウェア)を実行することにより実現される。また、これらの構成要素のうち一部または全部は、LSI(Large Scale Integrated circuit)やASIC(Application Specific Integrated Circuit)、FPGA(Field-Programmable Gate Array)、GPU(Graphics Processing Unit)等のハードウェア(回路部;circuitryを含む)によって実現されてもよいし、ソフトウェアとハードウェアの協働によって実現されてもよい。プログラムは、予めHDD(Hard Disk Drive)やフラッシュメモリ等の記憶装置(非一過性の記憶媒体を備える記憶装置)に格納されていてもよいし、DVDやCD-ROM等の着脱可能な記憶媒体(非一過性の記憶媒体)に格納されており、記憶媒体がドライブ装置に装着されることで記憶装置にインストールされてもよい。記憶装置は、例えば、HDD、フラッシュメモリ、EEPROM(Electrically Erasable Programmable Read Only Memory)、ROM(Read Only Memory)、またはRAM(Random Access Memory)等により構成される。
通信部20は、通信ネットワークNWを介して各通信処理部11-mと情報を送受する。
格納部21には、移動体10が移動する移動予定の移動経路が予め格納されている。この移動経路とは、例えば複数のノード12のうち、どのノード12を通過して目的地まで行くかを示す情報であって、移動体10の動作計画である。例えば、移動経路とは、通過予定のノード12(以下、「通過予定ノード」という。)及びどの通過予定ノードを何番目に通過するかなどの情報である。
また、格納部21には、移動体10を識別可能な識別情報(例えば、ID(identification))が格納されている。
制御部22は、移動体10の動作を制御する。制御部22は、格納部21に格納されている移動経路に基づいて、ノード12の間を移動しながら目的地まで移動体10を自律走行させる。制御部22は、格納部21に格納されている移動経路に基づいて、通過予定ノードを通過する通過予定時間を計算する。そして、制御部22は、通過予定ノードを通るための予約申請を当該通過予定ノードに対応する通信処理部11に対してそれぞれ行う。ここで、予約申請には、格納部21に格納されている識別情報と通過予定時間とが含まれる。
ここで、制御部22は、すべての通過予定ノードの通過予定時間を計算してもよいし、現在から所定時間先までにおいて移動体10が通過する通過予定ノードのみの通過予定時間を計算してもよい。この所定時間は、通過予定時間と移動体10が実際に通過する通過時間との誤差が許容できる範囲内において実験などにより設定されている。例えば、制御部22は、数秒先までに通過する各通過予定ノード(以下、「対象ノード」という。)に対してのみ通過予定時間を計算し、計算した通過予定時間に対象ノードを通るための予約申請を各対象ノードに対応する通信処理部11のそれぞれに対して行う。
図5は、第1の実施形態の対象ノードを説明する図である。図5に示す例では、ノード12-1を占有している移動体10-1の通過予定ノードとして、ノード12-2、ノード12-3、及びノード12-4が記載されている。ここで、例えば、現在から20秒先までに移動体10-1が通過する通過予定ノードを対象ノードと仮定する。図5に示す例では、ノード12-2の通過予定時間が2秒後から10秒後であり、ノード12-3の通過予定時間が10秒後から18秒後であり、ノード12-4の通過予定時間が20秒後から26秒後である。したがって、対象ノードは、ノード12-2及びノード12-3のみとなる。したがって、移動体10-1は、移動体10-1の識別情報と通過予定時間(2秒後から10秒後)とを含む予約申請を通信ネットワークNW経由で通信処理部11-2に行い、移動体10-1の識別情報と通過予定時間(10秒後から18秒後)とを含む予約申請を通信ネットワークNW経由で通信処理部11-3に行う。なお、移動体10-1がノード12-2またはノード12-3に移動した場合には、移動体10-1は、新たに対象ノードを決定し、その対象ノードに予約申請を行う。
制御部22は、予約申請の結果、その予約申請が通信処理部11で受け付けられれば、その通過予定時間通りに通過予定ノードを通過するように移動体10の動作を制御する。一方、制御部22は、予約申請の結果、予約申請が受け付けられず通信処理部11から動作の変更が指示された場合には、その指示に従って移動体10の動作を変更する。
以下において、第1の実施形態に係る通信処理部11の構成例について、図6を用いて説明する。図6は、第1の実施形態に係る通信処理部11の構成例を示す図である。なお、通信処理部11-mの各構成には、「-m」を付して他と区別する場合がある。
通信処理部11は、通信部30、格納部31、判定部32及び指示部33を備える。これらの構成要素は、例えば、CPU等のハードウェアプロセッサがプログラム(ソフトウェア)を実行することにより実現される。また、これらの構成要素のうち一部または全部は、LSIやASIC、FPGA、GPU等のハードウェア(回路部;circuitryを含む)によって実現されてもよいし、ソフトウェアとハードウェアの協働によって実現されてもよい。プログラムは、予めHDDやフラッシュメモリ等の記憶装置(非一過性の記憶媒体を備える記憶装置)に格納されていてもよいし、DVDやCD-ROM等の着脱可能な記憶媒体(非一過性の記憶媒体)に格納されており、記憶媒体がドライブ装置に装着されることで記憶装置にインストールされてもよい。記憶装置は、例えば、HDD、フラッシュメモリ、EEPROM、ROM、またはRAM等により構成される。
なお、通信処理部11は、実際の現場に小型マイコンなどを含む装置として配置してもよいし、クラウド上で仮想的に管理ノードとして構成されてもよい。
通信部30は、通信ネットワークNWを介して各移動体10の通信部20と情報を送受する。
格納部31には、通信処理部11が受け付けた予約申請の情報(以下、「予約情報」という。)が格納される。
判定部32は、複数の移動体10のそれぞれから予約申請された各通過予定時間のうち一部又は全部が重複する時間帯があるか否かを判定する。例えば、判定部32は、通信部30を介して移動体10から申請された予約申請を受け取る。判定部32は、受け取った予約申請の通過予定時間が、格納部31に格納された予約情報の通過予定時間(以下、「予約済み時間」という。)と重複していないか否かを確認する。
なお、以下の説明において、「重複」とは、少なくとも一部、すなわち一部または全部が重複することをいう。判定部32は、受け取った予約申請の通過予定時間が、予約済み時間と重複していないと判定した場合には、その予約申請を受け付け、受け付けた予約申請の情報を格納部31-mに格納する。一方、判定部32は、受け取った予約申請の通過予定時間が、予約済み時間と重複する場合には、移動体10同士が衝突する可能性があると判定する。
判定部32は、移動体10同士が衝突する可能性があると判定した場合には、想定される衝突の種類を判定する衝突種類判定を行う。ここで、衝突の種類とは、例えば、衝突する複数の移動体10のうち、いずれかの移動体10の一時待機で衝突を回避可能なソフトコンフリクトと、その一時待機では衝突を回避できないハードコンフリクトとのいずれかである。判定部32は、例えば、衝突する可能性がある複数の移動体10から各移動経路の情報を取得し、その移動経路上に衝突相手の移動体10が存在するか否かで衝突の種類を判定してもよい。
指示部33は、判定部32によって衝突の可能性があると判定された場合には、その衝突の可能性がある複数の移動体10のうち、少なくとも一つ以上の移動体10に対して一時待機又は経路変更を指示する。
例えば、指示部33は、判定部32が判定した衝突の種類がソフトコンフリクトである場合には、予約申請が遅かった方の移動体10に一時待機を指示する。一方、指示部33は、判定部32が判定した衝突の種類がハードコンフリクトである場合には、衝突する可能性のある複数の移動体10のうち、少なくとも一つ以上の移動体10に対して経路変更を指示する。ここで、経路変更を実行させる移動体10の決定は、指示部33が行ってもよいし、移動体10の間で決定してもよい。例えば、ハードコンフリクトである場合には、指示部33は、予約申請が遅かった方の移動体10に対して経路変更を指示してもよい。また、指示部33は、衝突する可能性がある複数の移動体10に対して移動経路の変更を指示する情報を通知して、その複数の移動体10の間で経路変更を行う移動体10を決定させてもよい。この場合には、移動体10同士で通信し、予め設定されたルールによっていずれか一方の移動体10が移動経路を変更する。
以下において、第1の実施形態に係る衝突判定について、図7を用いて説明する。図7は、第1の実施形態に係る衝突判定を説明する図である。
例えば、図7に示す例として、通信処理部11-4の格納部21-4には、移動体10-1の識別情報とノード12-4の通過予定時間t1(現在から40秒後)とを有する予約情報が格納されていると仮定する。ここで、通過予定時間t1(現在から40秒後)は、予約済み時間である。そして、移動体10-2は、移動経路からノード12-4の通過予定時間t2(18秒後から26秒後)を計算し、その予約申請を通信処理部11-4に行ったと仮定する。この場合には、判定部32-4は、格納部21-4に格納されている通過予定時間t1と、移動体10-2からの通過予定時間t2とを比較し、互いに時間が重複しないか否かを判定する。この例では、通過予定時間t2が通過予定時間t1と重複しているため、判定部32-4は、移動体10-1と移動体10-2との衝突が発生する可能性があると判定する。
次に、ソフトコンフリクトとハードコンフリクトについて、図8を用いて説明する。図8Aは、ソフトコンフリクトの一例を示す。図8Aは、ハードコンフリクトの一例を示す。なお、実線は移動体10-1の移動経路を示し、点線は移動体10-2の移動経路を示す。
ソフトコンフリクトは、例えば、図8Aに示すような三つのパターンが考えられる。いずれのパターンにおいても、ノード12-1において移動体10-1と移動体10-2とが衝突する可能性があるが、いずれかのノード12がその場で一時待機すればその衝突が回避可能である。すなわち、移動体10-1におけるノード12-1の通過予定時間と、移動体10-2におけるノード12-1の通過予定時間とを重複させずにずらすことができれば、移動体10-1と移動体10-2-との衝突を回避することができる。
ハードコンフリクトは、例えば、図8Bに示すような三つのパターンが考えられる。いずれのパターンにおいても、互いの移動経路上に衝突相手の移動体10が存在している。この場合には、いずれかの移動体10が一時待機したとしても移動経路上に衝突相手の移動体10が存在している以上、衝突は回避されない。そのため、例えば、移動体10-1と移動体10-2とのうち、いずれかの移動体10が移動経路を変更することでお互いの移動経路上に衝突相手の移動体10が存在する事象を解消する。これにより、移動体10-1と移動体10-2との衝突を回避することができる。
以下において、第1の実施形態に係る移動体10が資材を運搬する流れをおおまかに説明する。図9は、移動体10が資材を運搬する流れを説明する図である。図9に示す流れは、例えば、現場内の複数の移動体10とエレベータ100とが協調して資材を様々なフロアに運搬する場合などが考えられる。
まず、ユーザが通信情報端末(例えば、コンピュータ、スマートフォン、タブレット端末など)を操作して、移動体10が運搬する複数資材を設定する(図9(a))。そして、ユーザは、通信情報端末を操作して、設定された複数資材の中からどの移動体10がどの資材を運搬するかを選択する(図9(b))。資材運搬のタスクが割り当てられた移動体10は、指定された資材を積み込み(図9(c))、目的地までの移動経路に沿って移動して目的地まで運搬する。例えば、1Fの移動体10は、資材をエレベータ100まで運搬する(図9(d))。エレベータ100は、資材が持ち込まれると例えば、4Fへ上昇する(図9(e))。エレベータ100が4Fに到着すると、エレベータ100から直接的または間接的に4Fの移動体10に通知される。4Fの移動体10は、通知を受けとると、エレベータ100から資材を積み込み、目的地まで運搬する(図9(f))。なお、運搬を終えた移動体10は、新たなタスクが割り振れている場合にはそのタスクを実行し、割り振られていない場合には、待機場所に戻る。
以下において、第1の実施形態に係る移動体10の動作の流れを説明する。図10は、第1の実施形態に係る移動体10の動作のフローチャートである。
移動体10は、格納部21に格納されている移動経路に基づいて、現在から所定時間先までにおいて移動体10が通過するノード12である対象ノードのみの通過予定時間を計算する(ステップS101)。そして、移動体10は、計算した通過予定時間に対象ノードを通るための予約申請を各対象ノードに対応する通信処理部11のそれぞれに対して行う(ステップS102)。移動体10は、予約申請を行った後に、通信処理部11からの指示があるか否かを判定する(ステップS103)。
移動体10は、予約申請を行った後に、通信処理部11からの指示がない場合には、移動経路にしたがって移動を開始したり、移動を継続したりする(ステップS104)。一方、
移動体10は、予約申請を行った後に、通信処理部11からの指示があった場合には、その指示に応じて動作の変更を行う。例えば、移動体10は、通信処理部11からの指示があった場合には、その指示が一時待機の指示なのか、それとも移動経路の変更の指示なのかを判定する(ステップ105)。移動体10は、予約申請を行った後に、通信処理部11から一時待機の指示を受け取った場合には、その場で一時待機する(ステップS106)。なお、一時待機の指示には、待機時間が含まれてもよい。この場合には、移動体10は、その指示に含まれる待機時間が経過するまで待機した後に、移動経路にしたがって移動する。一時待機後から移動を開始する際には、移動体10は、ステップS101に戻り予約申請を行う処理を行う。
移動体10は、予約申請を行った後に、通信処理部11からの指示があった場合には、その指示に応じて動作の変更を行う。例えば、移動体10は、通信処理部11からの指示があった場合には、その指示が一時待機の指示なのか、それとも移動経路の変更の指示なのかを判定する(ステップ105)。移動体10は、予約申請を行った後に、通信処理部11から一時待機の指示を受け取った場合には、その場で一時待機する(ステップS106)。なお、一時待機の指示には、待機時間が含まれてもよい。この場合には、移動体10は、その指示に含まれる待機時間が経過するまで待機した後に、移動経路にしたがって移動する。一時待機後から移動を開始する際には、移動体10は、ステップS101に戻り予約申請を行う処理を行う。
移動体10は、予約申請を行った後に、通信処理部11から移動変更の指示を受け取った場合には、衝突相手の移動体10と通信して、移動変更する移動体10を決定する。なお、通信処理部11からの移動変更の指示には、衝突相手の移動体10を示す情報(例えば、識別情報)が含まれており、移動体10は、この情報に基づいて衝突相手の移動体10を特定することができる。例えば、移動体10は、衝突相手の移動体10と通信して、所定のルールに基づいて移動経路を変更するか否かを判断する。
なお、この所定のルールは、移動経路を変更する移動体10を決定できるものであればよく、そのルールの内容には特に限定されない。移動体10は、衝突相手が移動経路を変更する場合には、自身の移動経路の移動を継続する。一方、移動体10は、自身が移動経路を変更する場合には、格納部21に格納された移動経路を、衝突を回避する移動経路に変更し(ステップS107)、変更した移動経路に基づいて再度予約申請を行う。
以下において、第1の実施形態に係る通信処理部11の動作の流れを説明する。図11は、第1の実施形態に係る通信処理部11の動作のフローチャートである。
通信処理部11-mは、移動体10から予約申請を受け取ると(ステップS201)、その予約申請の通過予定時間が、格納部21-mに格納されている予約済み時間と重複するか否かを判定する(ステップS202)。通信処理部11-mは、予約申請の通過予定時間が、予約済み時間と重複しない場合には、その予約申請を受け付けて格納部21-mに予約申請の情報を格納する(ステップS203)。通信処理部11-mは、予約申請の通過予定時間が、予約済み時間と重複する場合には、予約申請を行った移動体10と、予約済み時間にノード12-mの通過が予約されている移動体10とが衝突する可能性があると判定し(ステップS204)、その衝突の種類を判定する(ステップS205)。
例えば、ステップS205において、通信処理部11-mは、衝突する可能性がある二つの移動体10の移動経路の情報をそれぞれネットワークNW経由で取得し、その移動経路上に衝突相手の移動体10が存在するか否かを判定する。
例えば、衝突する可能性がある二つの移動体10が移動体10-1と移動体10-2とである場合には、通信処理部11-mは、移動体10-1及び移動体10-2の現在位置と、移動体10-1の移動経路(以下、「第1移動経路」という。)と、移動体10-2の移動経路(以下、「第2移動経路」という。)とを取得する。現在位置とは、移動体10が位置しているノード12の情報である。通信処理部11-m(判定部32-m)は、第1移動経路上に移動体10-2が存在するか否かを判定する第1判定処理と、第2移動経路上に移動体10-1が存在するか否かを判定する第2判定処理と、を実行する。通信処理部11-mは、第1判定処理及び第2判定処理の結果、第1移動経路上に移動体10-2が存在し、且つ第2移動経路上に移動体10-1が存在すると判定した場合には、衝突がハードコンフリクトであると判定し、それ以外である場合には衝突がソフトコンフリクトであると判定する。
通信処理部11-mは、衝突の種類がソフトコンフリクトであると判定した場合には、後から予約申請した方の移動体10に対して一時待機を指示する(ステップS206)。通信処理部11-mは、衝突の種類がハードコンフリクトであると判定した場合には、衝突する可能性のある二つの移動体10に対して移動経路の変更を指示する(ステップS207)。
以上説明したように、第1の実施形態に係る移動体システム1は、複数の移動体10と複数の通信処理部11とを備える。移動体10は、あるエリア内の複数のノード12の間を移動し、ノード12において動作の変更が可能である。通信処理部11は、移動体10と通信可能であり、各ノード12に対応して設けられている。そして、移動体10は、通過予定のノード12である通過予定ノードに対応する通信処理部11と通信を行う。より具体的には、通過予定ノードを通過する通過予定時間を計算し、通過予定時間に通過予定ノードを通るための予約申請(通信)を当該通過予定ノードに対応する通信処理部11に対して行う。通信処理部11は、複数の移動体10のそれぞれから予約申請された各通過予定時間に基づき、複数の移動体のうち、少なくとも一つ以上の移動体10に対して一時待機又は経路変更を指示する。
このような構成により、複数の移動体10それぞれが自律的に行動を決定するため、数制限を設けずに移動体の動作を継続することができる。
ここで、現場で動作するロボットでは、通信の遅延などにより事前に決めた動作計画を定められた時間で動作することが保証されない。そのため、複数のロボットの動作の管理・制御をコンピュータなどで中央集権的に一元管理している従来の手法では、一つのロボットの動作の遅れにより、他のロボットの動作計画に影響を与えてしまい、その都度、一元管理するコンピュータが他の全てのロボットの動作計画を再計画する必要がある。その結果、複数のロボットの動作を長時間に亘って停止せざるを得ない事象が起こり、ロボットの動作を継続することができない場合がある。
第1の実施形態では、複数のロボットの動作の管理・制御をコンピュータなどで中央集権的に一元管理することなく、複数の移動体10それぞれが自律的に行動して衝突を回避可能であるため、一台の移動体10が故障しても移動体10の動作を継続することができる。
また、第1の実施形態では、移動体システム1は、すべての通過予定ノードではなく、現在から所定時間だけ先までの間に通過する予定の通過予定ノードに対してのみ予約申請を行ってもよい。上記所定時間を超える通過予定時間は、移動体10の動作の誤差などにより実際の通過時間との乖離が生じる場合がある。したがって、移動体システム1は、予約申請を行う通過予定ノードを所定時間先までに限定することにより、より正確な移動体10の通過管理を行うことができる。
<第2の実施形態>
第2の実施形態の移動体システム1Aについて説明する。以下の説明において、第1の実施形態で説明した内容と同様の機能を有する部分については、同様の名称および符号を付するものとし、その機能に関する具体的な説明は省略する。
第2の実施形態の移動体システム1Aについて説明する。以下の説明において、第1の実施形態で説明した内容と同様の機能を有する部分については、同様の名称および符号を付するものとし、その機能に関する具体的な説明は省略する。
図12は、第2の実施形態に係る移動体システム1Aの概略構成図である。移動体システム1Aは、複数の移動体10A-1~10A-n及び複数の通信処理部11A-1~11A-kを備える。なお、複数の移動体10A-1~10A-nのそれぞれを区別しない場合には、「移動体10A」と称する。複数の通信処理部11A-1~11A-kのそれぞれを区別しない場合には、「通信処理部11A」と称する。
移動体システム1Aは、第1の実施形態と比較して、移動体10Aが移動可能な経路のうち、巡回可能な第1経路R1から巡回できない第2経路R2に入場できる移動体10Aの数を制限する機能を有する点で異なる。
図13は、第1経路R1及び第2経路R2を説明する図である。例えば、図13に示す例では、あるエリアには、ノード12-1からノード12-10が配置されている。ノード12-1からノード12-10のうち、ノード12-1からノード12-7によって第1経路R1が形成されている。第1経路R1は、終端ノードが無い経路であり、移動体10によって巡回可能である。終端ノードとは、1つのノード12のみが接続されているノード12である。換言すれば、第1経路R1は、迂回路を形成することができるノード12の集まりである。ノード12-1からノード12-10のうち、ノード12-1,ノード12-8,ノード12-9,及びノード12-10によって第2経路R2が形成されている。 第2経路R2は、終端ノードを有する経路であり、移動体10Aによって巡回ができない経路である。換言すれば、第2経路R2は、迂回路を形成することができないノード12の集まりである。図13に示す例では、終端ノードは、ノード12-9及びノード12-10である。
第2経路R2内に従来の移動体が複数入場すると、第2経路R2内の1つ以上の移動体が一時待機したとしても、移動体同士の衝突を回避できない場合がある。第2の実施形態の移動体システム1Aは、第2経路R2に入場できる移動体10Aの数を、移動体10A同士の衝突を回避可能な数に制限する。これにより、移動体システム1Aは、第2経路R2内における移動体同士の衝突を抑制することができる。以下、第2の実施形態に係る移動体システム1Aの構成例を説明する。
複数の移動体10Aは、移動体10と同様に、あるエリア内を移動する。移動体10Aは、建材などを運搬する運搬車を例に説明するが、これに限定されず、あるエリア内を移動可能であればよい。例えば、移動体10Aは、ドローンなどの小型の飛行体であってもよい。また、移動体10Aは、土木工事や建築工事に使用されるロボットであってもよく、例えば、重運搬車両、ショベルカー、ブルドーザあるいはクレーン車であってもよい。移動体10Aは、有人であってもよいし、無人であってもよい。各移動体10Aには、予め目的の場所までの移動経路(行先情報)が設定されている。
移動体10Aは、第2経路R2内に入場する場合には、その第2経路R2のノード12に対応する通信処理部11Aに対して入場依頼を送信する。移動体10Aは、送信した入場依頼が許可された場合には、第2経路R2に入場する。
各通信処理部11Aは、第1の実施形態で説明した通信処理部11の通過管理の機能を有している。通信処理部11Aは、各移動体10Aと通信ネットワークNWを介して通信可能であり、各ノード12に対応して設けられる。通信処理部11Aの設置位置は、第1の実施形態で説明した通信処理部11と同様である。
通信処理部11Aは、移動体10Aの行き止まりが発生する第2経路R2を特定する。第1経路R1から第2経路R2につながるノード12(以下、「入退場管理ノード」という。)に対応する通信処理部11Aは、特定した第2経路R2内に入場できる移動体10Aの数を、第2経路R2内において移動体10A同士の衝突を回避可能な数に制限する入退場管理を行う。図13に示す例では、入退場管理ノードは、ノード12-1である。移動体10A同士の衝突を回避可能な数とは、例えば、1つの第2経路R2内に含まれる終端ノードの数以下である。図13に示す例では、移動体10A同士の衝突を回避可能な数とは、2以下である。第2経路R2の特定は、例えば、移動体10Aの移動が開始される前に実行される。
第2経路R2内の通信処理部11Aは、第2経路R2内の2台の移動体10A同士が衝突する可能性があると判定した場合には、2台の移動体10Aのうち、一方の移動体10Aに対して割込み指示を行うことで、他方の移動体10Aとの衝突を回避する方向に一方の移動体10Aを移動させる第1退避処理を実行する。通信処理部11Aは、第1退避処理を実行した後に、他方の移動体10Aの行先情報に基づいて、他方の移動体10Aとの衝突を回避可能なノード12である一時退避先に一方の移動体10Aを移動させる第2退避処理を実行する。
(第2経路R2の特定)
以下に、本実施形態の第2経路R2の特定方法について説明する。まず、図13を参照して、第2経路R2の特定方法の概要を説明する。
以下に、本実施形態の第2経路R2の特定方法について説明する。まず、図13を参照して、第2経路R2の特定方法の概要を説明する。
通信処理部11Aには、1対1で対応しているノード12が終端ノードであるか否かの情報が予め設定されている。通信処理部11A-mは、ノード12-mが終端ノードである場合には、その終端ノードに対して隣接して接続されているノード12に対応する通信処理部11Aに対して、ノード12-mが行き止まりノードであることを示す通知(以下、「行き止まり通知」という。)を行う。行き止まりノードとは、迂回することができない経路を形成するノード13である。この行き止まりノードは、終端ノードを含む。なお、行き止まり通知には、行き止まりノードであるノード12の識別情報を含んでもよい。
図13に示す例では、終端ノードは、行き止まりのノード12-9及びノード12-10である。ノード12-9は、ノード12-8に対して隣接しており、かつ接続されている。そのため、通信処理部11A-9は、通信処理部11A-8に対してノード12-9の行き止まり通知を行う。ノード12-10は、ノード12-8に対して隣接しており、かつ接続されている。そのため、通信処理部11A-10は、通信処理部11A-8に対してノード12-10の行き止まり通知を行う。
通信処理部11A-8は、行き止まり通知を受け取ると、1対1で対応しているノード12-8の接続先の中に、行き止まりノードではないノード12が2つ以上存在するか否かを判定する行き止まりノード判定を行う。ノード12の接続先とは、ノード12-8に対して隣接して接続されているノード12である。図13に示す例では、ノード12-8には、行き止まりノードではないノード12としてノード12-1しか接続されていない。したがって、ノード12-8は、行き止まりノードである。この場合には、通信処理部11A-8は、ノード12-1に対応する通信処理部11A-1に対して、行き止まり通知を行う。
通信処理部11A-1は、行き止まり通知を受け取ると、通信処理部11A-8と同様に、ノード12-1の接続先の中に、行き止まりノードではないノード12が2つ以上存在するか否かを判定する。図13に示す例では、ノード12-1には、行き止まりノードではないノード12としてノード12-2及びノード12-7が接続されている。通信処理部11A-1は、行き止まりノードではないノード12が2つ以上存在すると判定すると、ノード12-1を入退場管理ノードとして設定する。この場合には、行き止まりノード及び入退場管理ノードが第2経路R2として設定される。換言すると、ノード12-10、ノード12-9、ノード12-8及びノード12-1が、1つの第2経路R2としてグループ化される。第2経路R2の情報は、第2経路R2を構成する全てのノード12のそれぞれに1対1で対応する複数の通信処理部11A-1、11A-8~11A-10に記憶されてもよい。例えば、複数の通信処理部11A-1は、通信処理部11A-8~11A-10に対して、第2経路R2の情報を送信してもよい。
次に、第2経路R2の特定方法の具体例を、図14を用いて説明する。
図14に示すように、ノード12-20とノード12-21とは、終端ノードである。まず、通信処理部11A-20は、ノード12-20に隣接して接続されているノード12-22に対応する通信処理部11A-22に対して、ノード12-20の行き止まり通知を送信する。
通信処理部11A-22は、ノード12-20の行き止まり通知を受信すると、ノード12-22に対して行き止まりノード判定を行う。ノード12-22は、行き止まりノード以外のノードとして、ノード12-24しか接続されていない。そのため、ノード12-22は、行き止まりノードである。通信処理部11A-22は、ノード12-24に対して行き止まり通知を送信する。
通信処理部11A-21は、ノード12-21に隣接して接続されているノード12-23に対応する通信処理部11A-23に対して、行き止まり通知を送信する。通信処理部11A-23は、行き止まり通知を受信すると、ノード12-23に対して行き止まりノード判定を行う。ノード12-23は、行き止まりノード以外のノードとして、ノード12-24及びノード12-23の2つのノード12が接続されている。そのため、ノード12-23は、入退場管理ノードであると判定される。すなわち、ノード12-21とノード12-23とが1つの第2経路R2-1を構成するグループとして設定される。
通信処理部11A-22は、ノード12-24に対応する通信処理部11A-24に対して行き止まり通知を送信する。通信処理部11A-24は、行き止まり通知を受信すると、ノード12-24に対して入退場管理ノード判定を行う。ノード12-24は、行き止まりノード以外のノードとして、ノード12-23しか接続されておらず、行き止まりノードである。通信処理部11A-24は、ノード12-23に対応する通信処理部11A-23に対して、ノード12-24の行き止まり通知を送信する。
通信処理部11A-23は、ノード12-24の行き止まり通知を受信すると、ノード12-23に対して行き止まりノード判定を行う。ここで、ノード12-21及びノード12-24は、行き止まりノードである。そのため、通信処理部11A-23は、行き止まりノード以外のノードとしてノード12-25のみがノード12-23に接続されていると判定する。すなわち、通信処理部11A-23は、ノード12-23が行き止まりノードであると判定する。ただし、通信処理部11A-23は、ノード12-23が行き止まりノードではないとして、すでに第2経路R2-1として設定されている。そのため、通信処理部11A-23は、第2経路R2-1のグループを解消する。通信処理部11A-23は、通信処理部11A-25に対して、ノード12-23の行き止まり通知を行う。
通信処理部11A-25は、ノード12-25の行き止まりノード判定を行う。通信処理部11A-25は、行き止まりノード以外のノード12として、ノード12-26のみがノード12-25に接続されていると判定する。換言すると、通信処理部11A-25は、ノード12-25が行き止まりノードであると判定する。通信処理部11A-25は、通信処理部11A-26に対して、ノード12-25の行き止まり通知を行う。
通信処理部11A-26は、ノード12-25の行き止まり通知を受信すると、ノード12-26に対して行き止まりノード判定を行う。ノード12-26には、行き止まりノード以外のノードとしてノード12-27及びノード12-29が接続されている。そのため、通信処理部11A-26は、ノード12-26が行き止まりノードではないと判定する。換言すれば、通信処理部11A-26は、ノード12-26が入退場管理ノードであると判定する。これにより、これまで行き止まりノードとして判定されたノード12-20からノード12-25及び入退場管理ノードであるノード12-26が1つの第2経路R2-2を構成するグループとして設定される。
(第2経路R2の設定の流れ)
次に、行き止まり通知を受信した通信処理部11Aの動作の流れについて、図15を用いて説明する。図15は、行き止まり通知を受信した通信処理部11Aのフローチャートである。
次に、行き止まり通知を受信した通信処理部11Aの動作の流れについて、図15を用いて説明する。図15は、行き止まり通知を受信した通信処理部11Aのフローチャートである。
通信処理部11Aは、行き止まり通知を受け取ると、1対1で対応しているノード12の接続先の中に、行き止まりノードではないノード12が2つ以上存在するか否かを判定する行き止まりノード判定を行う(ステップS301)。通信処理部11Aは、行き止まりノードではないノード12が2つ以上存在しないと判定した場合には、1対1で対応しているノード12が行き止まりノードであると判定する。行き止まりノードには、行き止まりノードではないノード12が1つしか接続されていない。通信処理部11Aは、1対1で対応しているノード12が行き止まりノードである場合には、そのノード12に接続されている行き止まりノードではないノード12の通信処理部11Aに対して、行き止まり通知を送信する(ステップS302)。
通信処理部11Aは、ステップS301において、行き止まりノードではないノード12が2つ以上存在すると判定した場合には、1対1で対応しているノード12が入退場管理ノードであると判定する。この場合には、終端ノードから入退場管理ノードまでのノード12がグループ化され、そのグループ化されたノード群が第2経路R2として設定される(ステップS303)。
(第2経路R2の入退場管理)
以下に、本実施形態における第2経路R2の入退場管理について説明する。まず、図16を参照して、第2経路R2の入退場管理の概要を説明する。
以下に、本実施形態における第2経路R2の入退場管理について説明する。まず、図16を参照して、第2経路R2の入退場管理の概要を説明する。
図16に示す例では、ノード12-30~12-33が第2経路R2-3としてグループ化されている。ノード12-33は、この第2経路R2-3の入退場管理ノードである。通信処理部11A-34は、第2経路R2-3内に存在する移動体10Aの数を制御している。通信処理部11A-33は、第2経路R2-3内に入場する移動体10A及び第2経路R2-3内から退場する移動体10Aを管理している。通信処理部11A-33は、第2経路R2-3内に存在する移動体10Aの数を管理しており、第2経路R2-3内に入場する移動体10Aの数が一定以上になることを防止している。通信処理部11A-33は、第2経路R2-3内に存在する移動体10Aの識別情報も管理してもよい。
通信処理部11A-33は、移動体10Aが第2経路R2-3に入場する場合に、移動体10Aが第2経路R2-3の入場を許可するか否かを判定する。一例として、通信処理部11A-33は、1台の移動体10Aのみ第2経路R2-3への入力を許可する。通信処理部11A-33は、1台の移動体10Aが第2経路R2-3内に存在する場合には、2台目以降の移動体10A-3の入場を拒否する。例えば、図16に例示するように、移動体10A-1は、第2経路R2-3内に存在している。通信処理部11A-33は、第2経路R2-3内に存在する移動体10Aの数を管理している。通信処理部11A-33は、移動体10A-2から第2経路R2-3への入場依頼を受信すると、第2経路R2-3内に存在する移動体10Aの数を確認する。入場依頼とは、例えば、予約申請であってもよい。
通信処理部11A-33は、第2経路R2-3内に移動体10A-1が存在しているため、移動体10A-2が第2経路R2-3に入場することを拒否して、移動体10A-2に対して第2経路R2-3の前で待機してもらう。図16に示す例では、通信処理部11A-33は、移動体10A-2に対して通信してノード12-34で待機してもらう。通信処理部11A-33は、移動体10A-1が第2経路R2-3から退場した場合には、移動体10A-2の入場を許可する。例えば、通信処理部11A-33は、第2経路R2-3に対する移動体10A-2の入場を許可する場合には、移動体10A-2に対して、第2経路R2-3内の入場を許可することを示す許可信号を移動体10A-2に送信する。移動体10A-2は、許可信号を受信すると、第2経路R2-3内への入場を開始する。
なお、移動体10A-2は、第2経路R2-3内に移動体10Aが存在している場合において、第2経路R2-3に入場するのではなく経由することであれば、通信処理部11A-33からの許可信号を受信しなくてもよい。すなわち、移動体10A-2は、入退場管理ノードを経由するだけであれば入場依頼を送信せずに移動可能である。図16に示す例では、移動体10A-2がノード12-34、ノード12-33及びノード12-36の順に通るのであれば、通信処理部11A-33に対して入場依頼を送信せずにノード12-33を経由してもよい。
通信処理部11A-33は、1台の移動体10Aのみではなく、複数の移動体10Aを第2経路R2-3に入場させてもよい。例えば、通信処理部11A-33は、第2経路R2-3内の終端ノードの数を上限に、複数の移動体10Aの入場を許可してもよい。複数の移動体10Aを第2経路R2に入場させる場合には、第2経路R2内での移動体10A同士の衝突を回避するため、2つの経路が交わるノード12(以下、「交差ノード」という。)に対応する通信処理部11Aは、交差ノードに対する移動体10Aの入退場を管理することができる。例えば、交差ノードの入退場管理とは、交差ノードを通過する移動体10Aの数や通過する方向を制御することである。
(第2経路R2内の入退場管理の流れ)
次に、入退場管理ノードの通信処理部11Aによる入場管理の動作の流れについて、図17を用いて説明する。図17は、入退場管理ノードの通信処理部11Aによる入場管理の動作のフローチャートである。
次に、入退場管理ノードの通信処理部11Aによる入場管理の動作の流れについて、図17を用いて説明する。図17は、入退場管理ノードの通信処理部11Aによる入場管理の動作のフローチャートである。
通信処理部11Aは、移動体10Aから入場依頼を受信したか否かを判定する(ステップS401)。通信処理部11Aは、移動体10Aから入場依頼を受信していない場合には、ステップS401の処理に戻る。通信処理部11Aは、移動体10Aから入場依頼を受信した場合には、第2経路R2内に存在する移動体10Aの数が、その第2経路R2内の終端ノード数よりも少ないか否かを判定する(ステップS402)。通信処理部11Aは、第2経路R2内に存在する移動体10Aの数が、その第2経路R2内の終端ノード数よりも少ない場合には、移動体10Aの入場を許可する(ステップS403)。通信処理部11Aは、第2経路R2内に存在する移動体10Aの数が、その第2経路R2内の終端ノード数である場合には、移動体10Aの入場を拒否する(ステップS404)。
(交差ノードの入退場管理)
以下に、本実施形態に係る交差ノードの入退場管理について説明する。まず、図18を参照して、交差ノードの入退場管理に説明する。
以下に、本実施形態に係る交差ノードの入退場管理について説明する。まず、図18を参照して、交差ノードの入退場管理に説明する。
図18に示す第2経路R2-4は、ノード12-44、ノード12-47、ノード12-52、及びノード12-53の4つの終端ノードを有している。第2経路R2-4の入退場管理ノードは、ノード12-41である。ノード12-41の通信処理部11A-41は、移動体10Aから第2経路R2-4内への入場依頼を受信した場合には、第2経路R2-4内の移動体10Aが第2経路R2-4内の終端ノード数より少ないことを条件に、移動体10Aの入場を許可する。したがって、第2経路R2-4内において、最大4台の移動体10Aが同時に存在することできる。
第2経路R2-4の交差ノードは、ノード12-43、ノード12-45、及びノード12-49である。したがって、通信処理部11A-43、通信処理部11A-45及び通信処理部11A-49は、それぞれ1対1で対応するノード12の入退場管理を実行する。例えば、交差ノードの通信処理部11Aは、交差ノードの接続先以降にある終端ノードの数に応じて交差ノードの入退場を管理する。例えば、通信処理部11-43は、左側のノード12-44に向かうことを許可する移動体10Aの数を1台に管理し、上側のノード12-45に向かうことを許可する移動体10Aの数を3台に管理する。
ここで、ノード12-43から上側にある複数のノード12にすでに3台の移動体10Aが存在していると仮定する。この場合において、新たな移動体10Aが、ノード12-43を経由して上側に移動しようとする場合、通信処理部11A-43は、ノード12-43の通過を認めず移動体10Aに対して、現在の位置で待機することを命ずる。このような構成により、移動体10Aが一時退避できるノード12が確保される。その結果、第2経路R2内でのハードコンフリクトの解消が可能となる。
(交差ノードの入場管理の流れ)
次に、交差ノードにおける通信処理部11Aによる入場管理の動作の流れについて、図19を用いて説明する。図19は、交差ノードにおける通信処理部11Aによる入場管理の動作のフローチャートである。
次に、交差ノードにおける通信処理部11Aによる入場管理の動作の流れについて、図19を用いて説明する。図19は、交差ノードにおける通信処理部11Aによる入場管理の動作のフローチャートである。
通信処理部11A-mは、交差ノードであるノード12-mから移動体10Aが退場できる方向(以下、「退場方向」という。)とその退場方向に移動できる移動体10Aの数の上限との情報を、退場方向ごとに予め有している。通信処理部11A-mは、移動体10Aから交差ノードへの入場依頼を受信したか否かを判定する(ステップS501)。通信処理部11Aは、移動体10Aから交差ノードへの入場依頼を受信すると、その入場依頼から移動体10Aの退場方向を読み取る。通信処理部11A-mは、読み取った退場方向における移動体10Aの数が、その退場方向における移動体10Aの数の上限よりも少ない数であるか否かを判定する(ステップS502)。通信処理部11A-mは、読み取った退場方向における移動体10Aの数が、その退場方向における移動体10Aの数の上限よりも少ない数である場合には、交差ノードへの入場を許可する(ステップS503)。通信処理部11A-mは、読み取った退場方向における移動体10Aの数が、その退場方向における移動体10Aの数の上限に達している場合には、交差ノードへの入場を拒否する(ステップS504)。
(退避処理)
以下に、本実施形態に係る交差ノードの入退場管理について説明する。まず、図20を参照して、交差ノードの入退場管理に説明する。
以下に、本実施形態に係る交差ノードの入退場管理について説明する。まず、図20を参照して、交差ノードの入退場管理に説明する。
第2経路R2内の通信処理部11A-69は、第1の実施形態で説明した方法を用いて、ハードコンフリクトを検知したとする。通信処理部11A-69は、移動体10A-1と移動体10A-2とのハードコンフリクトを検知すると、移動体10A-2に対して、交差ノードであるノード12-71に移動してもらうように要請する第1退避処理を実行する。要請を受けた移動体10A-2は、ノード12-71への移動を開始する。移動体10-2がノード12-71への移動を完了した後、通信処理部11A-71は、移動体10A-1との衝突を回避できる一時退避先を移動体10A-2に送信する第2退避処理を実行する。通信処理部11A-71は、例えば、移動体10A-1の移動経路に基づいて、移動体10A-2の一時退避先を決定してもよい。図20に示す例では、一時退避先は、例えばノード12-72である。移動体10A-2は、一時退避先の情報を受信すると、一時退避先への移動を開始する。移動体10A-1は、移動体10A-2が一時退避先に移動している間、又は移動体10A-2が一時退避先に移動した後に、目的の場所(例えば、ノード12-76)へ移動する。
第2経路R2の入退場管理により、第2経路R2内に存在する移動体10Aの数が制限されているため、一時退避先の確保が保証されている。したがって、移動体10Aは、移動経路に基づいて目的地まで到達することができる。
(退避処理の流れ)
次に、退避処理の動作の流れについて、図21を用いて説明する。図21は、退避処理の動作のフローチャートである。
次に、退避処理の動作の流れについて、図21を用いて説明する。図21は、退避処理の動作のフローチャートである。
通信処理部11Aは、第2経路R2内において、移動体10A同士の衝突の可能性があるか否かを判定する(ステップS601)。通信処理部11Aは、第2経路R2内において、移動体10A同士の衝突の可能性があると判定した場合には、衝突する可能性のある2つの移動体10Aのうち、一方の移動体10Aに対して割込み指示を行う(ステップS602)。一方の移動体10Aとは、例えば入退場管理ノードから遠い方の移動体10Aである。割り込み指示を受信した一方の移動体10Aは、衝突を回避する方向に位置しているノード12(例えば、交差ノード)に移動する。移動先の交差ノードに対応する通信処理部11Aは、他方の移動体10Aの移動経路の情報に基づいて、一方の移動体10Aの一時退避先を決定する(ステップS603)。そして、一方の移動体10Aが、他方の移動体10Aとの衝突を回避する方向にある交差ノードに移動した後に、その交差ノードの通信処理部11Aは、一方の移動体10Aに対して一時退避先の情報を送信する(ステップS604)。これにより、一方の移動体10Aが一時退避先に移動することが可能となり、移動体10A同士の衝突が回避される。
以上説明したように、第2の実施形態に係る移動体システム1Aは、第1の実施形態の移動体システム1と同様、移動体10Aは、通過予定のノードである通過予定ノードに対応する通信処理部11Aと通信を行う。そして通信処理部11Aは、複数の移動体10Aとの通信に基づき、複数の移動体10Aのうち、少なくとも一つ以上の移動体10Aに対して一時待機又は経路変更を指示する。より具体的には、第1経路R1から第2経路R2につながる入退場管理ノードに対応する通信処理部11Aが、第2経路R2内に入場できる移動体10Aの数を、第2経路R2内において移動体10A同士の衝突を回避可能な数に制限する。このような構成により、移動体システム1Aは、第2経路R2内において、衝突を回避し、より効率のよい移動経路を計画することができる。
以上、この発明の実施形態について図面を参照して詳述してきたが、具体的な構成はこの実施形態に限られるものではなく、この発明の要旨を逸脱しない範囲の設計等も含まれる。
また、明細書に記載の「…部」の用語は、少なくとも1つの機能や動作を処理する単位を意味し、これは、ハードウェアまたはソフトウェアとして具現されてもよいし、ハードウェアとソフトウェアとの組み合わせで具現されてもよい。
なお、上述した移動体システム1の全部または一部をコンピュータで実現するようにしてもよい。この場合、上記コンピュータは、CPU、GPUなどのプロセッサ及びコンピュータ読み取り可能な記録媒体を備えてもよい。そして、上記移動体システム1の全部または一部の機能をコンピュータで実現するためのプログラムを上記コンピュータ読み取り可能な記録媒体に記録して、この記録媒体に記録されたプログラムを上記プロセッサに読み込ませ、実行することによって実現してもよい。ここで、「コンピュータ読み取り可能な記録媒体」とは、フレキシブルディスク、光磁気ディスク、ROM、CD-ROM等の可搬媒体、コンピュータシステムに内蔵されるハードディスク等の記憶装置のことをいう。さらに「コンピュータ読み取り可能な記録媒体」とは、インターネット等のネットワークや電話回線等の通信回線を介してプログラムを送信する場合の通信線のように、短時間の間、動的にプログラムを保持するもの、その場合のサーバやクライアントとなるコンピュータシステム内部の揮発性メモリのように、一定時間プログラムを保持しているものも含んでもよい。また上記プログラムは、前述した機能の一部を実現するためのものであってもよく、さらに前述した機能をコンピュータシステムにすでに記録されているプログラムとの組み合わせで実現できるものであってもよく、FPGA等のプログラマブルロジックデバイスを用いて実現されるものであってもよい。
1,1A 移動体システム
10,10A 移動体
11,11A 通信処理部
12 ノード
20,30 通信部
21,31 格納部
22 制御部
32 判定部
33 指示部
10,10A 移動体
11,11A 通信処理部
12 ノード
20,30 通信部
21,31 格納部
22 制御部
32 判定部
33 指示部
Claims (13)
- エリア内の複数のノードの間を移動し、前記ノードにおいて動作の変更が可能な移動体と、
前記移動体と通信可能であり、各前記ノードに対応して設けられた複数の通信処理部と、
を備え、
前記移動体は、通過予定の前記ノードである通過予定ノードに対応する前記通信処理部と通信を行い、
前記通信処理部は、複数の前記移動体との前記通信に基づき、前記複数の移動体のうち、少なくとも一つ以上の前記移動体に対して一時待機又は経路変更を指示する、
移動体システム。 - 前記移動体は、前記通過予定ノードを通過する通過予定時間を計算し、前記通信として前記通過予定時間に前記通過予定ノードを通るための予約申請を当該通過予定ノードに対応する前記通信処理部に対して行い、
前記通信処理部は、複数の前記移動体のそれぞれから予約申請された各前記通過予定時間のうち一部又は全部が重複する場合には、前記複数の移動体のうち、少なくとも一つ以上の前記移動体に対して一時待機又は経路変更を指示する、
請求項1に記載の移動体システム。 - 前記通信処理部は、
各前記通過予定時間のうち一部又は全部が重複する場合には、想定される衝突の種類を判定する判定部と、
前記判定部の判定結果に応じて前記複数の移動体のうち、少なくとも一つ以上の前記移動体に対して一時待機又は経路変更を指示する指示部と、
を備える、
請求項2に記載の移動体システム。 - 前記指示部は、前記判定部が判定した衝突の種類が、いずれかの前記移動体の一時待機で衝突が回避できる衝突である場合には、前記一部又は全部が重複する時間帯がある前記複数の予約申請のうち、前記予約申請を行った時間が遅い方の前記移動体に一時待機を指示する、
請求項3に記載の移動体システム。 - 前記指示部は、前記判定部が判定した衝突の種類が、前記一時待機で衝突が回避できない衝突である場合には、前記通過予定時間の一部又は全部が重複する前記予約申請を行った複数の前記移動体のうち、少なくとも一つ以上の前記移動体に対して経路変更を指示する、
請求項4に記載の移動体システム。 - 前記通過予定ノードは、現在から所定時間先までにおいて前記移動体が通過する前記ノードであり、
前記所定時間は、前記通過予定時間と前記移動体が実際に通過する通過時間との誤差が許容できる範囲内に設定されている、
請求項2から5のいずれか一項に記載の移動体システム。 - 前記移動体が移動可能な経路のうち、巡回可能な第1経路から巡回できない第2経路につながる前記ノードである入退場管理ノードに対応する前記通信処理部は、前記第2経路内に入場できる前記移動体の数を、前記第2経路内において前記移動体同士の衝突を回避可能な数に制限する、
請求項1から6のいずれか一項に記載の移動体システム。 - 前記通信処理部は、前記第2経路内の2台の前記移動体の各前記通過予定時間のうち一部又は全部が重複する場合には、前記2台の前記移動体のうち一方の前記移動体に対して、割込み指示を行うことで他方の前記移動体との衝突を回避する方向に前記一方の前記移動体を移動させる、
請求項7に記載の移動体システム。 - 前記通信処理部は、前記一方の前記移動体が、前記他方の前記移動体との衝突を回避する方向にある前記ノードに移動した場合には、前記他方の前記移動体の行先情報に基づいて、前記他方の前記移動体との衝突を回避可能な前記ノードである一時退避先を前記一方の前記移動体に指示する、
請求項8に記載の移動体システム。 - 前記移動体は、資材を運搬するロボットである、
請求項1から9のいずれか一項に記載の移動体システム。 - エリア内の複数のノードの間を移動し、前記ノードにおいて動作の変更が可能な移動体と、前記移動体と通信可能であり、各前記ノードに対応して設けられた複数の通信処理部と、を備える移動体システムの制御方法であって、
前記移動体は、通過予定の前記ノードである通過予定ノードに対応する前記通信処理部と通信を行い、
前記通信処理部は、複数の前記移動体との前記通信に基づき、前記複数の移動体のうち、少なくとも一つ以上の前記移動体に対して一時待機又は経路変更を指示する、
制御方法。 - 前記移動体が、前記通過予定ノードを通過する通過予定時間を計算し、前記通信として通過予定時間に前記通過予定ノードを通るための予約申請を当該通過予定ノードに対応する前記通信処理部に対して行い、
前記通信処理部が、複数の前記移動体のそれぞれから予約申請された各前記通過予定時間のうち一部又は全部が重複する場合には、前記複数の移動体のうち、少なくとも一つ以上の前記移動体に対して一時待機又は経路変更を指示する、
請求項11に記載の制御方法。 - 前記移動体が移動可能な経路のうち、巡回可能な第1経路から巡回できない第2経路につながる前記ノードである入退場管理ノードに対応する前記通信処理部は、前記第2経路内に入場できる前記移動体の数を、前記第2経路内において前記移動体同士の衝突を回避可能な数に制限する、
請求項11又は12に記載の制御方法。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020-204268 | 2020-12-09 | ||
JP2020204268 | 2020-12-09 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2022124374A1 true WO2022124374A1 (ja) | 2022-06-16 |
Family
ID=81973318
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2021/045378 WO2022124374A1 (ja) | 2020-12-09 | 2021-12-09 | 移動体システム及びその制御方法 |
Country Status (1)
Country | Link |
---|---|
WO (1) | WO2022124374A1 (ja) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63316603A (ja) * | 1987-06-19 | 1988-12-23 | Mitsubishi Electric Corp | 荷役機械の衝突防止制御装置 |
JPH0423108A (ja) * | 1990-05-18 | 1992-01-27 | Toshiba Corp | 無人搬送車自動制御装置 |
JPH07219633A (ja) * | 1993-12-10 | 1995-08-18 | Shinko Electric Co Ltd | 運行管理制御装置およびその方法 |
JPH11119830A (ja) * | 1997-10-17 | 1999-04-30 | Murata Mach Ltd | 無人搬送車システム |
JP2006195859A (ja) * | 2005-01-17 | 2006-07-27 | Murata Mach Ltd | 搬送車システム |
JP2009026265A (ja) * | 2007-07-24 | 2009-02-05 | Hitachi Plant Technologies Ltd | 無人搬送車装置 |
JP2011227716A (ja) * | 2010-04-20 | 2011-11-10 | Toyota Industries Corp | 無人搬送車走行方法及び無人搬送車走行システム |
-
2021
- 2021-12-09 WO PCT/JP2021/045378 patent/WO2022124374A1/ja active Application Filing
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63316603A (ja) * | 1987-06-19 | 1988-12-23 | Mitsubishi Electric Corp | 荷役機械の衝突防止制御装置 |
JPH0423108A (ja) * | 1990-05-18 | 1992-01-27 | Toshiba Corp | 無人搬送車自動制御装置 |
JPH07219633A (ja) * | 1993-12-10 | 1995-08-18 | Shinko Electric Co Ltd | 運行管理制御装置およびその方法 |
JPH11119830A (ja) * | 1997-10-17 | 1999-04-30 | Murata Mach Ltd | 無人搬送車システム |
JP2006195859A (ja) * | 2005-01-17 | 2006-07-27 | Murata Mach Ltd | 搬送車システム |
JP2009026265A (ja) * | 2007-07-24 | 2009-02-05 | Hitachi Plant Technologies Ltd | 無人搬送車装置 |
JP2011227716A (ja) * | 2010-04-20 | 2011-11-10 | Toyota Industries Corp | 無人搬送車走行方法及び無人搬送車走行システム |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR102160968B1 (ko) | 자율주행 로봇 장치 및 자율 주행 방법 | |
JP4621073B2 (ja) | ロボット制御装置 | |
JP2020149370A (ja) | 運行計画システム、運行計画方法及びコンピュータプログラム | |
TW201812971A (zh) | 行走車系統及行走車系統的控制方法 | |
WO2018190960A1 (en) | Roadmap annotation for deadlock-free multi-agent navigation | |
JP7204631B2 (ja) | 走行制御装置、方法及びコンピュータプログラム | |
US11656625B2 (en) | System for evacuating one or more mobile robots | |
JP6636107B1 (ja) | エレベータを用いた搬送システム、これに用いるエレベータ、およびエレベータ制御方法 | |
JP2019537730A (ja) | ナビゲーションデータを生成し、対象物を搬送する方法及びシステム | |
JP2021071891A (ja) | 走行制御装置、走行制御方法、及びコンピュータプログラム | |
US10598496B2 (en) | Local navigation system | |
JPWO2019198330A1 (ja) | 搬送車システム及び搬送車制御方法 | |
US9298185B2 (en) | Traveling vehicle system | |
JP7237799B2 (ja) | 走行制御装置及び運行システム | |
WO2022124374A1 (ja) | 移動体システム及びその制御方法 | |
EP3164675B1 (en) | Allocation of facilities on a route | |
JP4093245B2 (ja) | 自律移動装置 | |
JPH0224706A (ja) | 走行予約閉塞制御による無人搬送装置 | |
WO2021020092A1 (ja) | 駐車支援装置、及び駐車支援方法 | |
KR102622482B1 (ko) | 자율 주행 차량을 제어하는 전자 장치 및 시스템 | |
CN115676542A (zh) | 一种乘梯调度方法、系统、设备及介质 | |
JP6369232B2 (ja) | 走行車システム | |
JP7509288B1 (ja) | 移動体管理装置、移動体管理システム、移動体管理方法、および移動体管理プログラム | |
JP7334839B1 (ja) | 割当制御装置、割当方法、割当制御プログラム、および記録媒体 | |
WO2023190480A1 (ja) | 自律移動装置管理システム、自律移動装置管理方法及びプログラム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 21903473 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 21903473 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: JP |