Nothing Special   »   [go: up one dir, main page]

WO2024202133A1 - 制御方法、プログラム及び移動体 - Google Patents

制御方法、プログラム及び移動体 Download PDF

Info

Publication number
WO2024202133A1
WO2024202133A1 PCT/JP2023/035345 JP2023035345W WO2024202133A1 WO 2024202133 A1 WO2024202133 A1 WO 2024202133A1 JP 2023035345 W JP2023035345 W JP 2023035345W WO 2024202133 A1 WO2024202133 A1 WO 2024202133A1
Authority
WO
WIPO (PCT)
Prior art keywords
turning
route
waypoint
path
moving body
Prior art date
Application number
PCT/JP2023/035345
Other languages
English (en)
French (fr)
Inventor
健司 ▲高▼尾
祐介 筈井
Original Assignee
三菱重工業株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 三菱重工業株式会社 filed Critical 三菱重工業株式会社
Publication of WO2024202133A1 publication Critical patent/WO2024202133A1/ja

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/40Control within particular dimensions
    • G05D1/43Control of position or course in two dimensions

Definitions

  • This disclosure relates to a control method, a program, and a moving object.
  • Patent Document 1 describes an omnidirectional mobile dolly that can also pivot by having four driven and steerable wheels.
  • a mobile body capable of pivoting like this can adjust its travel route more flexibly than a mobile body that cannot pivot. For this reason, there is a demand for mobile bodies that can pivot to move along an appropriate route.
  • the present disclosure aims to provide a control method, program, and vehicle capable of moving a vehicle capable of pivot turning along an appropriate path.
  • the control method disclosed herein is a method for controlling a moving body capable of normal turning, which turns around a rotation center outside the vehicle body as viewed vertically, and pivot turning, which turns around a rotation center inside the vehicle body as viewed vertically, and includes the steps of: setting a destination position for the moving body; acquiring movable information indicating positions to which the moving body can move in a working area in which the moving body moves; setting a route to the destination position passing through the movable positions based on the destination position and the movable information, a turning position at which the moving body turns, and a turning mode for either normal turning or pivot turning at the turning position; and moving the moving body based on the route, the turning position, and the turning mode.
  • the program disclosed herein is a program that causes a computer to execute a method for controlling a moving body capable of normal turning, which turns around a center of rotation outside the vehicle body as viewed vertically, and pivot turning, which turns around a center of rotation inside the vehicle body as viewed vertically, and causes a computer to execute the steps of: setting a destination position for the moving body; acquiring movable information indicating positions to which the moving body can be moved in a working area in which the moving body moves; setting a route to the destination position passing through the movable positions based on the destination position and the movable information, a turning position at which the moving body turns, and a turning mode for either normal turning or pivot turning at the turning position; and moving the moving body based on the route, the turning position, and the turning mode.
  • the moving body according to the present disclosure is a moving body capable of normal turning, which turns around the outside of the vehicle body as seen from the vertical direction, and pivot turning, which turns around the inside of the vehicle body as seen from the vertical direction, and includes a path acquisition unit that acquires the path of the moving body, the turning position at which the moving body turns, and the turning mode, which is either normal turning or pivot turning at the turning position, and a movement control unit that moves the moving body based on the path, the turning position, and the turning mode, and the path, the turning position, and the turning mode are set based on a destination position of the moving body and mobility information that indicates positions to which the moving body can move in a working area to which the moving body moves, and the path is a path that passes through the movable positions toward the destination position.
  • a moving object capable of pivot turning can be made to move along an appropriate path.
  • FIG. 1 is a schematic diagram of a mobility control system according to the present embodiment.
  • FIG. 2 is a schematic diagram of the configuration of a moving body.
  • FIG. 3 is a schematic diagram of a wheel as viewed from above.
  • FIG. 4 is a schematic diagram for explaining normal turning.
  • FIG. 5 is a schematic diagram for explaining a pivot turn.
  • FIG. 6 is a schematic block diagram of the management device.
  • FIG. 7 is a schematic block diagram of an information processing device.
  • FIG. 8 is a schematic block diagram of a control device for a moving body.
  • FIG. 9 is a schematic diagram showing an example of a route.
  • FIG. 10 is a schematic diagram showing an example of a route.
  • FIG. 11 is a flowchart illustrating a setting flow based on a predicted time.
  • FIG. 11 is a flowchart illustrating a setting flow based on a predicted time.
  • FIG. 12 is a schematic diagram illustrating an example in which an object is unloaded into an installation area.
  • FIG. 13 is a schematic diagram illustrating an example of moving from an installation area to a travel waypoint.
  • FIG. 14 is a schematic diagram illustrating an example of a case where an object is unloaded into an installation area.
  • FIG. 15 is a schematic diagram illustrating an example of a case where an object is unloaded into an installation area.
  • FIG. 16 is a schematic diagram illustrating an example of a case where an object is unloaded into an installation area.
  • FIG. 17 is a schematic diagram for explaining an example of a case where an object loaded from a temporary installation area is unloaded onto a transportation vehicle.
  • FIG. 18 is a schematic diagram for explaining an example of a case where an object loaded from a temporary installation area is unloaded onto a transportation vehicle.
  • FIG. 19 is a schematic diagram for explaining an example of a case where an object loaded from a temporary installation area is unloaded onto a transportation vehicle.
  • FIG. 20 is a schematic diagram showing an example of a case where a target is moved while being held at a high position.
  • FIG. 1 is a schematic diagram of a movement control system according to the present embodiment.
  • the movement control system 1 includes a moving body 10, a management device 12, and an information processing device 14.
  • the movement control system 1 is a system that controls the movement of a moving body 10 belonging to a facility W.
  • the facility W is, for example, a facility that is managed by logistics, such as a warehouse, but may be any facility that operates a moving body 10.
  • the moving body 10 picks up an object P arranged in the facility W, transports it, and drops it to another location.
  • the object P transported by the moving body 10 is a transport object with luggage loaded on a pallet.
  • the object P is not limited to a pallet with luggage loaded on it, and may be any form, for example, it may be only luggage without a pallet.
  • the moving body 10 is not limited to a device that transports the object P, and may be a device that moves within the facility W for any purpose.
  • a work area AR is set in the facility W.
  • the work area AR is an area in which the mobile body 10 of this embodiment performs work.
  • the work area AR is an area in which the mobile body 10 is deployed, and the mobile body 10 can move within the work area AR.
  • the mobile body 10 may not be able to move, for example, in a parking area ARV described later or an area in which an object P or a fixed object P0 (for example, a pillar or a wall in the facility W) is located.
  • the mobile body 10 may be able to move within the parking area ARV or the temporary installation area AR1.
  • one direction along the work area AR is defined as the X direction
  • a direction along the work area AR that intersects with the direction X is defined as the Y direction.
  • the Y direction is a direction perpendicular to the X direction.
  • the X direction and the Y direction may be said to be directions along a horizontal plane.
  • the direction perpendicular to the X-direction and Y-direction, more specifically the vertical upward direction, is defined as the Z-direction.
  • position refers to a position (coordinate) in a coordinate system on a two-dimensional surface on the working area AR (the coordinate system of the working area AR).
  • attitude (orientation)" of the moving body 10, etc. refers to the orientation of the moving body 10, etc. in the coordinate system of the working area AR, and refers to the yaw angle (rotation angle) of the moving body 10 when the X-direction is set to 0° when viewed from the Z direction.
  • the working area AR is a so-called truck berth, and includes a parking area ARV where the transport vehicle V is parked, and a moving area ARW where the mobile body 10 can move.
  • the parking area ARV is an area for parking the transport vehicle V
  • the moving area ARW is an area of the working area AR other than the parking area ARV. It is preferable that the transport vehicle V is parked in a predetermined position and attitude with respect to the parking area ARV.
  • the transport vehicle V is a mobile body that transports the loaded object P in a section inside and outside the facility W. For example, the transport vehicle V arrives at the facility W with the loaded object P and stops in the parking area ARV, and the loaded object P is carried out by the mobile body 10.
  • the mobile body 10 may load the object P onto the transport vehicle V stopped in the parking area ARV.
  • the transport vehicle V is a truck, but is not limited to this, and may be any mobile body that transports the object P, such as a railroad car.
  • the transport vehicle V is provided with a storage room Va in which the object P is placed.
  • a door Vb is provided on both sides of the transport vehicle V. With the door Vb open, the mobile body 10 approaches the storage room Va from the side of the transport vehicle V where the door Vb is provided (here, the side side), thereby picking up the object P in the storage room VA or dropping the object P into the storage room Va.
  • the transport vehicle V is not limited to one with the door Vb provided on the side, and the door Vb may be provided at any position of the transport vehicle V (for example, the rear).
  • a temporary installation area AR1 in which the target object P is placed is also set in the working area AR.
  • the temporary installation area AR1 is set in a part of the moving area ARW.
  • the moving body 10 can enter the temporary installation area AR1 in which the target object P is not placed.
  • the working area AR is set on the X-direction side and the opposite side to the X-direction of the parking area ARV in the working area AR.
  • the position and number of the temporary installation area AR1 are arbitrary, and may be set at any position other than the parking area ARV.
  • the temporary installation area AR1 is a temporary storage area for the target object P. That is, for example, depending on the operating status of the equipment W, the target object P loaded on the transport vehicle V or the target object P to be loaded on the transport vehicle V may be temporarily placed in the temporary installation area AR1.
  • the object P temporarily placed in the temporary installation area AR1 is transported to another location (for example, a transport vehicle V or an installation area AR2 described below).
  • the use of the installation area AR2 is not limited to being a temporary storage area.
  • the installation area AR2 may be an area for any purpose in which the object P is placed.
  • the temporary installation area AR1 includes multiple unit areas A.
  • a unit area A is an area set for the installation of an object P, and can be said to be an area where an object P may be installed.
  • the shape and size of the unit area A are set in advance. In the example of FIG. 1, the unit area A is rectangular, but the shape and size may be arbitrary.
  • the unit area A is divided into areas for each object P, and one object P is placed in each unit area A. Depending on the status of the equipment W, an object P may or may not be placed in each unit area A.
  • the unit areas A are set in the temporary installation area AR1 lined up in the Y direction, but the arrangement and number of unit areas A within the temporary installation area AR1 may be arbitrary.
  • the working area AR there is one working area AR, but multiple working areas AR may be provided. That is, for example, multiple working areas AR including a parking area ARV and a movement area ARW may be set side by side in the X direction. Furthermore, the working area AR is not limited to being a truck berth including a parking area ARV and a movement area ARW, but may be any area in which the mobile body 10 moves (works).
  • the equipment W also includes an area ARa in which an installation area AR2 is provided.
  • the area ARa is provided adjacent to the work area AR (movement area ARW), and in the example of FIG. 1, it is located on the opposite side of the work area AR (movement area ARW) in the Y direction.
  • the moving body 10 in the work area AR can drop an object P in the area ARa and pick up the object P placed in the area ARa, but it is preferable not to move within the area ARa.
  • the area ARa is located on the Z direction side of the work area AR (i.e., it is set at a higher position than the work area AR), and the moving body 10 cannot enter the area ARa from within the work area AR.
  • the moving body 10 in the work area AR may also be able to enter the area ARa, and for example, the area ARa and the work area AR may be set at the same height.
  • the object P may be transported to that storage area by the mobile body 10 that picked up the object P in the working area AR.
  • the installation area AR2 is an area provided in the area ARa for placing the object P.
  • the mobile body 10 in the work area AR drops the object P picked up from the transport vehicle V or the temporary installation area AR1 into the installation area AR2.
  • the mobile body 10 in the work area AR also picks up the object P placed in the installation area AR2 and transports it to the transport vehicle V or the temporary installation area AR1.
  • the installation area AR2 is a temporary storage area, and the object P dropped into the installation area AR2 by the mobile body 10 is transported to another storage location by another mobile body deployed in the area ARa.
  • the object P on the installation area AR2 picked up by the mobile body 10 is transported from another location in the area ARa to the installation area AR2 by another mobile body deployed in the area ARa.
  • the use of the installation area AR2 is not limited to being a temporary storage area.
  • the installation area AR2 may be an area for any purpose in which the object P is installed.
  • the installation area AR2 includes multiple unit areas A.
  • the unit areas A are set in the installation area AR2 aligned in the X direction, but the arrangement and number of unit areas A within the installation area AR2 may be arbitrary.
  • a waypoint WP In the working area AR, a waypoint WP is set for each position (coordinate).
  • a first route R1 of the moving body 10, which will be described later, is set to connect the waypoints WP. That is, a route that connects the waypoints WP that the moving body 10 is scheduled to pass through becomes the first route R1 of the moving body 10.
  • the waypoints WP are set according to the layout of the working area AR.
  • the waypoints WP may be set in a matrix shape in the moving area ARW.
  • the position where the object P is placed in the parking area ARV is set in advance so as to correspond to the position where the object P is placed in the storage room Va of the transport vehicle V.
  • the waypoints WP are also set in the traveling area ARW at positions corresponding to the position where the object P is placed in the parking area ARV.
  • the waypoints WP are set for each unit area A of the temporary installation area AR1 in the traveling area ARW.
  • the waypoints WP are set at positions (coordinates) corresponding to each unit area A.
  • the waypoint WP is set at a position (coordinates) corresponding to each unit area A.
  • the position corresponding to the unit area A (the position where the waypoint WP is set) may be set appropriately, and may be, for example, any position that overlaps with the unit area A.
  • the waypoint WP may be set for each unit area A of the installation area AR2 within the working area AR, and may be set at a position (coordinates) corresponding to each unit area A.
  • waypoints WP corresponding to the parking area ARV are lined up in the Y direction, and on the approachable side of these waypoints WP (the X direction side and the opposite side to the X direction in the example of FIG. 9), route waypoints WPA, which are waypoints WP lined up in the Y direction, are set.
  • route waypoints WPA which are waypoints WP lined up in the Y direction
  • approach waypoints WPB which are multiple waypoints WP
  • a waypoint WP corresponding to the temporary installation area AR1 is set.
  • the moving body 10 is a device capable of moving automatically.
  • the moving body 10 is a device capable of transporting an object. More specifically, in this embodiment, the moving body 10 is a forklift, more specifically, a so-called AGV (Automated Guided Vehicle) or AGF (Automated Guided Forklift).
  • AGV Automated Guided Vehicle
  • AGF Automatic Guided Forklift
  • the moving body 10 is not limited to being a forklift that transports an object, and may be any device capable of moving automatically.
  • the moving body 10 includes a vehicle body 20, a wheel 20A, a straddle leg 21, a mast 22, a fork 24, a sensor 26A, and a control device 28.
  • the straddle leg 21 is a pair of shaft-shaped members provided at one end of the vehicle body 20 in the fore-aft direction and protruding from the vehicle body 20.
  • the mast 22 is movably attached to the straddle leg 21 and moves in the fore-aft direction of the vehicle body 20.
  • the mast 22 extends along a vertical direction (direction Z here) perpendicular to the fore-aft direction.
  • the fork 24 is movably attached to the mast 22 in direction Z.
  • the fork 24 may also be movable in the lateral direction of the vehicle body 20 (a direction intersecting the vertical and fore-aft directions) relative to the mast 22.
  • the fork 24 has a pair of claws 24A, 24B.
  • the claws 24A, 24B extend from the mast 22 toward the rear of the vehicle body 20.
  • Claws 24A and 24B are spaced apart from each other in the lateral direction of mast 22.
  • the front direction on the side of moving body 10 where fork 24 is not provided is referred to as the front direction
  • the direction on the side where fork 24 is provided is referred to as the rear direction.
  • Sensor 26A detects at least one of the position and posture of an object present around the vehicle body 20. It can also be said that sensor 26A detects at least one of the position of an object relative to the moving body 10 and the posture of the object relative to the moving body 10.
  • sensor 26A is provided at the rear end of each straddle leg 21 and on the forward side of the vehicle body 20.
  • the position at which sensor 26A is provided is not limited to this, and sensor 26A may be provided at any position, and the number of sensors provided may also be arbitrary.
  • sensor 26A may be provided at the upper end of mast 22.
  • Sensor 26A is, for example, a sensor that irradiates laser light. Sensor 26A irradiates laser light while scanning in one direction (here, the horizontal direction) and detects the position and orientation of an object from the reflected light of the irradiated laser light. In other words, sensor 26A can also be said to be a so-called two-dimensional (2D) LiDAR (Light Detection and Ranging). However, sensor 26A is not limited to the above and may be a sensor that detects an object by any method, for example, it may be a so-called three-dimensional (3D) LiDAR that scans in multiple directions, a so-called one-dimensional (1D) LiDAR that does not scan, or it may be a camera.
  • 3D three-dimensional
  • the control device 28 controls the movement of the moving body 10.
  • the control device 28 will be described later.
  • FIG. 3 is a schematic diagram of the wheels as viewed from above. As shown in FIGS. 2 and 3, the moving body 10 has wheels 20A1, 20A2, and 20A3 as the wheels 20A.
  • the wheel 20A1 is a wheel that cannot be driven but can be steered.
  • Driving means that the wheel is connected to a drive source such as a motor and can rotate autonomously using power from the drive source. Therefore, the wheel 20A1 is a wheel that cannot rotate autonomously.
  • Steering means that the orientation (rotation angle) of the wheel relative to the moving body 10 (car body 20) when viewed from the Z direction can be changed. Therefore, the orientation of the wheel 20A1 can be changed relative to the moving body 10.
  • the wheel 20A1 is attached to the straddle leg 21, more specifically, to the tip of the straddle leg 21.
  • the attachment position of the wheel 20A1 on the moving body 10 is not limited to the straddle leg 21 and may be arbitrary.
  • wheel 20A2 like wheel 20A1, is a wheel that cannot be driven but can be steered. Therefore, wheel 20A2 can change its orientation with respect to moving body 10.
  • Wheel 20A2 is attached to straddle leg 21 on the opposite side to wheel 20A1, more specifically, to the tip portion of straddle leg 21.
  • the attachment position of wheel 20A2 on moving body 10 is not limited to straddle leg 21 and may be arbitrary.
  • the wheel 20A3 is a wheel that can be driven and steered. That is, the wheel 20A3 is a wheel that can rotate autonomously and can change its orientation with respect to the moving body 10.
  • the wheel 20A3 is provided on the moving body 10 on the forward side (the side where the fork 24 is not provided) of the wheels 20A1 and 20A2. In this embodiment, the wheel 20A3 is provided at a position (here, the midpoint position) between the wheels 20A1 and 20A2 in the left-right direction.
  • the wheel 20A3 is also attached to the vehicle body 20, more specifically, to a location on the forward side of the vehicle body 20.
  • the attachment position of the wheel 20A3 on the moving body 10 may be arbitrary.
  • the moving body 10 can steer the wheels 20A1 and 20A2, and can steer and drive the wheel 20A3. Therefore, the moving body 10 can perform normal turning and pivot turning, which will be described later. Furthermore, the moving body 10 can move not only in the forward or backward direction as the traveling direction, but also in any direction of the vehicle body 20 (for example, left and right direction or diagonal direction) as the traveling direction.
  • the moving body 10 can perform normal turning and pivot turning, and can move in any direction of the vehicle body 20 (for example, left and right direction or diagonal direction) as the traveling direction, it is not limited to a configuration in which the wheels 20A1 and 20A2 can be steered and the wheel 20A3 can be steered and driven.
  • the number of wheels 20A may be any number of two or more, all of the wheels 20A can be steered, and at least one wheel 20A can be driven and steered.
  • wheels 20A1 and 20A2 may be driven and steerable, and wheel 20A3 may be non-driven and steerable.
  • the number of wheels 20A may be four or more, all of the wheels 20A may be steerable, and at least one of the wheels 20A may be driven and steerable.
  • FIG. 4 is a schematic diagram for explaining normal turning.
  • Normal turning which is one of the turning modes, refers to a turning mode in which the moving body 10 turns (revolves around an external rotation center) with the outside of the vehicle body 20 (moving body 10) as viewed from the Z direction as the center of rotation. That is, as shown in FIG. 4, if the center position of the trajectory when the moving body 10 turns is the center of rotation C, normal turning refers to the moving body 10 turning (changing the traveling direction) with the position outside the area occupied by the vehicle body 20 (moving body 10) as the center of rotation C.
  • Normal turning may be realized by any method. For example, normal turning may be realized by driving the wheel 20A3 while steering it so that the direction is changed to the turning direction, and not steering the wheels 20A1 and 20A2 (making the direction follow the traveling direction).
  • FIG. 5 is a schematic diagram for explaining a pivot turn.
  • the pivot turn which is one of the turning modes, refers to a turning mode in which the moving body 10 turns (rotates around an internal rotation center) with the inside of the vehicle body 20 (moving body 10) as the rotation center when viewed from the Z direction. That is, as shown in FIG. 5, if the center position of the trajectory when the moving body 10 turns is the rotation center C, the pivot turn refers to the moving body 10 turning (changing the traveling direction) with the inside position of the area occupied by the vehicle body 20 (moving body 10) as the rotation center C.
  • the pivot turn may be realized by any method.
  • the pivot turn may be realized by driving the wheel 20A3 while steering the wheels 20A1 to 20A3 so that the direction is changed toward the turning direction.
  • the wheels 20A1 to 20A3 may be driven while steering the wheels 20A1 to 20A3 to face the traveling direction of the vehicle body 20 in the direction in which the traveling direction is desired.
  • FIG. 6 is a schematic block diagram of the management device.
  • the management device 12 is a system that manages the logistics in the facility W.
  • the management device 12 is a WCS (warehouse control system) or a WMS (warehouse management system), but is not limited to a WCS or a WMS and may be any system, for example, a back-end system such as other production management systems.
  • the location where the management device 12 is installed is arbitrary, and may be installed in the facility W or may be installed at a location away from the facility W to manage the facility W from the remote location.
  • the management device 12 is a computer, and includes a communication unit 30, a storage unit 32, and a control unit 34 as shown in FIG. 6.
  • the communication unit 30 is a module used by the control unit 34 to communicate with an external device such as the information processing device 14, and may include, for example, an antenna.
  • the communication method used by the communication unit 30 is wireless communication, but any communication method may be used.
  • the storage unit 32 is a memory that stores various information such as the calculation contents and programs of the control unit 34, and includes, for example, at least one of a RAM (Random Access Memory), a main storage device such as a ROM (Read Only Memory), and an external storage device such as a HDD (Hard Disk Drive).
  • the control unit 34 is a calculation device and includes a calculation circuit such as a CPU (Central Processing Unit).
  • the control unit 34 includes a destination position setting unit 40 and a movable information acquisition unit 42.
  • the control unit 34 realizes the destination position setting unit 40 and the movable information acquisition unit 42 by reading and executing a program (software) from the storage unit 32, and executes the processes.
  • the control unit 34 may execute the processes using one CPU, or may have multiple CPUs and execute the processes using the multiple CPUs. At least a part of the destination position setting unit 40 and the movable information acquisition unit 42 may be realized by a hardware circuit.
  • the program for the control unit 34 stored in the storage unit 32 may be stored in a recording medium that can be read by the management device 12.
  • the destination position setting unit 40 sets the destination position G to which the mobile body 10 is to move.
  • the movable information acquisition unit 42 acquires movable information indicating positions to which the mobile body 10 is to move within the working area AR. The specific processing content of these will be described later.
  • the management device 12 may also perform processes other than setting the destination position G and acquiring obstacle information.
  • the management device 12 may also set information for controlling mechanisms (e.g., elevators, doors, etc.) other than the moving body 10 provided in the facility W.
  • FIG. 7 is a schematic block diagram of an information processing device.
  • the information processing device 14 is a device that processes information related to the movement of the mobile body 10.
  • the information processing device 14 is, for example, an FCS (Fleet Control System), but is not limited thereto, and may be any device that processes information related to the movement of the mobile body 10.
  • the information processing device 14 is a computer, and includes a communication unit 50, a storage unit 52, and a control unit 54, as shown in FIG. 7.
  • the communication unit 50 is a module used by the control unit 54 to communicate with external devices such as the management device 12 and the mobile body 10, and may include, for example, an antenna.
  • the communication method by the communication unit 50 is wireless communication, but the communication method may be any.
  • the storage unit 52 is a memory that stores various information such as the calculation contents and programs of the control unit 54, and includes, for example, at least one of a RAM, a main storage device such as a ROM, and an external storage device such as a HDD.
  • the control unit 54 is a calculation device and includes a calculation circuit such as a CPU.
  • the control unit 54 includes a destination position acquisition unit 60, a movable information acquisition unit 62, and a first route setting unit 64.
  • the control unit 54 realizes the destination position acquisition unit 60, the movable information acquisition unit 62, and the first route setting unit 64 by reading and executing a program (software) from the storage unit 52, and executes the processes.
  • the control unit 54 may execute these processes using one CPU, or may be provided with multiple CPUs and execute the processes using the multiple CPUs.
  • At least a part of the destination position acquisition unit 60, the movable information acquisition unit 62, and the first route setting unit 64 may be realized by a hardware circuit.
  • the program for the control unit 54 stored in the storage unit 52 may be stored in a recording medium that can be read by the information processing device 14.
  • the destination position acquisition unit 60 acquires information on the destination position G
  • the movable information acquisition unit 62 acquires movable information
  • the first route setting unit 64 sets the first route R1 of the mobile body 10. The specific processing content of these will be described later.
  • the management device 12 and the information processing device 14 are separate devices, but they may be integrated devices. That is, the management device 12 may have at least some of the functions of the information processing device 14, and the information processing device 14 may have at least some of the functions of the management device 12.
  • FIG. 8 is a schematic block diagram of the control device of the moving body.
  • the control device 28 is a device that controls the moving body 10.
  • the control device 28 is a computer, and includes a communication unit 70, a storage unit 72, and a control unit 74 as shown in FIG. 8.
  • the communication unit 70 is a module used by the control unit 74 to communicate with an external device such as the information processing device 14, and may include, for example, an antenna.
  • the communication method by the communication unit 70 is wireless communication, but the communication method may be arbitrary.
  • the storage unit 72 is a memory that stores various information such as the calculation contents and programs of the control unit 74, and includes, for example, at least one of a RAM, a main storage device such as a ROM, and an external storage device such as an HDD.
  • the control unit 74 is a calculation device and includes a calculation circuit such as a CPU.
  • the control unit 74 includes a first path acquisition unit 80, a second path setting unit 82, and a movement control unit 84.
  • the control unit 74 realizes the first path acquisition unit 80, the second path setting unit 82, and the movement control unit 84 by reading and executing a program (software) from the storage unit 72, and executes the processes.
  • the control unit 74 may execute these processes using one CPU, or may have multiple CPUs and execute the processes using the multiple CPUs.
  • at least a part of the first path acquisition unit 80, the second path setting unit 82, and the movement control unit 84 may be realized by a hardware circuit.
  • the program for the control unit 74 stored in the storage unit 72 may be stored in a recording medium that can be read by the control device 28.
  • the first route acquisition unit 80 acquires information on the first route R1, the second route setting unit 82 sets the second route R2 based on the first route R1, and the movement control unit 84 controls the movement of the moving body 10 by controlling the driving unit, steering, and other movement mechanisms of the moving body 10. The specific processing content of these will be described later.
  • the destination position setting unit 40 of the management device 12 sets a destination position G to which the moving body 10 is to be moved.
  • the destination position setting unit 40 sets a position within the working area AR to be the destination position G.
  • the destination position setting unit 40 selects a waypoint WPG corresponding to a position within the working area AR to be the destination position, and sets it as the destination position G.
  • the destination position setting unit 40 may set any position (waypoint WP) within the working area AR as the destination position G, and may set the waypoint WP to be the destination position G based on, for example, pre-set order information indicating the object P to be transported and the source and destination of the object P.
  • the management device 12 transmits the position information of the set destination position G to the information processing device 14.
  • the destination position acquisition unit 60 of the information processing device 14 acquires the position information of the destination position G set by the destination position setting unit 40 of the management device 12.
  • the position information of the destination position G may be any information indicating the position of the destination position G, and may be, for example, information indicating the coordinates of the destination position G or information indicating the identifier of the waypoint WPG corresponding to the destination position G.
  • the movable information acquisition unit 42 of the management device 12 acquires movable information indicating positions to which the mobile body 10 can move within the working area AR.
  • the movable information is information indicating positions to which the mobile body 10 can move (here, waypoints WP) during the time period in which the mobile body 10 is scheduled to move.
  • the movable information indicates a location to which the mobile body 10 can move, which is determined from layout information of the equipment W that does not change dynamically (such as the position of the fixed object P0 and the width of the passage) and the presence or absence of obstacles that change dynamically (such as the object P in the temporary installation area AR1 and the transportation vehicle V in the parking area ARV).
  • the movable information may be set based on information on the vehicle specifications of the mobile body 10 (such as the size of the mobile body 10) in addition to the layout information and the presence or absence of obstacles.
  • the movable information acquisition unit 42 may acquire the movable information by any method. For example, the movable information acquisition unit 42 acquires the position information (layout information of the facility W) of the fixed object P0 that does not change dynamically from the map information of the facility W (work area AR). The movable information acquisition unit 42 also acquires obstacle information indicating the presence or absence of obstacles (object P in the temporary installation area AR1 and transport vehicle V in the parking area ARV) during the time period during which the mobile body 10 is scheduled to move.
  • the movable information acquisition unit 42 may then set the position of the fixed object P0 indicated by the map information of the facility W and the position of the obstacle indicated by the obstacle information as an obstacle area, and set a position (waypoint WP) that is a predetermined distance or more from the obstacle area as a movable position.
  • the movable information acquisition unit 42 may also acquire other mobile body information indicating a position (waypoint WP) that is set as the movement route (first route R1) of another mobile body during the time period during which the mobile body 10 is scheduled to move.
  • the movable information acquisition unit 42 may then set the position of the fixed object P0 indicated by the map information of the facility W, the position of the obstacle indicated by the obstacle information, and the position of the movement path of the other moving body 10 indicated by the other moving body information as the obstacle area.
  • the predetermined distance from the obstacle area may be set arbitrarily, and may be set, for example, based on the vehicle specification information of the moving body 10 described above.
  • the management device 12 transmits the acquired movable information to the information processing device 14.
  • the movable information acquisition unit 62 of the information processing device 14 acquires the movable information from the management device 12.
  • the first route setting unit 64 of the information processing device 14 sets the first route R1, the turning position, and the turning mode of the moving body 10 based on the position information of the destination position G and the movable information.
  • the first route R1 may be called a layout path.
  • the first route setting unit 64 sets a route toward the destination position G through the movable positions indicated by the movable information as the first route R1.
  • the first route setting unit 64 sets a route connecting each waypoint WP from the movement origin S of the moving body 10 through the movable positions to reach the destination position G as the first route R1.
  • the first route setting unit 64 sets a route connecting the waypoint WP0 corresponding to the movement origin S through the movable waypoint WP indicated by the movable information to the waypoint WPG corresponding to the destination position G as the first route R1.
  • the position of the origin S may be set arbitrarily.
  • the waypoint WP closest to the position where the moving body 10 starts moving may be set as the origin S.
  • the first route setting unit 64 sets (selects) a turning position where the moving body 10 turns from among each position (waypoint WP) on the first route R1 and a position (waypoint WP) within a predetermined distance range from the first route R1.
  • the first route setting unit 64 may set any position on the first route R1 and within a predetermined distance range from the first route R1 as the turning position.
  • the first route setting unit 64 may acquire position information of an obstacle area, and set a position on the first route R1 and within a predetermined distance range from the first route R1 whose distance from the obstacle area is equal to or greater than a predetermined threshold (for example, a distance that does not interfere with an obstacle due to turning) as the turning position.
  • a predetermined threshold for example, a distance that does not interfere with an obstacle due to turning
  • the information processing device 14 transmits information about the set first route R1 to the mobile body 10. That is, the first route acquisition unit 80 of the mobile body 10 acquires the information about the first route R1 set by the information processing device 14.
  • the information about the first route R1 may be any information indicating the position of the first route R1, but in this embodiment, it may be the position information of the waypoint WP included in the first route R1.
  • the second route setting unit 82 of the moving body 10 sets the second route R2 based on the first route R1, the turning position, and the turning mode.
  • the second route R2 can also be called a global path. More specifically, the second route setting unit 82 sets the second route R2 based on the first route R1, the turning position, the turning mode, and information on the vehicle specifications of the moving body 10.
  • the information on the vehicle specifications is, for example, specifications that affect the route on which the moving body 10 can move, such as the size of the moving body 10 and the minimum turning radius.
  • the second route R2 is a route that can be followed by the moving body 10 and passes through positions on which the moving body 10 can move while passing within a predetermined distance from the first route R1, and heads toward the destination position G. More specifically, the second route R2 is a route that passes through positions on which the moving body 10 can move while turning in the set turning mode at a position within a predetermined distance range from the turning position set in the first route R1 and heads toward the destination position G.
  • the second route R2 is set to include a section extending in the Y direction from waypoint WP0 to waypoint WP1b, and a section that turns around at waypoint WP1b with a normal turn to reach waypoint WPG.
  • the second route R2 is set to include a section extending in the Y direction from waypoint WP0 to waypoint WP1a, and a section that connects waypoint WP1a to waypoint WPG by making a pivot turn at waypoint WP1a to point the rear of the vehicle body 20 toward waypoint WPG.
  • the movement control unit 84 of the moving body 10 moves the moving body 10 according to the second route R2.
  • the movement control unit 84 moves the moving body 10 so as to pass through the second route R2 by sequentially grasping the position information of the moving body 10.
  • the method of acquiring the position information of the moving body 10 is arbitrary, but for example, in this embodiment, a detection body (not shown) is provided in the facility W, and the movement control unit 84 acquires the position and posture information of the moving body 10 based on the detection of the detection body.
  • the moving body 10 irradiates a laser light toward the detection body and receives the reflected light of the laser light by the detection body to detect its own position and posture in the facility W.
  • the method of acquiring the position and posture information of the moving body 10 is not limited to using the detection body, and for example, SLAM (Simultaneous Localization And Mapping) may be used.
  • the mobile body 10 moves in the Y direction from waypoint WP0 to waypoint WP1b, traveling in the forward direction where the fork 24 is not provided. Then, at waypoint WP1b, the mobile body 10 turns so that its traveling direction is the rear direction where the fork 24 is provided, and moves to waypoint WPG while making a normal turn.
  • the mobile body 10 moves in the Y direction from waypoint WP0 to waypoint WP1a, traveling in the forward direction where the fork 24 is not provided. Then, at waypoint WP1a, the mobile body 10 makes a pivot turn so that its traveling direction is the rear direction where the fork 24 is provided, and moves in the X direction from waypoint WP1a to waypoint WPG.
  • the object P to be transported is placed in a storage room Va corresponding to the destination position G. Therefore, when the moving body 10 reaches the waypoint WPG, which is the destination position G, the movement control unit 84 controls the fork 24 to insert the fork 24 into the opening Pb of the object P provided at the destination position G to pick up (take off) the object P.
  • the movement control unit 84 may detect the position and attitude of the front surface Pa of the object P by the sensor 26A from the waypoint WPG or from a position before reaching the waypoint WPG. Then, the movement control unit 84 may set a third route to the object P based on the position and attitude of the front surface Pa of the object P, and approach the object P according to the third route to pick up the object P.
  • the movement control unit 84 may set a third route that provides a predetermined position and orientation (a position and orientation at which the moving body 10 can pick up the object P) for the detected position and orientation of the object P, and may approach the object P according to the third route. Also, for example, the movement control unit 84 may cause the moving body 10 to approach the object P by performing feedback control (direct feedback control) based on the detection results of the position and orientation of the object P and the detection results of the position and orientation of the moving body 10. In this case, the movement control unit 84 may switch to direct feedback control during the approach according to the third route based on the position and orientation of the object P.
  • the first route setting unit 64 sets the first route R1, the turning position, and the turning mode based on the predicted time to reach the destination position G. Specifically, the first route setting unit 64 sets the first route R1 and the turning position based on the destination position and the movable information. Then, the first route setting unit 64 calculates a first predicted time, which is a predicted time required to reach the destination position G while turning normally at the set turning position, using a route (the second route R2 in this example) based on the set first route R1.
  • the first route setting unit 64 calculates a second predicted time, which is a predicted time required to reach the destination position G while turning at the set turning position, using a route (the second route R2 in this example) based on the set first route R1.
  • the first route setting unit 64 determines whether to make a normal turn or a turning turn based on the first predicted time and the second predicted time. For example, the first route setting unit 64 determines that the vehicle is turning normally when the first predicted time is shorter than the second predicted time, and determines that the vehicle is turning in a pivotal manner when the second predicted time is shorter than the first predicted time.
  • the first predicted time and the second predicted time are calculated based on the length of the first route R1 and the turning mode.
  • the time required to move a unit length of the first route R1 and the time required for normal turning and turning in a pivotal manner are set in advance, and the first route setting unit 64 may calculate the first predicted time and the second predicted time based on the set first route R1, the turning mode, and these times.
  • FIG. 11 is a flowchart illustrating the setting flow based on the predicted time.
  • the information processing device 14 acquires the destination position G and the movable information by the destination position acquisition unit 60 and the movable information acquisition unit 62 (step S10).
  • the first route setting unit 64 of the information processing device 14 sets the shortest route that can reach the destination position G while passing through the movable positions as a tentative first route R1 based on the destination position G and the movable information (step S12). That is, although it may be possible to set multiple routes that can reach the destination position G while passing through the movable positions (waypoints WP), in this example, the first route setting unit 64 sets the shortest route among those routes as the shortest route.
  • the first path setting unit 64 sets a turning position based on the shortest path (step S14).
  • the first path setting unit 64 sets (selects) a turning position from each position on the shortest path and within a predetermined distance range from the shortest path.
  • the method of setting the turning position may be the same as the method described in the above embodiment. That is, for example, the first path setting unit 64 may set a position, among each position on the shortest path and within a predetermined distance range from the shortest path, at which the distance from the obstacle area is equal to or greater than a predetermined threshold, as a turning position, assuming that turning is possible at that position.
  • the first path setting unit 64 may set all of them as tentative turning positions.
  • the first path setting unit 64 sets a possible turning mode at the set turning position (step S16). That is, the first path setting unit 64 judges whether normal turning is possible or whether pivot turning is possible at the set turning position. If the first path setting unit 64 judges that normal turning is possible, it sets normal turning as the possible turning mode, and if it judges that pivot turning is possible, it sets pivot turning as the possible turning mode. Note that, if it judges that both turning are possible, the first path setting unit 64 sets both normal turning and pivot turning as the possible turning modes. The first path setting unit 64 sets a possible turning mode for each of the set turning positions. Note that the method of judging whether normal turning and pivot turning are possible may be the same as the method described in the above embodiment.
  • the first path setting unit 64 may determine that normal turning is possible when the distance between the normal turning area and the obstacle area is equal to or greater than a predetermined threshold, and may determine that pivot turning is possible when the distance between the pivot turning area and the obstacle area is equal to or greater than a predetermined threshold.
  • the first path setting unit 64 modifies the shortest path based on the set turning position and turning mode to set a modified path that is a provisional first path R1 (step S18). For example, the first path setting unit 64 determines whether it is necessary to deviate from the shortest path to turn at the turning position based on the set turning position and turning mode, and if it is determined that it is necessary to deviate, sets a modified path that modifies the shortest path to set it as the provisional first path R1. On the other hand, if the first path setting unit 64 determines that it is not necessary to deviate from the shortest path to turn at the turning position, it does not modify the shortest path and treats the shortest path as a modified path (provisional first path R1).
  • the first path setting unit 64 sets a position away from the shortest path as the turning position and sets the turning mode to normally turn and turn back at that turning position, it determines that it is necessary to deviate from the shortest path.
  • the first path setting unit 64 sets the modified path so as to include a section that connects from the position on the shortest path to the turning position and a section that returns from the turning position to the shortest path.
  • the turning position is set to be on the shortest route and the vehicle is set to make a pivot turn at that turning position, it is determined that there is no need to deviate from the shortest route and the shortest route is not modified.
  • the first route setting unit 64 performs the same process for each combination of the set turning position and turning mode to set a modified route.
  • the first path setting unit 64 calculates, for each corrected path, a predicted time T for reaching the destination position G along the corrected path while turning in the set turning mode at the set turning position (step S20).
  • the predicted time T may be calculated by any method based on the corrected path, turning position, and turning mode, but for example, the first path setting unit 64 calculates the predicted time T using the following formula (1).
  • Tsf is the straight-forward travel time when moving along the corrected path.
  • the straight-forward travel time Tsf is the predicted time required to move along a section of the corrected path where the fork 24 is not provided and the forward travel section moves straight ahead.
  • the first path setting unit 64 calculates the length of the straight-forward travel section from the corrected path, and divides the length of the straight-forward travel section by a preset straight-forward speed (the travel speed when moving straight ahead with the forward travel direction being the direction of travel), to calculate the straight-forward travel time Tsf.
  • the straight-forward travel speed may be set as appropriate, and may be, for example, about 1 m/s to 2 m/s.
  • Tsb is the straight backward travel time when moving along the corrected path.
  • the straight backward travel time Tsb is the predicted time required to move along a section of the corrected path in which the forward direction is the rearward direction where the fork 24 is provided (straight backward travel section).
  • the first path setting unit 64 calculates the length of the straight backward travel section from the corrected path, and divides the length of the straight backward travel section by a preset straight backward travel speed (travel speed when moving straight backward with the forward direction as the direction of travel) to calculate the straight backward travel time Tsb.
  • the straight backward travel speed may be set as appropriate, but may be slower than the straight forward travel speed, for example, about 0.5 m/s to 1 m/s.
  • the turning time Tt is the turning time when moving along the corrected path.
  • the turning time Tt is the predicted time required from the start of turning to the completion of turning.
  • the first path setting unit 64 may set the turning time Tt to the sum of the value obtained by dividing the pivot turning angle by the pivot turning speed, the value obtained by dividing the forward turning distance by the forward turning speed, and the value obtained by dividing the reverse turning distance by the reverse turning speed.
  • the pivot turning angle indicates the amount of change in the direction (angle) of the moving body 10 due to the pivot turning and is calculated based on the turning mode, and the pivot turning speed is the angle that can be changed per unit time by the pivot turning and is set in advance.
  • the forward turning distance indicates the distance traveled when normally turning with the forward direction, where the fork 24 is not provided, as the traveling direction and is calculated based on the corrected path
  • the forward turning speed indicates the distance traveled per unit time by the forward turning and is calculated, for example, by the turning radius.
  • the reverse turning distance refers to the distance traveled when turning normally with the direction of travel being the rearward direction where the forks 24 are provided, and is calculated based on the corrected path
  • the reverse turning speed refers to the distance traveled per unit time when turning backward, and is calculated, for example, from the turning radius.
  • Tla is the lateral movement time when moving along the corrected path.
  • the lateral movement time Tla is the predicted time required for movement along a section of the corrected path in which the moving body 10 moves straight with the left and right direction as the traveling direction (lateral movement section).
  • the first path setting unit 64 calculates the length of the lateral movement section from the corrected path, and divides the length of the lateral movement section by a preset lateral movement speed (movement speed when moving with the left and right direction as the traveling direction) to calculate the lateral movement time Tla.
  • the lateral movement speed may be set appropriately, but may be slower than the forward linear speed, for example, about 0.5 m/s to 1 m/s.
  • the approach time Ta is the approach time when moving along the corrected path.
  • the approach time Ta is the predicted time required to approach the object P based on the detection results of the position and orientation of the object P (e.g., the predicted time required to move along the third path described above).
  • the first path setting unit 64 calculates the approach time Ta as the value obtained by dividing the approach distance (the distance traveled when approaching the object P) by a preset approach speed (the speed of travel when approaching the object P).
  • the approach distance and approach speed may be preset.
  • the approach speed may be slower than the linear backward speed, and may be, for example, about 0.2 m/s to 0.5 m/s.
  • Tlos is the lost time due to stopping the moving body 10, etc.
  • the first route setting unit 64 calculates the lost time Tlos as the value obtained by multiplying the number of times the moving body 10 stops during movement by a predetermined penalty coefficient.
  • the number of times the moving body 10 stops may be calculated based on the number of turning positions, for example, and the number of turning positions may be the number of times the moving body 10 stops.
  • the penalty coefficient is the predicted time from stopping to resuming movement, and may be, for example, about 4 seconds.
  • the first path setting unit 64 sets the first path R1, turning position, and turning mode based on the predicted time calculated for each corrected path as described above. Specifically, the first path setting unit 64 extracts a combination of the corrected path, turning position, and turning mode that minimizes the predicted time from among the combinations of each corrected path, turning position, and turning mode, and sets the extracted corrected path, turning position, and turning mode as the first path R1, turning position, and turning mode to be actually used (step S22). That is, the first path setting unit 64 uses the predicted time T in equation (1) as an evaluation function, and adopts the combination of the corrected path, turning position, and turning mode that corresponds to the predicted time T that minimizes the evaluation function as the first path R1, turning position, and turning mode to be actually used.
  • the first route setting unit 64 may set the first route R1, the turning position, and the turning mode depending on the work content of the mobile body 10. A specific example will be described below.
  • the first route setting unit 64 preferably sets the turning mode so that the moving body 10 turns normally while turning back to head toward the destination position G. Specifically, as shown in FIG. 9, for example, the first route setting unit 64 sets a route from the waypoint WP0 of the movement origin S through the travel route waypoint WPA to the waypoint WPG of the destination position G corresponding to the parking area ARV as the first route R1.
  • the first route setting unit 64 sets the waypoint WP1b, which is on the opposite side of the movement origin S with respect to the destination position G (the Y direction side in the example of FIG. 9), among the travel route waypoints WPA, as a turning position, and sets the turning mode so that the moving body 10 turns normally to reach the waypoint WPG.
  • Fig. 12 is a schematic diagram illustrating an example of unloading an object into an installation area.
  • the first route setting unit 64 sets the first route R1 so as to include a section moving from the waypoint WP0 (movement source S) corresponding to the parking area ARV to the travel waypoint WPA (waypoints WP0 to WP1a in the example of FIG. 12), a section passing through the travel waypoint WPA (waypoints WP1a to WP2a in the example of FIG. 12), a section moving through the travel waypoint WPA to the approach waypoint WPB (waypoints WP2a to WP2b in the example of FIG. 12), and a section reaching the waypoint WPG corresponding to the installation area AR2 from the approach waypoint WPB (waypoints WP2b to WPG in the example of FIG. 12).
  • the first route setting unit 64 sets the first route R1 (the first route R1a in FIG. 13) so as to include a section moving from the waypoint WP0 (movement source S) corresponding to the installation area AR2 to the approach waypoint WPB (waypoints WP0 to WP2b in the example of FIG. 13), a section moving via the approach waypoint WPB to the traffic waypoint WPA (waypoints WP2b to WP2a in the example of FIG. 13), and a section passing through the traffic waypoint WPA (waypoints WP2a to WP1d in the example of FIG. 13). Also, the first route setting unit 64 sets the lateral direction of the vehicle body 20 as the travel direction at the waypoint WP2b. Also, the first route setting unit 64 sets the forward direction of the vehicle body 20 as the travel direction at the waypoint WP2a.
  • the first route setting unit 64 sets the setting mode to normal turning.
  • the first route setting unit 64 sets the first route R1 (first route R1b in FIG. 13) to include a section moving from the waypoint WP0 (movement source S) corresponding to the installation area AR2 to the approach waypoint WPB (waypoints WP0 to WP2b in the example of FIG. 13), a section moving via the approach waypoint WPB to the travel waypoint WPA (waypoints WP2b to WP2a in the example of FIG.
  • the first route setting unit 64 sets the waypoint WP (waypoint WP2b in the example of FIG. 13) on the travel waypoint WPA as the turning position, and sets the turning mode to turn normally.
  • the mobile body 10 moves along a second route R2b set based on the first route R1b, turning position, and turning mode thus set. Therefore, in this case, as shown in the second route R2b in FIG. 13, the mobile body 10 moves from waypoint WP0 to waypoint WP2b with the forward direction as the travel direction, turns normally at waypoint WP2b, and moves to waypoint WP on the travel waypoint WPA (waypoint WP1d in the example of FIG. 13). The mobile body 10 then moves in the Y direction along the travel waypoint WPA.
  • FIGS. 14 to 16 are schematic diagrams for explaining an example of unloading the object into the installation area.
  • a position corresponding to the parking area ARV is set as the movement origin S
  • a position corresponding to the temporary installation area AR1 is set as the destination position G
  • the work is set to unload the object at the destination position G
  • the first path setting unit 64 performs setting as follows.
  • the first path setting unit 64 calculates a separation distance, which is the distance in the Y direction between the movement origin S (waypoint WP0 corresponding to the parking area ARV) and the destination position G (waypoint WPG corresponding to the temporary installation area AR1), and sets the first path R1, the turning position, and the turning mode based on the separation distance.
  • the first route setting unit 64 sets the first route R1 to include a section moving from the waypoint WP0 (origin S) corresponding to the parking area ARV to the travel waypoint WPA (waypoints WP0-WP1a in the example of Figure 14), a section passing through the travel waypoint WPA (waypoints WP1a-WP1e in the example of Figure 14), and a section reaching the waypoint WPG corresponding to the temporary installation area AR1 (waypoints WP1d-WPG in the example of Figure 14).
  • the first path setting unit 64 also sets waypoint WP0 and waypoint WP1e (a waypoint WP among the travel waypoints WPA that is on the opposite side of waypoint WPG in the Y direction) as turning positions.
  • the first path setting unit 64 also sets a turning mode at waypoint WP0 so that the vehicle turns normally in the opposite direction of the Y direction with the forward direction of the vehicle body 20 as the travel direction.
  • the first path setting unit 64 also sets a turning mode at waypoint WP1e so that the vehicle turns normally with the rear direction of the vehicle body 20 as the travel direction.
  • the mobile body 10 sets and moves along the second route R2 based on the first route R1, turning position, and turning mode thus set. Therefore, as shown in FIG. 14, the mobile body 10 turns normally from waypoint WP0 with the forward direction as its travel direction, moves to waypoint WP1c on the travel waypoint WPA, and moves along the travel waypoint WPA to waypoint WP1e. Then, at waypoint WP2b, the mobile body 10 turns (normally) with the rear direction of the vehicle body 20 as its travel direction, reaches waypoint WPG, and unloads the object P into the unit area A of the temporary installation area AR1 corresponding to waypoint WPG.
  • FIG. 15 shows an example in which the distance in the Y direction between the origin S and the destination position G is less than a predetermined distance and greater than 0.
  • the first route setting unit 64 selects normal turning and pivot turning as the turning mode. More specifically, the first route setting unit 64 sets the first route R1 to include a section moving from the waypoint WP0 (origin S) corresponding to the parking area ARV to the traffic waypoint WPA (waypoints WP0 to WP1a in the example of FIG. 15), a section passing through the traffic waypoint WPA (waypoints WP1a to WP1c in the example of FIG.
  • FIG. 16 shows an example in which the distance in the Y direction between the origin S and the destination position G is 0.
  • the first path setting unit 64 selects pivot turning as the turning mode. More specifically, the first path setting unit 64 sets the first path R1 to include a section moving from the waypoint WP0 (origin S) corresponding to the parking area ARV to the travel waypoint WPA (waypoints WP0 to WP1a in the example of FIG. 16), and a section reaching the waypoint WPG corresponding to the temporary installation area AR1 (waypoints WP1a to WPG in the example of FIG. 16).
  • the first path setting unit 64 also sets the waypoint WP1a as the turning position, and sets the turning mode so that the vehicle makes a pivot turn at the waypoint WP1a so that the rear direction of the vehicle body 20 faces in the opposite direction to the direction X, and the rear direction of the vehicle body 20 becomes the traveling direction.
  • the mobile body 10 sets and moves along the second route R2 based on the first route R1, turning position, and turning mode thus set. Therefore, as shown in FIG. 16, the mobile body 10 moves from waypoint WP0 to waypoint WP1a with the forward direction of the vehicle body 20 as its travel direction, and at waypoint WP1a, makes a pivot turn so that the rear of the vehicle body 20 faces in the opposite direction to direction X. Then, with the rear direction of the vehicle body 20 as its travel direction, the mobile body 10 reaches waypoint WPG from waypoint WP1a, and unloads the object P into unit area A of the temporary installation area AR1 corresponding to waypoint WPG.
  • FIGS. 17 to 19 are schematic diagrams for explaining an example of unloading the object loaded from the temporary installation area onto the transport vehicle.
  • the first path setting unit 64 calculates a separation distance, which is the distance in the Y direction between the movement origin S (waypoint WP0 corresponding to the temporary installation area AR1) and the destination position G (waypoint WPG corresponding to the parking area ARV), and sets the first path R1, the turning position, and the turning mode based on the separation distance.
  • FIG. 18 shows an example in which the distance in the Y direction between the origin S and the destination position G is less than a predetermined distance and greater than 0.
  • the first route setting unit 64 selects normal turning and pivot turning as the turning mode. More specifically, the first route setting unit 64 sets the first route R1 to include a section moving from the waypoint WP0 (origin S) corresponding to the temporary installation area AR1 to the traffic waypoint WPA (waypoints WP0 to WP1c in the example of FIG. 18), a section passing through the traffic waypoint WPA (waypoints WP1c to WP1a in the example of FIG.
  • the mobile body 10 sets and moves along the second route R2 based on the first route R1, turning position, and turning mode thus set. Therefore, as shown in FIG. 15, the mobile body 10 moves from waypoint WP0 to waypoint WP1c with the forward direction of the vehicle body 20 as its travel direction, and at waypoint WP1c, it makes a pivot turn so that the rear of the vehicle body 20 faces the waypoint WPG. Then, from waypoint WP1c, the mobile body 10 makes a normal turn in the X direction to reach waypoint WPG, and unloads the object P at the position in the storage room Va corresponding to waypoint WPG.
  • the first path setting unit 64 also sets the waypoint WP1a as the turning position, and sets the turning mode so that the vehicle turns at the waypoint WP1a so that the rear direction of the vehicle body 20 faces the X direction, and the rear direction of the vehicle body 20 becomes the traveling direction.
  • the mobile body 10 sets and moves along the second route R2 based on the first route R1, turning position, and turning mode thus set. Therefore, as shown in FIG. 19, the mobile body 10 moves from waypoint WP0 to waypoint WP1a with the forward direction of the vehicle body 20 as its travel direction, and at waypoint WP1a, makes a pivot turn so that the rear of the vehicle body 20 faces the X direction. Then, with the rear direction of the vehicle body 20 as its travel direction, the mobile body 10 reaches waypoint WPG from waypoint WP1a, and unloads the object P at a position in the storage room Va corresponding to waypoint WPG.
  • FIG. 20 is a schematic diagram showing an example of a case where a target is moved while being held at a high position.
  • the first route setting unit 64 may set the position in the Z direction (transport height) of the object P transported by the moving body 10 based on the height information of the obstacle in the obstacle area.
  • the obstacle height information is information indicating the height (length in the Z direction) of the obstacle located in the obstacle area, and refers to, for example, the height of the fixed object P0 or the transport vehicle V, or the height of the object P installed in the temporary installation area AR1 or the installation area AR2 as the obstacle area.
  • the height of the fixed object P0 or the transport vehicle V may be set in advance.
  • the fact that the object P is installed in the temporary installation area AR1 or the installation area AR2 can be acquired from the movable information, and the height of the object P may be set in advance.
  • the first path setting unit 64 determines whether there is a position on the first path R1 where the distance to the obstacle area is less than a predetermined distance. If there is a position where the distance to the obstacle area is less than the predetermined distance, the first path setting unit 64 acquires obstacle height information for that obstacle area, and sets a position in the Z direction (vertically above) the obstacle as the position in the Z direction (transport height) of the object P based on the obstacle height information.
  • the movement control unit 84 of the moving body 10 controls the forks 24 to move the object P being transported through a section where the distance to the obstacle area is less than the predetermined distance while positioning the object P at the transport height. In this way, by setting the transport height of the object P, the object P can be transported while suppressing interference with obstacles, for example, even in a narrow area where it is not possible to turn.
  • Figure 20 shows an example where the distance between the approach waypoint WPB and the installation area AR2 as an obstacle area is less than a predetermined distance.
  • the moving body 10 moves along the approach waypoint WPB in the opposite direction to the X direction while lifting the object P being transported to a position higher than the object P on the installation area AR2.
  • the object P on the installation area AR2 is an obstacle
  • the obstacle is not limited to this.
  • the object P on the temporary installation area AR1 may be an obstacle, and the moving body 10 may move while lifting the object P being transported to a position higher than the object P on the temporary installation area AR1.
  • the control method according to the first aspect of the present disclosure is a control method for a moving body 10 capable of normal turning, which turns around the outside of the vehicle body 20 as viewed from the vertical direction (Z direction), and pivot turning, which turns around the inside of the vehicle body 20 as viewed from the vertical direction.
  • This control method includes a step of setting a destination position G of the moving body 10, a step of acquiring movable information indicating a position to which the moving body 10 can move in a working area AR to which the moving body 10 moves, a step of setting a route to the destination position through the movable position based on the destination position G and the movable information, a turning position at which the moving body turns, and a turning mode for normal turning or pivot turning at the turning position, and a step of moving the moving body 10 based on the route, turning position, and turning mode.
  • a turning position and a turning mode are set while a turning path passing through a movable position is set, so that it is possible to move an appropriate route for a moving body 10 capable of pivot turning.
  • the control method according to the second aspect of the present disclosure is the control method according to the first aspect, and in the step of setting the turning position, position information of the obstacle area where the obstacle is located is obtained, and a position on the route whose distance from the obstacle area is equal to or greater than a predetermined threshold is set as the turning position. According to the present disclosure, a position at which the vehicle can turn without interfering with an obstacle can be set as the turning position, so that the vehicle 10 can move along an appropriate route.
  • the control method according to the third aspect of the present disclosure is the control method according to the first or second aspect, and in the step of setting the turning position, the turning mode is set based on the distance from the origin S of the moving body 10 to the destination position G in the step of setting the turning mode. According to the present disclosure, since the turning mode is determined according to the distance to the destination position G, it is possible to move the moving body 10 along an appropriate path.
  • the control method according to the fifth aspect of the present disclosure is a control method according to any one of the first to fourth aspects, and in the step of setting the route, turning position, and turning mode, the shortest route to reach the destination position G is set based on the destination position G and the movable information, a position on the shortest route or within a predetermined distance range from the shortest route is set as the turning position, a first corrected route that can reach the destination position G by turning normally at the turning position is set based on the shortest route, and a second corrected route that can reach the destination position G by turning pivotally at the turning position is set based on the shortest route.
  • the control method according to the sixth aspect of the present disclosure is the control method according to the fifth aspect, and in the step of setting the route, turning position, and turning mode, if the first predicted time is shorter than the second predicted time, normal turning is set as the turning mode, and the first corrected route is set as the route. On the other hand, if the second predicted time is shorter than the first predicted time, pivot turning is set as the turning mode, and the second corrected route is set as the route. According to the present disclosure, it is possible to set a route that allows the target position G to be reached quickly.
  • the path, turning position, and turning mode are set based on the destination position G of the mobile body 10 and the movable information indicating the positions to which the mobile body 10 can move in the working area AR to which the mobile body 10 moves, and the path is a path toward the destination position G through the movable positions. According to the present disclosure, it is possible to move the mobile body 10 capable of pivot turning along an appropriate path.

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

制御方法、プログラム及び移動体
 本開示は、制御方法、プログラム及び移動体に関する。
 自動で移動する移動体が知られている。このような移動体は、一般的に、鉛直方向から見た車体内を回転中心としてその場で旋回する信地旋回ができない構造となっている。ただし、例えば特許文献1には、4輪が駆動しかつ操舵可能とすることで、信地旋回も可能な全方位移動台車が記載されている。
特開2004-348678号公報
 このように信地旋回が可能な移動体は、信地旋回が不可能な移動体に比べて、移動経路などを柔軟に調整できる。そのため、信地旋回が可能な移動体に対して、適切な経路を移動させることが求められている。
 本開示は、信地旋回が可能な移動体に対して、適切な経路を移動させることが可能な制御方法、プログラム及び移動体を提供することを目的とする。
 本開示に係る制御方法は、鉛直方向から見た車体外を回転中心として旋回する通常旋回と、鉛直方向から見た車体内を回転中心として旋回する信地旋回とが可能な移動体の制御方法であって、前記移動体の目的位置を設定するステップと、前記移動体が移動する作業領域において前記移動体が移動可能な位置を示す移動可能情報を取得するステップと、前記目的位置及び前記移動可能情報に基づき、移動可能な位置を通って前記目的位置に向かう経路と、前記移動体が旋回する旋回位置と、前記旋回位置において通常旋回するか信地旋回するかの旋回モードと、を設定するステップと、前記経路、前記旋回位置、及び前記旋回モードに基づいて、前記移動体を移動させるステップと、を含む。
 本開示に係るプログラムは、鉛直方向から見た車体外を回転中心として旋回する通常旋回と、鉛直方向から見た車体内を回転中心として旋回する信地旋回とが可能な移動体の制御方法をコンピュータに実行させるプログラムであって、前記移動体の目的位置を設定するステップと、前記移動体が移動する作業領域において前記移動体が移動可能な位置を示す移動可能情報を取得するステップと、前記目的位置及び前記移動可能情報に基づき、移動可能な位置を通って前記目的位置に向かう経路と、前記移動体が旋回する旋回位置と、前記旋回位置において通常旋回するか信地旋回するかの旋回モードと、を設定するステップと、前記経路、前記旋回位置、及び前記旋回モードに基づいて、前記移動体を移動させるステップと、をコンピュータに実行させる。
 本開示に係る移動体は、鉛直方向から見た車体外を回転中心として旋回する通常旋回と、鉛直方向から見た車体内を回転中心として旋回する信地旋回とが可能な移動体であって、前記移動体の経路と、前記移動体が旋回する旋回位置と、前記旋回位置において通常旋回するか信地旋回するかの旋回モードとを取得する経路取得部と、前記経路、前記旋回位置、及び前記旋回モードに基づいて、前記移動体を移動させる移動制御部と、を含み、前記経路、前記旋回位置、及び前記旋回モードは、前記移動体の目的位置と、前記移動体が移動する作業領域において前記移動体が移動可能な位置を示す移動可能情報とに基づき設定され、前記経路は、移動可能な位置を通って前記目的位置に向かう経路である。
 本開示によれば、信地旋回が可能な移動体に対して、適切な経路を移動させることができる。
図1は、本実施形態に係る移動制御システムの模式図である。 図2は、移動体の構成の模式図である。 図3は、車輪を上面から見た模式図である。 図4は、通常旋回を説明するための模式図である。 図5は、信地旋回を説明するための模式図である。 図6は、管理装置の模式的なブロック図である。 図7は、情報処理装置の模式的なブロック図である。 図8は、移動体の制御装置の模式的なブロック図である。 図9は、経路の一例を示す模式図である。 図10は、経路の一例を示す模式図である。 図11は、予測時間に基づいた設定フローを説明するフローチャートである。 図12は、対象物を設置領域に荷下ろしする場合の例を説明する模式図である。 図13は、設置領域から通行ウェイポイントに移動する例を説明する模式図である。 図14は、対象物を設置領域に荷下ろしする場合の例を説明する模式図である。 図15は、対象物を設置領域に荷下ろしする場合の例を説明する模式図である。 図16は、対象物を設置領域に荷下ろしする場合の例を説明する模式図である。 図17は、仮設置領域から荷積みした対象物を運送車両に荷下ろしする場合の例を説明する模式図である。 図18は、仮設置領域から荷積みした対象物を運送車両に荷下ろしする場合の例を説明する模式図である。 図19は、仮設置領域から荷積みした対象物を運送車両に荷下ろしする場合の例を説明する模式図である。 図20は、目標物を高い位置に保持したまま移動する場合の例を示す模式図である。
 以下に添付図面を参照して、本開示の好適な実施形態を詳細に説明する。なお、この実施形態により本開示が限定されるものではなく、また、実施形態が複数ある場合には、各実施形態を組み合わせて構成するものも含むものである。
 (移動制御システム)
 図1は、本実施形態に係る移動制御システムの模式図である。図1に示すように、本実施形態に係る移動制御システム1は、移動体10と管理装置12と情報処理装置14とを含む。移動制御システム1は、設備Wに所属する移動体10の移動を制御するシステムである。設備Wは、例えば倉庫など、物流管理される設備であるが、移動体10を運用する任意の設備であってよい。移動制御システム1においては、移動体10は、設備W内に配置された内に配置された対象物Pをピックアップして搬送し、別の場所にドロップする。移動体10が搬送する対象物Pは、本実施形態では、パレット上に荷物が積載された搬送対象物である。ただし、対象物Pは、パレット上に荷物が積載されたものに限られず任意の形態であってよく、例えばパレットを有さず荷物のみであってもよい。また、移動体10は、対象物Pを搬送するものにも限られず、設備W内を任意の目的で移動する装置であってよい。
 (作業領域)
 図1に示すように、設備Wには、作業領域ARが設定されている。作業領域ARは、本実施形態の移動体10が作業を行う領域である。作業領域ARは、移動体10が配備されている領域であり、移動体10は、作業領域AR内を移動可能である。ただし、移動体10は、例えば、後述の駐車領域ARVや、対象物Pや固定物P0(例えば設備W内の柱や壁など)が位置している領域については、移動不可能であってよい。なお、駐車領域ARV内に運送車両Vが存在していない期間や、後述の仮設置領域AR1に対象物Pが配置されていない期間においては、移動体10は、駐車領域ARVや仮設置領域AR1を移動可能であってもよい。以降において、作業領域ARに沿った一方向をX方向とし、作業領域ARに沿った方向であって方向Xに交差する方向を、Y方向とする。本実施形態では、Y方向は、X方向に直交する方向である。X方向、Y方向は、水平面に沿った方向といってもよい。また、X方向、Y方向に直交する方向を、より詳しくは鉛直方向の上方に向かう方向を、Z方向とする。また、本実施形態においては、「位置」とは、特に断りのない限り、作業領域AR上の二次元面における座標系(作業領域ARの座標系)における位置(座標)を指す。また、移動体10などの「姿勢(向き)」とは、特に断りのない限り、作業領域ARの座標系における移動体10などの向きであり、Z方向から見た場合に、X方向を0°とした際の移動体10のヨー角(回転角度)を指す。
 作業領域ARは、いわゆるトラックバースであり、運送車両Vが駐車される駐車領域ARVと、移動体10が移動可能な移動領域ARWとを含む。駐車領域ARVは、運送車両Vの駐車用の領域であり、移動領域ARWは、作業領域ARのうちで駐車領域ARV以外の領域である。運送車両Vは、駐車領域ARVに対して予め定められた位置及び姿勢で駐車されることが好ましい。運送車両Vは、搭載した対象物Pを、設備W内外の区間で運送する移動体である。例えば、運送車両Vは、対象物Pを搭載した状態で設備Wに到着して駐車領域ARV内に停車され、搭載した対象物Pが移動体10により搬出される。また、駐車領域ARV内で停車する運送車両Vに、移動体10により対象物Pが搭載される場合もある。運送車両Vは、本実施形態ではトラックであるが、それに限られず、例えば鉄道車両など、対象物Pを搬送する任意の移動体であってよい。運送車両Vには、対象物Pが配置される収納室Vaが設けられている。図1の例では、運送車両Vの両側方に扉Vbが設けられている。移動体10は、扉Vbが開いた状態で、運送車両Vの扉Vbが設けられた側(ここでは側方側)から収納室Vaにアプローチすることで、収納室VA内の対象物Pをピックアップしたり、収納室Va内に対象物Pをドロップしたりする。ただし、運送車両Vは、側方に扉Vbが設けられるものに限られず、運送車両Vの任意の位置(例えば後方)に扉Vbが設けられていてもよい。
 作業領域ARには、対象物Pを配置する仮設置領域AR1も設定されることが好ましい。仮設置領域AR1は、移動領域ARW内の一部の領域に設定される。本実施形態の例では、仮設置領域AR1は、移動領域ARWと同じ高さであるため、移動体10は、対象物Pが配置されてない仮設置領域AR1内に進入可能である。ただしそれに限られず、移動体10は、仮設置領域AR1内に進入不可能であってよい。図1の例では、作業領域ARは、作業領域AR内において、駐車領域ARVのX方向側及びX方向と反対側とに設定される。ただし、仮設置領域AR1の位置及び数は任意であり、駐車領域ARVとは別の任意の位置に設けられてよい。本実施形態では、仮設置領域AR1は、対象物Pの仮置き場である。すなわち例えば、設備Wの稼働状況に応じて、運送車両Vに積まれた対象物Pや、運送車両Vに積まれる予定の対象物Pが、仮設置領域AR1内に仮置きされる場合がある。仮設置領域AR1内に仮置きされた対象物Pは、別の場所(例えば、運送車両Vや、後述する設置領域AR2)に搬送される。ただし、設置領域AR2の用途は仮置き場であることに限られない。設置領域AR2は、対象物Pが設置される任意の用途の領域であってよい。
 仮設置領域AR1は、複数の単位領域Aを含む。単位領域Aとは、対象物Pの設置用に設定された領域であり、対象物Pが設置される可能性がある領域ともいえる。単位領域Aの形状及び大きさは、予め設定されている。図1の例では単位領域Aは矩形であるが、形状及び大きさは任意であってよい。また、単位領域Aは、対象物P毎に区画されており、単位領域Aにはそれぞれ対象物Pが1つ配置される。それぞれの単位領域Aには、設備Wの状況に応じて、対象物Pが配置されている場合もあるし、配置されていない場合もある。図1の例では、仮設置領域AR1には、単位領域AがY方向に並んで設定されているが、仮設置領域AR1内における単位領域Aの並び方及び数は、任意であってよい。
 作業領域ARは、図1の例では1つであるが、複数設けられていてもよい。すなわち例えば、駐車領域ARV及び移動領域ARWを含む作業領域ARが、X方向に並んで複数設定されていてもよい。また、作業領域ARは、駐車領域ARV及び移動領域ARWを含むトラックバースであることに限られず、移動体10が移動する(作業する)任意の領域であってよい。
 本実施形態においては、設備W内には、設置領域AR2が設けられた領域ARaも含まれている。領域ARaは、作業領域AR(移動領域ARW)と隣接する位置に設けられ、図1の例では、作業領域AR(移動領域ARW)のY方向と反対側に位置する。本実施形態では、作業領域AR内の移動体10は、領域ARaに対象物Pをドロップし、領域ARaに配置された対象物Pをピックアップすることは可能であるが、領域ARa内を移動しないことが好ましい。例えば、領域ARaは、作業領域ARよりもZ方向側に位置しており(すなわち作業領域ARよりも高い位置に設定されており)、移動体10が、作業領域AR内から領域ARa内に進入不可能となっている。ただしそれに限られず、作業領域AR内の移動体10が、領域ARa内にも進入可能であってもよく、例えば、領域ARaと作業領域ARとが同じ高さに設定されていてよい。この場合、例えば領域ARaのY方向と反対方向の奥に、対象物Pの保管エリアがある場合には、作業領域ARで対象物Pをピックアップした移動体10により、対象物Pをその保管エリアまで搬送してもよい。
 設置領域AR2は、領域ARaに設けられた、対象物Pを配置するための領域である。例えば、作業領域AR内の移動体10は、運送車両Vや仮設置領域AR1からピックアップした対象物Pを、設置領域AR2にドロップする。また、作業領域AR内の移動体10は、設置領域AR2に配置された対象物Pをピックアップして、運送車両Vや仮設置領域AR1に搬送する。本実施形態では、設置領域AR2は仮置き場であり、移動体10により設置領域AR2にドロップされた対象物Pは、領域ARaに配備された別の移動体などにより、別の保管場所に搬送される。また、移動体10がピックアップする設置領域AR2上の対象物Pは、領域ARaに配備された別の移動体などにより、領域ARa内の別の場所から、設置領域AR2に搬送される。ただし、設置領域AR2の用途は仮置き場であることに限られない。設置領域AR2は、対象物Pが設置される任意の用途の領域であってよい。
 設置領域AR2は、複数の単位領域Aを含む。図1の例では、設置領域AR2には、単位領域AがX方向に並んで設定されているが、設置領域AR2内における単位領域Aの並び方及び数は、任意であってよい。
 (ウェイポイント)
 作業領域ARには、位置(座標)毎にウェイポイントWPが設定されている。後述する移動体10の第1経路R1は、ウェイポイントWPを繋ぐように設定される。すなわち、移動体10が通過を予定するウェイポイントWPを接続する経路が、移動体10の第1経路R1となる。ウェイポイントWPは、作業領域ARのレイアウトに応じて設定される。例えば、ウェイポイントWPは、移動領域ARW内においてマトリクス状に設定されてよい。また、駐車領域ARV内において対象物Pが配置される位置は、運送車両Vの収納室Va内での対象物Pが配置される位置と対応するように、予め設定されている。そのため、ウェイポイントWPは、走行領域ARW内において、駐車領域ARV内で対象物Pが配置される位置に対応する位置にも、設定される。また、ウェイポイントWPは、走行領域ARW内において、仮設置領域AR1の単位領域A毎に設定されることが好ましい。例えば、それぞれの単位領域Aに対応する位置(座標)に、ウェイポイントWPが設定されている。例えば、それぞれの単位領域Aに対応する位置(座標)に、ウェイポイントWPが設定されている。単位領域Aに対応する位置(ウェイポイントWPが設定される位置)は、適宜設定されてよく、例えば、単位領域Aと重なる任意の位置であってよい。また、ウェイポイントWPは、作業領域AR内において、設置領域AR2の単位領域A毎に設定され、それぞれの単位領域Aに対応する位置(座標)に設定されてよい。
 本実施形態の例では、図1に示すように、駐車領域ARVに対応するウェイポイントWPがY方向に並んでおり、それらのウェイポイントWPに対してアプローチできる側(図9の例ではX方向側及びX方向と反対側)に、Y方向に並ぶウェイポイントWPである通行路ウェイポイントWPAが設定されている。また、通行路ウェイポイントWPAのうちの最もY方向と反対側のウェイポイントWPから、X方向に沿って、複数のウェイポイントWPであるアプローチウェイポイントWPBが設定されている。アプローチウェイポイントWPBのY方向と反対側には、仮設置領域AR1に対応するウェイポイントWPが設定されている。
 (移動体)
 図2は、移動体の構成の模式図である。移動体10は、自動で移動可能な装置である。本実施形態では、移動体10は、対象物を搬送可能な装置である。さらに言えば、本実施形態では、移動体10は、フォークリフトであり、より詳しくはいわゆるAGV(Automated Guided Vehicle)やAGF(Automated Guided Forklift)である。ただし、移動体10は、対象物を搬送するフォークリフトであることに限られず、自動で移動可能な任意な装置であってよい。
 図2に示すように、移動体10は、車体20と、車輪20Aと、ストラドルレッグ21と、マスト22と、フォーク24と、センサ26Aと、制御装置28とを備えている。ストラドルレッグ21は、車体20の前後方向における一方の端部に設けられて、車体20から突出する一対の軸状の部材である。マスト22は、ストラドルレッグ21に移動可能に取り付けられ、車体20の前後方向に移動する。マスト22は、前後方向に直交する上下方向(ここでは方向Z)に沿って延在する。フォーク24は、マスト22に方向Zに移動可能に取付けられている。フォーク24は、マスト22に対して、車体20の横方向(上下方向及び前後方向に交差する方向)にも移動可能であってよい。フォーク24は、一対のツメ24A、24Bを有している。ツメ24A、24Bは、マスト22から車体20の後方向に向けて延在している。ツメ24Aとツメ24Bとは、マスト22の横方向に、互いに離れて配置されている。以下、前後方向のうち、移動体10においてフォーク24が設けられていない側の方向を、前方向とし、フォーク24が設けられている側の方向を、後方向とする。
 センサ26Aは、車体20の周辺に存在する対象物の位置及び姿勢の少なくとも1つを検出する。センサ26Aは、移動体10に対する対象物の位置と、移動体10に対する対象物の姿勢との少なくとも一方を検出するともいえる。本実施形態では、センサ26Aは、それぞれのストラドルレッグ21の後方向における先端と、車体20の前方向側とに設けられている。ただし、センサ26Aの設けられる位置はこれに限られず、任意の位置に設けられてもよいし、設けられる数も任意であってよい。例えば、センサ26Aは、マスト22の上端に設けられていてもよい。
 センサ26Aは、例えばレーザ光を照射するセンサである。センサ26Aは、一方向(ここでは横方向)に走査しつつレーザ光を照射し、照射したレーザ光の反射光から、対象物の位置及び向きを検出する。すなわち、センサ26Aは、いわゆる2次元(2D)-LiDAR(Light Detection And Ranging)であるともいえる。ただし、センサ26Aは、以上のものに限られず任意の方法で対象物を検出するセンサであってよく、例えば、複数の方向に走査されるいわゆる3次元(3D)-LiDARであってもよいし、走査されない、いわゆる1次元(1D)-LiDARであってもよいし、カメラであってもよい。
 制御装置28は、移動体10の移動を制御する。制御装置28については後述する。
 図3は、車輪を上面から見た模式図である。図2及び図3に示すように、移動体10は、車輪20Aとして、車輪20A1、20A2、20A3を有する。
 図3に示すように、本実施形態の例では、車輪20A1は、駆動が不可能であり、操舵が可能な車輪である。ここでの駆動とは、例えばモータなどの駆動源と接続されて、駆動源からの動力で自律的に回転できることを指す。従って、車輪20A1は、自律的に回転できない車輪である。また、ここでの操舵(ステアリング)とは、Z方向から見た場合の、移動体10(車体20)に対する車輪の向き(回転角度)が、変更可能であることを指す。従って、車輪20A1は、移動体10に対して向きを変更可能である。車輪20A1は、ストラドルレッグ21に取り付けられ、より詳しくはストラドルレッグ21の先端部分に取り付けられる。ただし、車輪20A1の移動体10における取り付け位置は、ストラドルレッグ21に限られず、任意であってよい。
 図3に示すように、本実施形態の例では、車輪20A2は、車輪20A1と同様、駆動が不可能であり、操舵が可能な車輪である。そのため、車輪20A2は、移動体10に対して向きを変更可能である。車輪20A2は、車輪20A1とは反対側のストラドルレッグ21に取り付けられ、より詳しくはストラドルレッグ21の先端部分に取り付けられる。ただし、車輪20A2の移動体10における取り付け位置は、ストラドルレッグ21に限られず、任意であってよい。
 図3に示すように、本実施形態の例では、車輪20A3は、駆動が可能であり、操舵が可能な車輪である。すなわち、車輪20A3は、自律的に回転できる車輪であり、かつ、移動体10に対して向きを変更可能である。車輪20A3は、移動体10において、車輪20A1及び車輪20A2に対して、前方向側(フォーク24が設けられない側)に設けられている。本実施形態において、車輪20A3は、左右方向において、車輪20A1と車輪20A2との間の位置(ここでは中点位置)に設けられている。また、車輪20A3は、車体20に取り付けられ、より詳しくは車体20の前方向側の箇所に取り付けられる。だし、車輪20A3の移動体10における取り付け位置は、任意であってよい。
 (旋回モード)
 このように、本実施形態の例では、移動体10は、車輪20A1、20A2の操舵が可能であり、かつ、車輪20A3の操舵及び駆動が可能である。そのため、移動体10は、後述する通常旋回及び信地旋回が可能である。さらに言えば、移動体10は、前方向又は後方向を進行方向として移動可能であるだけでなく、車体20の任意の方向(例えば左右方向や斜め方向)を進行方向としても移動可能である。ただし、移動体10は、通常旋回及び信地旋回が可能であり、かつ、車体20の任意の方向(例えば左右方向や斜め方向)を進行方向として移動可能であれば、車輪20A1、20A2の操舵が可能であり、車輪20A3の操舵及び駆動が可能な構成であることに限られない。例えば、車輪20Aが2つ以上の任意の個数であり、全ての車輪20Aが操舵可能で、少なくとも1つの車輪20Aが駆動及び操舵可能であってよい。例えば、車輪20A1、20A2が駆動及び操舵可能で、車輪20A3が駆動不可能であり操舵可能、という構成であってもよい。また例えば、車輪20Aの数が4つ以上であり、全ての車輪20Aが操舵可能で、少なくとも1つの車輪20Aが駆動及び操舵可能であってよい。
 (通常旋回)
 図4は、通常旋回を説明するための模式図である。旋回モードの1つである通常旋回とは、移動体10が、Z方向から見た車体20(移動体10)外を回転中心として旋回する(外部の回転中心に対して公転する)旋回モードを指す。すなわち、図4に示すように、移動体10が旋回する際の軌跡の中心位置を回転中心Cとすると、通常旋回は、車体20(移動体10)が占める領域の外側の位置を回転中心Cとして、移動体10が旋回する(進行方向を変化させる)ことを指す。通常旋回は、任意の方法で実現されてよい。例えば、車輪20A3を、曲がる方向側に向きが変更されるように操舵しつつ駆動して、車輪20A1、20A2を、操舵しない(向きを進行方向に追従させる)ことより、通常旋回を実現してよい。
 (信地旋回)
 図5は、信地旋回を説明するための模式図である。旋回モードの1つである信地旋回とは、移動体10が、Z方向から見た車体20(移動体10)内を回転中心として旋回する(内部の回転中心を中心として自転する)旋回モードを指す。すなわち、図5に示すように、移動体10が旋回する際の軌跡の中心位置を回転中心Cとすると、信地旋回は、車体20(移動体10)が占める領域の内側の位置を回転中心Cとして、移動体10が旋回する(進行方向を変化させる)ことを指す。信地旋回は、任意の方法で実現されてよい。例えば、車輪20A1~20A3を、曲がる方向側に向きが変更されるように操舵しつつ、車輪20A3を駆動することより、信地旋回を実現してよい。
 また、車体20の任意の方向を進行方向として移動させる場合には、例えば、進行方向を向かせたい車体20の向きに車輪20A1~20A3を、進行方向に向くように操舵しつつ、車輪20A3を駆動させてよい。
 (管理装置)
 図6は、管理装置の模式的なブロック図である。管理装置12は、設備Wにおける物流を管理するシステムである。管理装置12は、本実施形態ではWCS(Warehouse Control System)やWMS(Warehouse Management System)であるが、WCS及びWMSに限られず任意のシステムであってよく、例えば、その他の生産管理系システムのようなバックエンドシステムでも構わない。管理装置12が設けられる位置は任意であり、設備W内に設けられてもよいし、設備Wから離れた位置に設けられて、離れた位置から設備Wを管理するものであってもよい。管理装置12は、コンピュータであり、図6に示すように、通信部30と記憶部32と制御部34とを含む。
 通信部30は、制御部34に用いられて、情報処理装置14などの外部の装置と通信するモジュールであり、例えばアンテナやなどを含んでよい。通信部30による通信方式は、本実施形態では無線通信であるが、通信方式は任意であってよい。記憶部32は、制御部34の演算内容やプログラムなどの各種情報を記憶するメモリであり、例えば、RAM(Random Access Memory)と、ROM(Read Only Memory)のような主記憶装置と、HDD(Hard Disk Drive)などの外部記憶装置とのうち、少なくとも1つ含む。
 制御部34は、演算装置であり、例えばCPU(Central Processing Unit)などの演算回路を含む。制御部34は、目的位置設定部40と移動可能情報取得部42とを含む。制御部34は、記憶部32からプログラム(ソフトウェア)を読み出して実行することで、目的位置設定部40と移動可能情報取得部42とを実現して、それらの処理を実行する。なお、制御部34は、1つのCPUによって処理を実行してもよいし、複数のCPUを備えて、それらの複数のCPUで、処理を実行してもよい。また、目的位置設定部40と移動可能情報取得部42との少なくとも一部を、ハードウェア回路で実現してもよい。また、記憶部32が保存する制御部34用のプログラムは、管理装置12が読み取り可能な記録媒体に記憶されていてもよい。
 目的位置設定部40は、移動体10の移動先である目的位置Gを設定する。移動可能情報取得部42は、作業領域AR内において移動体10が移動可能な位置を示す移動可能情報を取得する。これらの具体的な処理内容については後述する。
 なお、管理装置12は、目的位置Gの設定と障害物情報の取得以外の処理も実行してよい。例えば、管理装置12は、設備Wに設けられる移動体10以外の機構(例えばエレベータや扉など)を制御する情報も設定してよい。
 (情報処理装置)
 図7は、情報処理装置の模式的なブロック図である。情報処理装置14は、移動体10の移動に関する情報などを処理する装置である。情報処理装置14は、例えばFCS(Fleet Control System)であるが、それに限られず、移動体10の移動に関する情報を処理する任意の装置であってよい。情報処理装置14は、コンピュータであり、図7に示すように、通信部50と記憶部52と制御部54とを含む。通信部50は、制御部54に用いられて、管理装置12や移動体10などの外部の装置と通信するモジュールであり、例えばアンテナなどを含んでよい。通信部50による通信方式は、本実施形態では無線通信であるが、通信方式は任意であってよい。記憶部52は、制御部54の演算内容やプログラムなどの各種情報を記憶するメモリであり、例えば、RAMと、ROMのような主記憶装置と、HDDなどの外部記憶装置とのうち、少なくとも1つ含む。
 制御部54は、演算装置であり、例えばCPUなどの演算回路を含む。制御部54は、目的位置取得部60と、移動可能情報取得部62と、第1経路設定部64とを含む。制御部54は、記憶部52からプログラム(ソフトウェア)を読み出して実行することで、目的位置取得部60と移動可能情報取得部62と第1経路設定部64とを実現して、それらの処理を実行する。なお、制御部54は、1つのCPUによってこれらの処理を実行してもよいし、複数のCPUを備えて、それらの複数のCPUで、処理を実行してもよい。また、目的位置取得部60と移動可能情報取得部62と第1経路設定部64の少なくとも一部を、ハードウェア回路で実現してもよい。また、記憶部52が保存する制御部54用のプログラムは、情報処理装置14が読み取り可能な記録媒体に記憶されていてもよい。
 目的位置取得部60は、目的位置Gの情報を取得し、移動可能情報取得部62は、移動可能情報を取得し、第1経路設定部64は、移動体10の第1経路R1を設定する。これらの具体的な処理内容については後述する。
 なお、本実施形態では、管理装置12と情報処理装置14とが別の装置であったが、一体の装置であってもよい。すなわち、管理装置12が情報処理装置14の少なくとも一部の機能を兼ね備えてよいし、情報処理装置14が管理装置12の少なくとも一部の機能を兼ね備えてよい。
 (移動体の制御装置)
 次に、移動体10の制御装置28について説明する。図8は、移動体の制御装置の模式的なブロック図である。制御装置28は、移動体10を制御する装置である。制御装置28は、コンピュータであり、図8に示すように、通信部70と記憶部72と制御部74とを含む。通信部70は、制御部74に用いられて、情報処理装置14などの外部の装置と通信するモジュールであり、例えばアンテナなどを含んでよい。通信部70による通信方式は、本実施形態では無線通信であるが、通信方式は任意であってよい。記憶部72は、制御部74の演算内容やプログラムなどの各種情報を記憶するメモリであり、例えば、RAMと、ROMのような主記憶装置と、HDDなどの外部記憶装置とのうち、少なくとも1つ含む。
 制御部74は、演算装置であり、例えばCPUなどの演算回路を含む。制御部74は、第1経路取得部80と、第2経路設定部82と、移動制御部84とを含む。制御部74は、記憶部72からプログラム(ソフトウェア)を読み出して実行することで、第1経路取得部80と第2経路設定部82と移動制御部84とを実現して、それらの処理を実行する。なお、制御部74は、1つのCPUによってこれらの処理を実行してもよいし、複数のCPUを備えて、それらの複数のCPUで、処理を実行してもよい。また、第1経路取得部80と第2経路設定部82と移動制御部84との少なくとも一部を、ハードウェア回路で実現してもよい。また、記憶部72が保存する制御部74用のプログラムは、制御装置28が読み取り可能な記録媒体に記憶されていてもよい。
 第1経路取得部80は、第1経路R1の情報を取得し、第2経路設定部82は、第1経路R1に基づいて第2経路R2を設定し、移動制御部84は、移動体10の駆動部やステアリングなどの移動機構を制御して、移動体10の移動を制御する。これらの具体的な処理内容については後述する。
 (移動制御システムの処理)
 移動制御システム1の処理内容について、以下で説明する。
 (目的位置の設定)
 管理装置12の目的位置設定部40は、移動体10の移動先である目的位置Gを設定する。本実施形態では、移動体10が作業領域AR内を移動することを例にして説明するため、目的位置設定部40は、移動先となる作業領域AR内の位置を、目的位置Gに設定する。例えば、目的位置設定部40は、移動先となる作業領域AR内の位置に対応するウェイポイントWPGを選択して、目的位置Gとして設定する。目的位置設定部40は、作業領域AR内の任意の位置(ウェイポイントWP)を目的位置Gとしてよく、例えば、搬送すべき対象物Pと、対象物Pの搬送元及び搬送先とを示す、予め設定されたオーダー情報に基づいて、目的位置GとするウェイポイントWPを設定してよい。
 管理装置12は、設定した目的位置Gの位置情報を、情報処理装置14に送信する。すなわち、情報処理装置14の目的位置取得部60は、管理装置12の目的位置設定部40が設定した目的位置Gの位置情報を取得するといえる。目的位置Gの位置情報は、目的位置Gの位置を示す任意の情報であってよく、例えば目的位置Gの座標を示す情報でもよいし、目的位置Gに対応するウェイポイントWPGの識別子を示す情報であってよい。
 (移動可能情報の取得)
 管理装置12の移動可能情報取得部42は、作業領域AR内で移動体10が移動可能な位置を示す移動可能情報を取得する。移動可能情報は、その移動体10が移動を予定する時間帯において、移動体10が移動可能な位置(ここではウェイポイントWP)を示す情報である。移動可能情報は、動的には変化しない設備Wのレイアウト情報(固定物P0の位置や通路幅など)と、動的に変化する障害物(仮設置領域AR1における対象物Pや、駐車領域ARVにおける運送車両V)の有無から求められる、移動体10が移動可能な場所を指す。移動可能情報は、レイアウト情報及び障害物の有無に加えて、さらに、移動体10の車両仕様の情報(移動体10の大きさなどの情報)にも基づき、設定されてよい。
 移動可能情報取得部42は、任意の方法で移動可能情報を取得してよい。例えば、移動可能情報取得部42は、設備W(作業領域AR)の地図情報から、動的には変化しない固定物P0の位置情報(設備Wのレイアウト情報)を取得する。また、移動可能情報取得部42は、移動体10が移動を予定する時間帯における、障害物(仮設置領域AR1における対象物Pや、駐車領域ARVにおける運送車両V)の有無を示す障害物情報を取得する。そして、移動可能情報取得部42は、設備Wの地図情報が示す固定物P0の位置と、障害物情報が示す障害物の位置とを、障害物領域として設定して、障害物領域に対して所定距離以上となる位置(ウェイポイントWP)を、移動可能な位置としてよい。また、移動可能情報取得部42は、移動体10が移動を予定する時間帯における、他の移動体の移動経路(第1経路R1)として設定されている位置(ウェイポイントWP)を示す他移動体情報を取得してよい。そして、移動可能情報取得部42は、設備Wの地図情報が示す固定物P0の位置と、障害物情報が示す障害物の位置と、他移動体情報が示す他の移動体10の移動経路の位置とを、障害物領域として設定してよい。なお、障害物領域に対する所定距離は、任意に設定されてよいが、例えば、上述の移動体10の車両仕様の情報に基づき設定されてよい。
 管理装置12は、取得した移動可能情報を、情報処理装置14に送信する。すなわち、情報処理装置14の移動可能情報取得部62は、管理装置12から、移動可能情報を取得するといえる。
 (第1経路と旋回位置と旋回モードの設定)
 図9及び図10は、経路の一例を示す模式図である。情報処理装置14の第1経路設定部64は、目的位置Gの位置情報と移動可能情報とに基づき、移動体10の第1経路R1と旋回位置と旋回モードとを設定する。第1経路R1は、レイアウトパスと呼んでもよい。第1経路設定部64は、移動可能情報が示す移動可能な位置を通って、目的位置Gに向かう経路を、第1経路R1として設定する。本実施形態では、第1経路設定部64は、移動体10の移動元Sから移動可能な位置を通って目的位置Gまで到達する、各ウェイポイントWPを繋ぐ経路を、第1経路R1として設定する。すなわち、第1経路設定部64は、移動元Sに対応するウェイポイントWP0から、移動可能情報が示す移動可能なウェイポイントWPを通って、目的位置Gに対応するウェイポイントWPGまでを繋ぐ経路を、第1経路R1として設定する。移動元Sの位置は任意に設定されてよく、例えば移動体10が移動を開始する位置に最も近いウェイポイントWPを、移動元Sとして設定してもよい。
 第1経路設定部64は、第1経路R1上の各位置(ウェイポイントWP)と、第1経路R1から所定距離範囲内の位置(ウェイポイントWP)のうちから、移動体10が旋回する位置である旋回位置を設定(選択)する。第1経路設定部64は、第1経路R1上、及び第1経路R1から所定距離範囲内の任意の位置を、旋回位置に設定してよい。例えば、第1経路設定部64は、障害物領域の位置情報を取得して、第1経路R1上及び第1経路R1から所定距離範囲内の各位置のうちで障害物領域との距離が所定の閾値(例えば旋回により障害物と干渉しない程度の距離)以上となる位置を、旋回位置として設定してよい。この場合例えば、第1経路設定部64は、障害物領域の位置情報と第1経路R1の位置情報とから、各位置と障害物領域との距離を算出する。そして、第1経路設定部64は、各位置のうちで、障害物領域との距離が所定の閾値以上となる位置を、旋回位置として設定する。なお、各位置(すなわち移動可能情報が示す移動可能な位置)について、障害物領域までの距離が予め算出されていてもよい。
 (旋回モードの設定)
 第1経路設定部64は、旋回位置における旋回モードを設定する。旋回モードとは、旋回位置においてどのように旋回するかを示す情報であり、旋回位置において通常旋回するか信地旋回するかを示す情報といえる。第1経路設定部64は、任意の方法で旋回モードを設定してよい。例えば、第1経路設定部64は、旋回位置において通常旋回した場合に移動体10が通る領域である通常旋回領域の情報と、旋回位置において信地旋回した場合に移動体10が通る領域である信地旋回領域の情報とを取得する。通常、信地旋回よりも通常旋回の方が、移動体10が大きく膨らむ経路をとるため、信地旋回領域よりも通常旋回領域の方が広くなる。そのため例えば、第1経路設定部64は、通常旋回領域と障害物領域との距離が所定の閾値(例えば旋回により障害物と干渉しない程度の距離)以上である場合には、通常旋回が可能であるとして、通常旋回すると設定してよい。また、第1経路設定部64は、通常旋回領域と障害物領域との距離が所定の閾値未満であるが、信地旋回領域と障害物領域との距離が所定の閾値以上である場合には、通常旋回できないが信地旋回できるとして、信地旋回すると設定してよい。なお、通常旋回領域や信地旋回領域は、任意に算出されてよく、例えば、通常旋回や信地旋回によって移動体10がはみ出す距離が予め算出されており、設定した旋回位置からそれらの距離だけ離れた位置までの領域を、通常旋回領域や信地旋回領域としてよい。
 また、第1経路設定部64は、移動元Sから目的位置Gまでの距離に基づき、旋回モードを設定してもよい。この場合例えば、第1経路設定部64は、移動元Sから目的位置Gまでの距離が所定の閾値以上である場合には、通常旋回すると設定し、移動元Sから目的位置Gまでの距離が所定の閾値未満である場合には、信地旋回すると設定してよい。このように旋回モードを設定することで、目的位置Gまでの距離が十分にある場合には、通常旋回として目的位置Gに早く到着できる。また、目的位置Gまでの距離が十分にない場合には、信地旋回とすることで、通常旋回するために遠回りすることなく目的位置Gに到着できる。なおこの場合、第1経路設定部64は、移動元Sから目的位置Gまでの距離に加えて、旋回を予定する領域における通路幅(旋回位置と障害物領域との距離)にも基づき、旋回モードを設定してもよい。この場合例えば、第1経路設定部64は、移動元Sから目的位置Gまでの距離が所定の閾値以上であり、かつ、通常旋回領域と障害物領域との距離が所定の閾値以上である場合には、通常旋回が可能であるとして、通常旋回すると設定してよい。一方、移動元Sから目的位置Gまでの距離が所定の閾値以上ではあるが、通常旋回領域と障害物領域との距離が所定の閾値未満である場合には、通常旋回が不可能であるとして、信地旋回すると設定してよい。
 また、第1経路設定部64は、旋回後の移動体10の進行方向も設定してよい。すなわち、第1経路設定部64は、設定した旋回モードによって旋回させることで、移動体10の進行方向をどの向きとするかを設定してよい。第1経路設定部64は、旋回位置と目的位置Gとの位置関係に基づき、例えば移動体10が目的位置Gに向かう方向を向くように、旋回後の移動体10の進行方向を設定してよい。また、第1経路設定部64は、旋回位置と目的位置Gとの位置関係に基づき、旋回時において進行方向を向かせる車体20の向きも設定してよい。すなわち例えば、第1経路設定部64は、通常旋回とした場合には、移動体10を切り返しつつ(進行方向を向かせる車体20の向きを変更させつつ)旋回させるか、又は切り返さずに旋回させるかを、設定する。また例えば、第1経路設定部64は、信地旋回とした場合には、旋回後に進行方向を向かせる車体20の向きを、設定する。
 図9の例では、移動元Sに対応するウェイポイントWP0からウェイポイントWP1aを経てウェイポイントWP1bまで到達する区間と、ウェイポイントWP1aからウェイポイントWPG(目的位置G)までの区間とを含むように、第1経路R1が設定されている。ウェイポイントWP1aは、ウェイポイントWP0のY方向にあり、ウェイポイントWP1bは、ウェイポイントWP1aのY方向に隣接し、ウェイポイントWPGは、ウェイポイントWP1aのX方向側に位置して、駐車領域ARVに対応するウェイポイントWPである。そして、図9の例では、ウェイポイントWP1bが旋回位置である旨と、ウェイポイントWP1bで切り返しつつ通常旋回する旨(車体20の後方向を進行方向に向かせる旨)とが、設定されている。
 また、図10の例では、移動元Sに対応するウェイポイントWP0からウェイポイントWP1aまでの区間と、ウェイポイントWP1aからウェイポイントWPG(目的位置G)までの区間とを含むように、第1経路R1が設定されている。そして、図10の例では、ウェイポイントWP1aが旋回位置である旨と、ウェイポイントWP1aで信地旋回して車体20の後方向を進行方向に向かせる旨とが、設定されている。
 情報処理装置14は、設定した第1経路R1の情報を、移動体10に送信する。すなわち、移動体10の第1経路取得部80は、情報処理装置14により設定された第1経路R1の情報を取得する。第1経路R1の情報とは、第1経路R1の位置を示す任意の情報であってよいが、本実施形態では、第1経路R1に含まれるウェイポイントWPの位置情報であってよい。
 このように、本実施形態においては、情報処理装置14が第1経路R1を設定するが、第1経路R1の設定主体は、情報処理装置14に限られず任意であってよい。例えば、移動体10の第1経路取得部80が、上記と同様の方法で、第1経路R1を設定してよい。
 (第2経路の設定)
 移動体10の第2経路設定部82は、第1経路R1と旋回位置と旋回モードとに基づき、第2経路R2を設定する。第2経路R2は、グローバルパスとも呼べる。より詳しくは、第2経路設定部82は、第1経路R1、旋回位置、及び旋回モードと、移動体10の車両仕様の情報とに基づき、第2経路R2を設定する。車両仕様の情報とは、例えば、移動体10の大きさや最小旋回半径など、移動体10が移動可能な経路に影響を及ぼす仕様である。第2経路R2は、移動体10による追従が可能であり、かつ、第1経路R1に対して所定距離内を通りつつ、移動体10が移動可能な位置を通って目的位置Gに向かう経路となる。さらに言えば、第2経路R2は、第1経路R1において設定された旋回位置から所定距離範囲内の位置で、設定された旋回モードで旋回しつつ、移動体10が移動可能な位置を通って目的位置Gに向かう経路となる。
 図9の例では、第2経路R2は、ウェイポイントWP0からウェイポイントWP1bまでY方向に延在する区間と、ウェイポイントWP1bで通常旋回で切り返してウェイポイントWPGに到達する区間とを含むように、設定される。また、図10の例では、第2経路R2は、ウェイポイントWP0からウェイポイントWP1aまでY方向に延在する区間と、ウェイポイントWP1aで信地旋回して車体20の後方向をウェイポイントWPGに向かせて、ウェイポイントWP1aからウェイポイントWPGまでを繋ぐ区間とを含むように、設定される。
 (移動体の移動)
 移動体10の移動制御部84は、第2経路R2に従って、移動体10を移動させる。移動制御部84は、移動体10の位置情報を逐次把握することで、第2経路R2を通るように、移動体10を移動させる。移動体10の位置情報の取得方法は任意であるが、例えば本実施形態では、設備Wに図示しない検出体が設けられており、移動制御部84は、検出体の検出に基づき移動体10の位置及び姿勢の情報を取得する。具体的には、移動体10は、検出体に向けてレーザ光を照射し、検出体によるレーザ光の反射光を受光して、設備Wにおける自身の位置及び姿勢を検出する。移動体10の位置及び姿勢の情報の取得方法は、検出体を用いることに限られず、例えば、SLAM(Simultaneous Localization And Mapping)を用いてもよい。
 図9の例では、移動体10は、ウェイポイントWP0からウェイポイントWP1bまで、フォーク24が設けられない前方向を進行方向として、Y方向に移動する。そして、移動体10は、ウェイポイントWP1bでフォーク24が設けられる後方向を進行方向とするように切り返して、通常旋回しつつウェイポイントWPGまで移動する。図10の例では、移動体10は、ウェイポイントWP0からウェイポイントWP1aまで、フォーク24が設けられない前方向を進行方向として、Y方向に移動する。そして、移動体10は、ウェイポイントWP1aで、フォーク24が設けられる後方向を進行方向とするように信地旋回して、ウェイポイントWP1aからウェイポイントWPGまでX方向に移動する。
 なお、図9及び図10の例では、目的位置Gに対応する収納室Vaに、搬送対象となる対象物Pが配置されている。そのため、移動制御部84は、移動体10が目的位置GであるウェイポイントWPGまで到達したら、フォーク24を制御することで、目的位置Gに設けられた対象物Pの開口Pbにフォーク24を挿入して、対象物Pをピックアップ(荷取り)する。なおこの場合、移動制御部84は、ウェイポイントWPGから、又は、ウェイポイントWPGに到達する前の位置から、センサ26Aによって対象物Pの前面Paの位置及び姿勢を検出させてもよい。そして、移動制御部84は、対象物Pの前面Paの位置及び姿勢に基づいて、対象物Pまでの第3経路を設定して、その第3経路に従って対象物Pにアプローチして、対象物Pをピックアップしてもよい。すなわちこの場合、移動制御部84は、検出した対象物Pの位置及び姿勢に対して、所定の位置及び姿勢(移動体10が対象物Pをピックアップ可能な位置及び姿勢)となる第3経路を設定して、その第3経路に従って対象物Pにアプローチしてもよい。また例えば、移動制御部84は、対象物Pの位置及び姿勢の検出結果と、移動体10の位置及び姿勢の検出結果とに基づき、フィードバック制御(直接フィードバック制御)を行うことで、移動体10を対象物Pにアプローチさせてもよい。この場合、対象物Pの位置及び姿勢に基づいた第3経路に従ったアプローチ中に、直接フィードバック制御に切り替えてもよい。
 (第1経路R1、旋回位置、旋回モードの設定の具体例)
 以降において、第1経路R1、旋回位置、及び旋回モードの設定の具体例について説明する。
 (予測時間に基づいた設定例)
 本例においては、第1経路設定部64は、目的位置Gまで到達するための予測時間に基づき、第1経路R1、旋回位置、及び旋回モードを設定する。具体的には、第1経路設定部64は、目的位置及び移動可能情報に基づき、第1経路R1及び旋回位置を設定する。そして、第1経路設定部64は、設定した第1経路R1に基づいた経路(本例では第2経路R2)を用いて、設定した旋回位置において通常旋回しつつ、目的位置Gに到達するのに必要な予測時間である、第1予測時間を算出する。同様に、第1経路設定部64は、設定した第1経路R1に基づいた経路(本例では第2経路R2)を用いて、設定した旋回位置において信地旋回しつつ、目的位置Gに到達するのに必要な予測時間である、第2予測時間を算出する。第1経路設定部64は、第1予測時間と第2予測時間とに基づいて、通常旋回とするか信地旋回とするかを決定する。例えば、第1経路設定部64は、第1予測時間が第2予測時間より短い場合には通常旋回として、第2予測時間が第1予測時間より短い場合には信地旋回とする。なお、第1予測時間と第2予測時間とは、第1経路R1の長さと、旋回モードとに基づき算出される。例えば、第1経路R1の単位長さの移動に要する時間と、通常旋回及び信地旋回に要する時間とが予め設定されており、第1経路設定部64は、設定した第1経路R1や旋回モードと、これらの時間とに基づき、第1予測時間と第2予測時間を算出してよい。
 予測時間に基づいた設定方法のより好ましい具体例を説明する。図11は、予測時間に基づいた設定フローを説明するフローチャートである。図11に示すように、本例においては、情報処理装置14は、目的位置取得部60及び移動可能情報取得部62により、目的位置Gと移動可能情報とを取得する(ステップS10)。情報処理装置14の第1経路設定部64は、目的位置Gと移動可能情報とに基づき、仮の第1経路R1として、移動可能な位置を通りつつ目的位置Gに到達可能な最短経路を設定する(ステップS12)。すなわち、移動可能な位置(ウェイポイントWP)を通りつつ目的位置Gに到達する経路は、複数設定できる場合もあるが、本例では、第1経路設定部64は、それらの経路のうちで最短となる経路を、最短経路として設定する。
 そして、第1経路設定部64は、最短経路に基づき、旋回位置を設定する(ステップS14)。この場合例えば、第1経路設定部64は、最短経路上、及び最短経路から所定距離範囲内の各位置から、旋回位置を設定(選択)する。旋回位置の設定方法は、上述の実施形態で説明した方法と同じであってよい。すなわち例えば、第1経路設定部64は、最短経路上及び最短経路から所定距離範囲内の各位置のうちで、障害物領域との距離が所定の閾値以上となる位置を、その位置で旋回可能であるとして、旋回位置としてよい。第1経路設定部64は、旋回可能と判断した位置(例えば障害物領域との距離が所定の閾値以上となる位置)が複数ある場合には、それらの全てを仮の旋回位置としてよい。
 そして、第1経路設定部64は、設定した旋回位置でとり得る旋回モードを設定する(ステップS16)。すなわち、第1経路設定部64は、設定した旋回位置において、通常旋回が可能であるかと、信地旋回が可能であるかと、を判断する。第1経路設定部64は、通常旋回が可能と判断した場合には、通常旋回をとり得る旋回モードとして設定し、信地旋回が可能と判断した場合には、信地旋回をとり得る旋回モードとして設定する。なお、両方の旋回が可能と判断した場合、第1経路設定部64は、通常旋回及び信地旋回の両方を、とり得る旋回モードとして設定する。第1経路設定部64は、設定した旋回位置のそれぞれについて、とり得る旋回モードを設定する。なお、通常旋回及び信地旋回が可能であるかの判断方法は、上述の実施形態で説明した方法と同じであってよい。すなわち例えば、第1経路設定部64は、通常旋回領域と障害物領域との距離が所定の閾値以上である場合には、通常旋回が可能であると判断してよく、信地旋回領域と障害物領域との距離が所定の閾値以上である場合には、信地旋回が可能であると判断してよい。
 第1経路設定部64は、設定した旋回位置及び旋回モードに基づき、最短経路を修正して、仮の第1経路R1である修正経路を設定する(ステップS18)。例えば、第1経路設定部64は、設定した旋回位置及び旋回モードに基づき、その旋回位置で旋回するために最短経路から離れる必要があるかを判断し、離れる必要があると判断した場合には、最短経路を修正した修正経路を設定して、仮の第1経路R1とする。一方、第1経路設定部64は、その旋回位置で旋回するために最短経路から離れる必要が無いと判断した場合には、最短経路を修正せず、最短経路を修正経路(仮の第1経路R1)として扱う。例えば、第1経路設定部64は、最短経路から離れた位置を旋回位置とし、その旋回位置で通常旋回して切り返す旨を旋回モードとして設定した場合には、最短経路から離れる必要があると判断する。この場合、第1経路設定部64は、最短経路上の位置から旋回位置まで接続する区間と、旋回位置から最短経路に戻る区間とを含むように、修正経路を設定する。一方例えば、最短経路上を旋回位置とし、その旋回位置で信地旋回すると設定した場合には、最短経路から離れる必要が無いと判断して、最短経路を修正しない。第1経路設定部64は、設定した旋回位置及び旋回モードの組み合わせのそれぞれについて、同様の処理を行い、修正経路を設定する。
 そして、第1経路設定部64は、設定した旋回位置において設定した旋回モードで旋回しつつ、修正経路に従って目的位置Gに到達する予測時間Tを、各修正経路について算出する(ステップS20)。予測時間Tは、修正経路、旋回位置及び旋回モードに基づいた任意の方法で算出してよいが、例えば、第1経路設定部64は、次の式(1)を用いて、予測時間Tを算出する。
 T=Tsf+Tsb+Tt+Tla+Ta+Tlos ・・・(1)
 Tsfは、修正経路に従って移動する際の、前進直進時間である。前進直進時間Tsfとは、修正経路のうちで、フォーク24が設けられない前方向を進行方向として直進する区間(前進直進区間)の移動に要する予測時間である。例えば、第1経路設定部64は、修正経路から前進直進区間の長さを算出して、前進直進区間の長さを、予め設定された前進直線速度(前方向を進行方向として直進する際の移動速度)で除した値を、前進直進時間Tsfとして算出する。前進直線速度は適宜設定されてよいが、例えば1m/s~2m/s程度であってよい。
 Tsbは、修正経路に従って移動する際の、後進直進時間である。後進直進時間Tsbとは、修正経路のうちで、フォーク24が設けられる後方向を進行方向として直進する区間(後進直進区間)の移動に要する予測時間である。例えば、第1経路設定部64は、修正経路から後進直進区間の長さを算出して、後進直進区間の長さを、予め設定された後進直線速度(後方向を進行方向として直進する際の移動速度)で除した値を、後進直進時間Tsbとして算出する。後進直線速度は適宜設定されてよいが、前進直線速度より遅く、例えば0.5m/s~1m/s程度であってよい。
 Ttは、修正経路に従って移動する際の、旋回時間である。旋回時間Ttとは、旋回を始めてから旋回を完了するまでに要する予測時間である。例えば、第1経路設定部64は、信地旋回回転角度を信地旋回速度で除した値と、前進旋回距離を前進旋回速度で除した値と、後進旋回距離を後進旋回速度で除した値との合計値を、旋回時間Ttとしてよい。なお、信地旋回回転角度は、信地旋回により変更した移動体10の向き(角度)の量を指し、旋回モードに基づき算出され、信地旋回速度は、信地旋回により単位時間当たりに変更可能な角度であり、予め設定される。前進旋回距離は、フォーク24が設けられない前方向を進行方向として通常旋回する際に移動する距離を指し、修正経路に基づき算出され、前進旋回速度は、前進旋回により単位時間当たりに移動する距離を指し、例えば旋回半径により算出される。後進旋回距離は、フォーク24が設けられる後方向を進行方向として通常旋回する際に移動する距離を指し、修正経路に基づき算出され、後進旋回速度は、後進旋回により単位時間当たりに移動する距離を指し、例えば旋回半径により算出される。
 Tlaは、修正経路に従って移動する際の、横移動時間である。横移動時間Tlaとは、修正経路のうちで、移動体10の左右方向を進行方向として直進する区間(横移動区間)の移動に要する予測時間である。例えば、第1経路設定部64は、修正経路から横移動区間の長さを算出して、横移動区間の長さを、予め設定された横移動速度(左右方向を進行方向として移動する際の移動速度)で除した値を、横移動時間Tlaとして算出する。横移動速度は適宜設定されてよいが、前進直線速度より遅く、例えば0.5m/s~1m/s程度であってよい。
 Taは、修正経路に従って移動する際の、アプローチ時間である。アプローチ時間Taとは、対象物Pの位置及び姿勢の検出結果に基づいて対象物Pにアプローチするのに要する予測時間(例えば上述の第3経路の移動に要する予測時間)である。例えば、第1経路設定部64は、アプローチ距離(対象物Pにアプローチする際の移動距離)を、予め設定されたアプローチ速度(対象物Pにアプローチする際の移動速度)で除した値を、アプローチ時間Taとして算出する。アプローチ距離及びアプローチ速度は、予め設定されてよい。例えば、アプローチ速度は、後進直線速度より遅く、例えば0.2m/s~0.5m/s程度であってよい。
 Tlosは、移動体10を停止させることなどによるロス時間である。例えば、第1経路設定部64は、移動体10が移動中に停止する回数に、所定のペナルティ係数を乗じた値を、ロス時間Tlosとして算出する。移動体10が停止する回数は、例えば、旋回位置の数に基づき算出されてよく、旋回位置の数を停止する回数としてもよい。また、ペナルティ係数は、停止してから移動を再開するまでの予測時間であり、例えば4秒程度であってよい。
 第1経路設定部64は、以上のように修正経路毎に算出した予測時間に基づいて、第1経路R1、旋回位置及び旋回モードを設定する。具体的には、第1経路設定部64は、各修正経路、旋回位置、及び旋回モードの組み合わせのうちから、予測時間が最小となる修正経路、旋回位置、及び旋回モードの組み合わせを抽出して、抽出した修正経路、旋回位置、及び旋回モードを、実際に用いる第1経路R1、旋回位置、及び旋回モードとして設定する(ステップS22)。すなわち、第1経路設定部64は、式(1)の予測時間Tを評価関数として、評価関数が最小となる予測時間Tに対応する、修正経路、旋回位置、及び旋回モードの組み合わせを、実際に用いる第1経路R1、旋回位置、及び旋回モードとして採用する。
 このように、第1経路R1、旋回位置、及び旋回モードを、予測時間に基づいて設定することで、信地旋回が可能な移動体10の経路を適切に設定できる。
 (作業内容に応じた設定例)
 また、第1経路設定部64は、移動体10の作業内容に応じて、第1経路R1、旋回位置、及び旋回モードを設定してもよい。以下、具体例を説明する。
 (運送車両から荷積みする場合の設定例)
 移動体10が実施する作業が、運送車両Vから対象物Pを荷積みするものである場合における、設定例を説明する。第1経路設定部64は、駐車領域ARVに対応する位置が目的位置Gであり、目的位置Gで荷積みすることが作業として設定されている場合、切り返しつつ通常旋回して、目的位置Gに向かうように、旋回モードを設定することが好ましい。具体的には、例えば図9に示すように、第1経路設定部64は、移動元SのウェイポイントWP0から、通行路ウェイポイントWPAを経て、駐車領域ARVに対応する目的位置GのウェイポイントWPGまで到達する経路を、第1経路R1として設定する。そして、第1経路設定部64は、通行路ウェイポイントWPAのうちで、目的位置Gに対して移動元Sと反対側(図9の例ではY方向側)にあるウェイポイントWP1bを、旋回位置として設定し、切り返して通常旋回してウェイポイントWPGに到達するように、旋回モードを設定する。
 移動体10は、このように設定された第1経路R1、旋回位置、旋回モードに基づき、第2経路R2を設定して移動するため、図9に示したように、ウェイポイントWP0からウェイポイントWP1bまで、フォーク24が設けられない前方向を進行方向として、Y方向に移動する。そして、移動体10は、ウェイポイントWP1bでフォーク24が設けられる後方向を進行方向とするように切り返して、通常旋回しつつウェイポイントWPGまで移動して、対象物Pを荷積み(ピックアップ)する。このように第1経路R1、旋回位置、旋回モードを設定することで、運送車両Vから対象物Pを荷積みする際の経路を、適切に設定できる。
 (設置領域に荷下ろしする場合の設定例)
 移動体10が実施する作業が、運送車両Vから荷積みした対象物Pを設置領域AR2に荷下ろしするものである場合における、設定例を説明する。図12は、対象物を設置領域に荷下ろしする場合の例を説明する模式図である。第1経路設定部64は、駐車領域ARVに対応する位置が移動元Sに設定され、設置領域AR2に対応する位置が目的位置Gに設定されており、かつ、目的位置Gで荷下ろしするように作業が設定されている場合、次のように設定を行うことが好ましい。具体的には、第1経路設定部64は、駐車領域ARVに対応するウェイポイントWP0(移動元S)から通行ウェイポイントWPAに移動する区間(図12の例でのウェイポイントWP0~WP1a)と、通行ウェイポイントWPAを通る区間(図12の例でのウェイポイントWP1a~WP2a)と、通行ウェイポイントWPAを経てアプローチウェイポイントWPBに移動する区間(図12の例でのウェイポイントWP2a~WP2b)と、アプローチウェイポイントWPBから設置領域AR2に対応するウェイポイントWPGまで到達する区間(図12の例でのウェイポイントWP2b~WPG)と、を含むように、第1経路R1を設定する。また、第1経路設定部64は、ウェイポイントWP0と、通行ウェイポイントWPAのうちで最もY方向と反対側のウェイポイントWP2aとを、旋回位置として設定する。また、第1経路設定部64は、ウェイポイントWP0で、車体20の前方向を進行方向としてY方向の反対側に通常旋回するように、旋回モードを設定する。また、第1経路設定部64は、ウェイポイントWP2aで、車体20の向きが反対になるよう信地旋回し、車体20の横方向を進行方向とするように、旋回モードを設定する。また、第1経路設定部64は、通行ウェイポイントWPAのうちでウェイポイントWPGに対してY方向側にあるウェイポイントWP2bにおいて、車体20の後方向を進行方向に設定する。
 移動体10は、このように設定された第1経路R1、旋回位置、旋回モードに基づき、第2経路R2を設定して移動する。そのため、図12に示したように、移動体10は、ウェイポイントWP0から、前方向を進行方向として通常旋回して、通行ウェイポイントWPA上のウェイポイントWP1cに移動し、通行ウェイポイントWPAに沿って、ウェイポイントWP2aまで移動する。そして、移動体10は、ウェイポイントWP2aで、車体20の後方向がY方向と反対側を向くように信地旋回し、車体の左方向を進行方向として、アプローチウェイポイントWPBに沿って、ウェイポイントWP2bまで移動する。そして、移動体10は、ウェイポイントWP2bで、車体20の後方向を進行方向としてY方向と反対側に移動し、ウェイポイントWPGに到達する。そして、移動体10は、ウェイポイントWPGと対応する設置領域AR2の単位領域Aに、対象物Pを荷下ろしする。このように第1経路R1、旋回位置、旋回モードを設定することで、運送車両Vから荷積みした対象物Pを設置領域AR2に荷下ろしする際の経路を、適切に設定できる。
 (設置領域から通行ウェイポイントに移動する場合の設定例)
 移動体10が実施する作業が、設置領域AR2から通行ウェイポイントWPAに移動する場合(設置領域AR2で荷下ろし又は荷積みして通行ウェイポイントWPAに移動する場合)の、設定例を説明する。図13は、設置領域から通行ウェイポイントに移動する例を説明する模式図である。第1経路設定部64は、設置領域AR2に対応する位置が移動元Sに設定され、設置領域AR2に対応する位置以外の場所(例えば駐車領域ARVや仮設置領域AR1に対応する位置)が目的位置Gに設定されている場合、次のように設定を行うことが好ましい。具体的には、第1経路設定部64は、アプローチウェイポイントWPBと障害物領域との距離が所定の閾値未満である場合(通常旋回できる程度の距離が無い場合)には、設置領域AR2に対応するウェイポイントWP0(移動元S)からアプローチウェイポイントWPBに移動する区間(図13の例でのウェイポイントWP0~WP2b)と、アプローチウェイポイントWPBを経て通行ウェイポイントWPAに移動する区間(図13の例でのウェイポイントWP2b~WP2a)と、通行ウェイポイントWPAを通る区間(図13の例でのウェイポイントWP2a~WP1d)とを含むように、第1経路R1(図13の第1経路R1a)を設定する。また、第1経路設定部64は、ウェイポイントWP2bで車体20の横方向を進行方向に設定する。また、第1経路設定部64は、ウェイポイントWP2aで、車体20の前方向を進行方向に設定する。
 移動体10は、このように設定された第1経路R1aに基づき、第2経路R2aを設定して移動する。そのためこの場合、図13の第2経路R2aに示すように、移動体10は、ウェイポイントWP0から、前方向を進行方向としてウェイポイントWP2bに移動し、車体20の右方向を進行方向として、通行ウェイポイントWPAに沿って、ウェイポイントWP2aまで移動する。そして、移動体10は、ウェイポイントWP2aから、車体の前方向を進行方向として、通行ウェイポイントWPAに沿ってY方向に移動する。
 一方、第1経路設定部64は、アプローチウェイポイントWPBと障害物領域との距離が所定の閾値以上である場合(通常旋回できる程度に距離がある場合)には、設定モードを通常旋回に設定する。この場合、第1経路設定部64は、設置領域AR2に対応するウェイポイントWP0(移動元S)からアプローチウェイポイントWPBに移動する区間(図13の例でのウェイポイントWP0~WP2b)と、アプローチウェイポイントWPBを経て通行ウェイポイントWPAに移動する区間(図13の例でのウェイポイントWP2b~WP2a)と、通行ウェイポイントWPAを通る区間(図13の例でのウェイポイントWP2a~WP1d)とを含むように、第1経路R1(図13の第1経路R1b)を設定する。また、第1経路設定部64は、通行ウェイポイントWPA上のウェイポイントWP(図13の例ではウェイポイントWP2b)を旋回位置として設定し、通常旋回するように、旋回モードを設定する。
 移動体10は、このように設定された第1経路R1b、旋回位置、旋回モードに基づき、第2経路R2bを設定して移動する。そのためこの場合、図13の第2経路R2bに示すように、移動体10は、ウェイポイントWP0から、前方向を進行方向としてウェイポイントWP2bに移動し、ウェイポイントWP2bで通常旋回して、通行ウェイポイントWPA上のウェイポイントWP(図13の例ではウェイポイントWP1d)まで移動する。そして、移動体10は、通行ウェイポイントWPAに沿ってY方向に移動する。
 このように、障害物領域との距離に基づいて、旋回モードなどを設定することで、設置領域AR2に荷下ろしして通行ウェイポイントに移動する場合の経路を、適切に設定できる。
 (仮設置領域に荷下ろしする場合の設定例)
 移動体10が実施する作業が、運送車両Vから荷積みした対象物Pを仮設置領域AR1に荷下ろしするものである場合における、設定例を説明する。図14から図16は、対象物を設置領域に荷下ろしする場合の例を説明する模式図である。第1経路設定部64は、駐車領域ARVに対応する位置が移動元Sに設定され、仮設置領域AR1に対応する位置が目的位置Gに設定されており、かつ、目的位置Gで荷下ろしするように作業が設定されている場合、次のように設定を行うことが好ましい。具体的には、第1経路設定部64は、移動元S(駐車領域ARVに対応するウェイポイントWP0)と目的位置G(仮設置領域AR1に対応するウェイポイントWPG)とのY方向における距離である、離間距離を算出して、離間距離に基づいて、第1経路R1、旋回位置及び旋回モードを設定する。
 図14は、移動元Sと目的位置GとのY方向における離間距離が、0より大きい所定距離以上である場合の例を示している。図14に示すように、離間距離が所定距離以上である場合、第1経路設定部64は、通常旋回を旋回モードとして選択する。より詳しくは、第1経路設定部64は、駐車領域ARVに対応するウェイポイントWP0(移動元S)から通行ウェイポイントWPAに移動する区間(図14の例でのウェイポイントWP0~WP1a)と、通行ウェイポイントWPAを通る区間(図14の例でのウェイポイントWP1a~WP1e)と、通行ウェイポイントWPAから仮設置領域AR1に対応するウェイポイントWPGまで到達する区間(図14の例でのウェイポイントWP1d~WPG)と、を含むように、第1経路R1を設定する。また、第1経路設定部64は、ウェイポイントWP0と、ウェイポイントWP1e(通行ウェイポイントWPAのうちで、ウェイポイントWPGよりもY方向と反対側にあるウェイポイントWP)とを、旋回位置として設定する。また、第1経路設定部64は、ウェイポイントWP0で、車体20の前方向を進行方向としてY方向の反対側に通常旋回するように、旋回モードを設定する。また、第1経路設定部64は、ウェイポイントWP1eで、車体20の後方向を進行方向とする切り返しの通常旋回を、旋回モードとして設定する。
 移動体10は、このように設定された第1経路R1、旋回位置、旋回モードに基づき、第2経路R2を設定して移動する。そのため、図14に示したように、移動体10は、ウェイポイントWP0から、前方向を進行方向として通常旋回して、通行ウェイポイントWPA上のウェイポイントWP1cに移動し、通行ウェイポイントWPAに沿って、ウェイポイントWP1eまで移動する。そして、移動体10は、ウェイポイントWP2bで車体20の後方向を進行方向として切り返して(通常旋回して)、ウェイポイントWPGに到達し、ウェイポイントWPGと対応する仮設置領域AR1の単位領域Aに、対象物Pを荷下ろしする。
 図15は、移動元Sと目的位置GとのY方向における離間距離が、所定距離未満、かつ0より長い場合の例を示している。図15に示すように、離間距離が所定距離未満、かつ0より長い場合、第1経路設定部64は、通常旋回及び信地旋回を旋回モードとして選択する。より詳しくは、第1経路設定部64は、駐車領域ARVに対応するウェイポイントWP0(移動元S)から通行ウェイポイントWPAに移動する区間(図15の例でのウェイポイントWP0~WP1a)と、通行ウェイポイントWPAを通る区間(図15の例でのウェイポイントWP1a~WP1c)と、通行ウェイポイントWPAから仮設置領域AR1に対応するウェイポイントWPGまで到達する区間(図15の例でのウェイポイントWP1c~WPG)と、を含むように、第1経路R1を設定する。また、第1経路設定部64は、ウェイポイントWP1aを旋回位置として設定する。また、第1経路設定部64は、ウェイポイントWP1aで、車体20の後方向がウェイポイントWPG側を向くように信地旋回し、信地旋回の後に、X方向と反対方向に向けて通常旋回するように、旋回モードを設定する。
 移動体10は、このように設定された第1経路R1、旋回位置、旋回モードに基づき、第2経路R2を設定して移動する。そのため、図15に示したように、移動体10は、ウェイポイントWP0からウェイポイントWP1aまで、車体20の前方向を進行方向にして移動し、ウェイポイントWP1aで、車体20の後方向がウェイポイントWPG側を向くように信地旋回する。そして、移動体10は、ウェイポイントWP1aから、X方向と反対方向に向けて通常旋回して、ウェイポイントWPGに到達し、ウェイポイントWPGと対応する仮設置領域AR1の単位領域Aに、対象物Pを荷下ろしする。
 図16は、移動元Sと目的位置GとのY方向における離間距離が0である場合の例を示している。図16に示すように、離間距離が0である場合、第1経路設定部64は、信地旋回を旋回モードとして選択する。より詳しくは、第1経路設定部64は、駐車領域ARVに対応するウェイポイントWP0(移動元S)から通行ウェイポイントWPAに移動する区間(図16の例でのウェイポイントWP0~WP1a)と、通行ウェイポイントWPAから仮設置領域AR1に対応するウェイポイントWPGまで到達する区間(図16の例でのウェイポイントWP1a~WPG)と、を含むように、第1経路R1を設定する。また、第1経路設定部64は、ウェイポイントWP1aを旋回位置として設定し、ウェイポイントWP1aで、車体20の後方向が方向Xと反対方向を向くように信地旋回し、車体20の後方向を進行方向するように、旋回モードを設定する。
 移動体10は、このように設定された第1経路R1、旋回位置、旋回モードに基づき、第2経路R2を設定して移動する。そのため、図16に示したように、移動体10は、ウェイポイントWP0からウェイポイントWP1aまで、車体20の前方向を進行方向にして移動し、ウェイポイントWP1aで、車体20の後方向が方向Xと反対方向を向くように信地旋回する。そして、移動体10は、車体20の後方向を進行方向として、ウェイポイントWP1aから、ウェイポイントWPGに到達し、ウェイポイントWPGと対応する仮設置領域AR1の単位領域Aに、対象物Pを荷下ろしする。
 このように、離間距離に基づいて旋回モードなどを設定することで、運送車両Vから荷積みした対象物Pを仮設置領域AR1に荷下ろしする際の経路を、適切に設定できる。
 (仮設置領域から荷積みして運送車両に荷下ろしする場合の設定例)
 移動体10が実施する作業が、仮設置領域AR1から荷積みした対象物Pを運送車両Vに荷下ろしするものである場合における、設定例を説明する。図17から図19は、仮設置領域から荷積みした対象物を運送車両に荷下ろしする場合の例を説明する模式図である。第1経路設定部64は、仮設置領域AR1に対応する位置が移動元Sに設定され、駐車領域ARVに対応する位置が目的位置Gに設定されており、かつ、目的位置Gで荷下ろしするように作業が設定されている場合、次のように設定を行うことが好ましい。具体的には、第1経路設定部64は、移動元S(仮設置領域AR1に対応するウェイポイントWP0)と目的位置G(駐車領域ARVに対応するウェイポイントWPG)とのY方向における距離である、離間距離を算出して、離間距離に基づいて、第1経路R1、旋回位置及び旋回モードを設定する。
 図17は、離間距離が、0より大きい所定距離以上である場合の例を示している。図17に示すように、離間距離が所定距離以上である場合、第1経路設定部64は、通常旋回を旋回モードとして選択する。より詳しくは、第1経路設定部64は、仮設置領域AR1に対応するウェイポイントWP0(移動元S)から通行ウェイポイントWPAに移動する区間(図17の例でのウェイポイントWP0~WP1d)と、通行ウェイポイントWPAを通る区間(図17の例でのウェイポイントWP1d~WP1b)と、通行ウェイポイントWPAから駐車領域ARVに対応するウェイポイントWPGまで到達する区間(図17の例でのウェイポイントWP1a~WPG)と、を含むように、第1経路R1を設定する。また、第1経路設定部64は、ウェイポイントWP0と、ウェイポイントWP1b(通行ウェイポイントWPAのうちで、ウェイポイントWPGよりもY方向側にあるウェイポイントWP)とを、旋回位置として設定する。また、第1経路設定部64は、ウェイポイントWP0で、車体20の前方向を進行方向としてY方向側に通常旋回するように、旋回モードを設定する。また、第1経路設定部64は、ウェイポイントWP1bで、車体20の後方向を進行方向とする切り返しの通常旋回を、旋回モードとして設定する。
 移動体10は、このように設定された第1経路R1、旋回位置、旋回モードに基づき、第2経路R2を設定して移動する。そのため、図17に示したように、移動体10は、ウェイポイントWP0から、前方向を進行方向として通常旋回して、通行ウェイポイントWPA上のウェイポイントWP1eに移動し、通行ウェイポイントWPAに沿って、ウェイポイントWP1bまで移動する。そして、移動体10は、ウェイポイントWP2bで車体20の後方向を進行方向として切り返して(通常旋回して)、ウェイポイントWPGに到達し、ウェイポイントWPGと対応する収納室Va内の位置に、対象物Pを荷下ろしする。
 図18は、移動元Sと目的位置GとのY方向における離間距離が、所定距離未満、かつ0より長い場合の例を示している。図18に示すように、離間距離が所定距離未満、かつ0より長い場合、第1経路設定部64は、通常旋回及び信地旋回を旋回モードとして選択する。より詳しくは、第1経路設定部64は、仮設置領域AR1に対応するウェイポイントWP0(移動元S)から通行ウェイポイントWPAに移動する区間(図18の例でのウェイポイントWP0~WP1c)と、通行ウェイポイントWPAを通る区間(図18の例でのウェイポイントWP1c~WP1a)と、通行ウェイポイントWPAから駐車領域ARVに対応するウェイポイントWPGまで到達する区間(図18の例でのウェイポイントWP1a~WPG)と、を含むように、第1経路R1を設定する。また、第1経路設定部64は、ウェイポイントWP1cを旋回位置として設定する。また、第1経路設定部64は、ウェイポイントWP1cで、車体20の後方向がウェイポイントWPG側を向くように信地旋回し、信地旋回の後に、X方向に向けて通常旋回するように、旋回モードを設定する。
 移動体10は、このように設定された第1経路R1、旋回位置、旋回モードに基づき、第2経路R2を設定して移動する。そのため、図15に示したように、移動体10は、ウェイポイントWP0からウェイポイントWP1cまで、車体20の前方向を進行方向にして移動し、ウェイポイントWP1cで、車体20の後方向がウェイポイントWPG側を向くように信地旋回する。そして、移動体10は、ウェイポイントWP1cから、X方向に向けて通常旋回して、ウェイポイントWPGに到達し、ウェイポイントWPGと対応する収納室Va内の位置に、対象物Pを荷下ろしする。
 図19は、移動元Sと目的位置GとのY方向における離間距離が0である場合の例を示している。図19に示すように、離間距離が0である場合、第1経路設定部64は、信地旋回を旋回モードとして選択する。より詳しくは、第1経路設定部64は、仮設置領域AR1に対応するウェイポイントWP0(移動元S)から通行ウェイポイントWPAに移動する区間(図19の例でのウェイポイントWP0~WP1a)と、通行ウェイポイントWPAから駐車領域ARVに対応するウェイポイントWPGまで到達する区間(図19の例でのウェイポイントWP1a~WPG)と、を含むように、第1経路R1を設定する。また、第1経路設定部64は、ウェイポイントWP1aを旋回位置として設定し、ウェイポイントWP1aで、車体20の後方向がX方向を向くように信地旋回し、車体20の後方向を進行方向するように、旋回モードを設定する。
 移動体10は、このように設定された第1経路R1、旋回位置、旋回モードに基づき、第2経路R2を設定して移動する。そのため、図19に示したように、移動体10は、ウェイポイントWP0からウェイポイントWP1aまで、車体20の前方向を進行方向にして移動し、ウェイポイントWP1aで、車体20の後方向がX方向を向くように信地旋回する。そして、移動体10は、車体20の後方向を進行方向として、ウェイポイントWP1aから、ウェイポイントWPGに到達し、ウェイポイントWPGと対応する収納室Va内の位置に、対象物Pを荷下ろしする。
 このように、離間距離に基づいて旋回モードなどを設定することで、仮設置領域AR1から荷積みした対象物Pを運送車両Vに荷下ろしする際の経路を、適切に設定できる。
 (他の例)
 図20は、目標物を高い位置に保持したまま移動する場合の例を示す模式図である。第1経路設定部64は、第1経路R1、旋回位置、及び旋回モードを設定した後に、障害物領域における障害物の高さ情報に基づいて、移動体10が搬送する対象物PのZ方向における位置(搬送高さ)を設定してもよい。障害物の高さ情報とは、障害物領域に位置している障害物の高さ(Z方向における長さ)を示す情報であり、例えば、固定物P0や運送車両Vの高さや、障害物領域としての仮設置領域AR1や設置領域AR2に設置されている対象物Pの高さなどを指す。固定物P0や運送車両Vの高さは、予め設定されてよい。また、仮設置領域AR1や設置領域AR2に対象物Pが設置されている旨は、移動可能情報から取得可能であり、対象物Pの高さは、予め設定されてよい。
 第1経路設定部64は、第1経路R1上の各位置のうちで、障害物領域までの距離が所定距離未満となる位置があるかを判断する。第1経路設定部64は、障害物領域までの距離が所定距離未満となる位置がある場合、その障害物領域の障害物の高さ情報を取得して、障害物の高さ情報に基づいて、障害物よりもZ方向(鉛直方向上方)の位置を、対象物PのZ方向における位置(搬送高さ)として設定する。移動体10の移動制御部84は、フォーク24を制御することで、搬送している対象物Pを搬送高さに位置させた状態で、障害物領域までの距離が所定距離未満となる区間を、移動させる。このように、対象物Pの搬送高さを設定することで、例えば旋回できないような狭い領域などにおいても、障害物との干渉を抑制しつつ、対象物Pを搬送できる。
 図20は、アプローチウェイポイントWPBと、障害物領域としての設置領域AR2との距離が、所定距離未満である場合の例を示している。この場合、移動体10は、搬送している対象物Pを、設置領域AR2上の対象物Pよりも高い位置に持ち上げつつ、アプローチウェイポイントWPBに沿ってX方向と反対側に移動する。なお、図20は、設置領域AR2上の対象物Pが障害物である場合の例であるが、障害物はこれに限られない。例えば、仮設置領域AR1上の対象物Pを障害物として、移動体10は、搬送している対象物Pを、仮設置領域AR1上の対象物Pよりも高い位置に持ち上げつつ、移動してもよい。
 (効果)
 本開示の第1態様に係る制御方法は、鉛直方向(Z方向)から見た車体20外を回転中心Cとして旋回する通常旋回と、鉛直方向から見た車体20内を回転中心Cとして旋回する信地旋回とが可能な移動体10の制御方法である。本制御方法は、移動体10の目的位置Gを設定するステップと、移動体10が移動する作業領域ARにおいて移動体10が移動可能な位置を示す移動可能情報を取得するステップと、目的位置G及び移動可能情報に基づき、移動可能な位置を通って目的位置に向かう経路と、移動体が旋回する旋回位置と、旋回位置において通常旋回するか信地旋回するかの旋回モードと、を設定するステップと、経路、旋回位置、及び旋回モードに基づいて、移動体10を移動させるステップと、を含む。本開示によると、通常旋回及び信地旋回が可能な移動体10に対して、旋回位置と旋回モードを設定しつつ、移動可能な位置を通る経路を設定するため、信地旋回が可能な移動体10に対して、適切な経路を移動させることが可能となる。
 本開示の第2態様に係る制御方法は、第1態様に係る制御方法であって、旋回位置を設定するステップにおいては、障害物が位置する障害物領域の位置情報を取得して、経路上の各位置のうちで障害物領域との距離が所定の閾値以上となる位置を、旋回位置として設定する。本開示によると、障害物と干渉せずに旋回できる位置を旋回位置に設定できるため、移動体10に対して、適切な経路を移動させることが可能となる。
 本開示の第3態様に係る制御方法は、第1態様又は第2態様に係る制御方法であって、旋回位置を設定するステップにおいては、旋回モードを設定するステップにおいては、移動体10の移動元Sから目的位置Gまでの距離に基づき、旋回モードを設定する。本開示によると、目的位置Gまでの距離に応じて旋回モードを決めるため、移動体10に対して、適切な経路を移動させることが可能となる。
 本開示の第4態様に係る制御方法は、第3態様に係る制御方法であって、旋回モードを設定するステップにおいては、移動体10の移動元Sから目的位置Gまでの距離が所定の閾値以上である場合は、旋回モードとして通常旋回を設定し、移動体10の移動元Sから目的位置Gまでの距離が閾値未満である場合は、旋回モードとして信地旋回を設定する。本開示によると、目的位置Gまでの距離が十分にある場合には通常旋回とすることで、目的位置Gに早く到着でき、目的位置Gまでの距離が十分にない場合には、信地旋回とすることで、通常旋回するために遠回りすることなく、目的位置Gに到着できる。
 本開示の第5態様に係る制御方法は、第1態様から第4態様のいずれかに係る制御方法であって、経路と旋回位置と旋回モードとを設定するステップにおいては、目的位置Gと移動可能情報に基づき、目的位置Gに到達する最短経路を設定し、最短経路上又は最短経路から所定距離範囲内の位置を、旋回位置として設定し、最短経路に基づき、旋回位置で通常旋回して目的位置Gに到達できる第1修正経路を設定し、最短経路に基づき、旋回位置で信地旋回して目的位置Gに到達できる第2修正経路を設定する。そして、本ステップでは、第1修正経路に従って目的位置Gに到達するための第1予測時間と、第2修正経路に従って目的位置Gに到達するための第2予測時間とに基づいて、経路と旋回位置と旋回モードとを設定する。本開示によると、通常旋回を用いた場合の予測時間と信地旋回を用いた場合の予測時間から、旋回モードなどを決定するため、移動体10に対して、適切な経路を移動させることが可能となる。
 本開示の第6態様に係る制御方法は、第5態様に係る制御方法であって、経路と旋回位置と旋回モードとを設定するステップにおいては、第1予測時間が第2予測時間よりも短い場合には、旋回モードとして通常旋回を設定し、第1修正経路を経路とする。一方、第2予測時間が第1予測時間よりも短い場合には、旋回モードとして信地旋回を設定し、第2修正経路を経路とする。本開示によると、目的位置Gに早く到着できる経路を設定できる。
 本開示の第7態様に係る制御方法は、第1態様から第6態様のいずれかに係る制御方法であって、作業領域ARは、対象物Pを搭載した運送車両Vが停車する駐車領域ARVを含む。トラックバースが作業領域ARである場合には、運送車両Vから迅速に対象物Pを荷下ろしする必要があったり、レイアウトが特殊なため移動体10が移動できる領域が限られたりするなど、適切な作業内容の設定が難しい。それに対して、本開示によると、このようなトラックバースでの移動体10の作業用の経路を適切に設定できるため、トラックバースでの作業を適切に行わせることが可能となる。
 本開示の第8態様に係るプログラムは、鉛直方向(Z方向)から見た車体20外を回転中心Cとして旋回する通常旋回と、鉛直方向から見た車体20内を回転中心Cとして旋回する信地旋回とが可能な移動体10の制御方法をコンピュータに実行させる。本プログラムは、移動体10の目的位置Gを設定するステップと、移動体10が移動する作業領域ARにおいて移動体10が移動可能な位置を示す移動可能情報を取得するステップと、目的位置G及び移動可能情報に基づき、移動可能な位置を通って目的位置に向かう経路と、移動体が旋回する旋回位置と、旋回位置において通常旋回するか信地旋回するかの旋回モードと、を設定するステップと、経路、旋回位置、及び旋回モードに基づいて、移動体10を移動させるステップと、をコンピュータに実行させる。本開示によると、信地旋回が可能な移動体10に対して、適切な経路を移動させることが可能となる。
 本開示の第9態様に係る移動体10は、鉛直方向(Z方向)から見た車体20外を回転中心Cとして旋回する通常旋回と、鉛直方向から見た車体20内を回転中心Cとして旋回する信地旋回とが可能である。移動体10は、移動体10の経路と、移動体10が旋回する旋回位置と、旋回位置において通常旋回するか信地旋回するかの旋回モードとを取得する経路取得部(第1経路取得部80)と、経路、旋回位置、及び旋回モードに基づいて、移動体10を移動させる移動制御部84とを含む。経路、旋回位置、及び旋回モードは、移動体10の目的位置Gと、移動体10が移動する作業領域ARにおいて移動体10が移動可能な位置を示す移動可能情報とに基づき設定され、経路は、移動可能な位置を通って目的位置Gに向かう経路である。本開示によると、信地旋回が可能な移動体10に対して、適切な経路を移動させることが可能となる。
 以上、本開示の実施形態を説明したが、この実施形態の内容により実施形態が限定されるものではない。また、前述した構成要素には、当業者が容易に想定できるもの、実質的に同一のもの、いわゆる均等の範囲のものが含まれる。さらに、前述した構成要素は適宜組み合わせることが可能である。さらに、前述した実施形態の要旨を逸脱しない範囲で構成要素の種々の省略、置換又は変更を行うことができる。
 10 移動体
 12 管理装置
 14 情報処理装置
 AR 作業領域
 G 目的位置
 P 対象物
 WP ウェイポイント
 

Claims (9)

  1.  鉛直方向から見た車体外を回転中心として旋回する通常旋回と、鉛直方向から見た車体内を回転中心として旋回する信地旋回とが可能な移動体の制御方法であって、
     前記移動体の目的位置を設定するステップと、
     前記移動体が移動する作業領域において前記移動体が移動可能な位置を示す移動可能情報を取得するステップと、
     前記目的位置及び前記移動可能情報に基づき、移動可能な位置を通って前記目的位置に向かう経路と、前記移動体が旋回する旋回位置と、前記旋回位置において通常旋回するか信地旋回するかの旋回モードと、を設定するステップと、
     前記経路、前記旋回位置、及び前記旋回モードに基づいて、前記移動体を移動させるステップと、
     を含む、
     制御方法。
  2.  前記旋回位置を設定するステップにおいては、障害物が位置する障害物領域の位置情報を取得して、前記経路上の各位置のうちで前記障害物領域との距離が所定の閾値以上となる位置を、前記旋回位置として設定する、請求項1に記載の制御方法。
  3.  前記旋回モードを設定するステップにおいては、前記移動体の移動元から前記目的位置までの距離に基づき、前記旋回モードを設定する、請求項1又は請求項2に記載の制御方法。
  4.  前記旋回モードを設定するステップにおいては、前記移動体の移動元から前記目的位置までの距離が所定の閾値以上である場合は、前記旋回モードとして前記通常旋回を設定し、前記移動体の移動元から前記目的位置までの距離が前記閾値未満である場合は、前記旋回モードとして前記信地旋回を設定する、請求項3に記載の制御方法。
  5.  前記経路と前記旋回位置と前記旋回モードとを設定するステップにおいては、
     前記目的位置と前記移動可能情報に基づき、前記目的位置に到達する最短経路を設定し、
     前記最短経路上又は前記最短経路から所定距離範囲内の位置を、前記旋回位置として設定し、
     前記最短経路に基づき、前記旋回位置で前記通常旋回して前記目的位置に到達できる第1修正経路を設定し、
     前記最短経路に基づき、前記旋回位置で前記信地旋回して前記目的位置に到達できる第2修正経路を設定し、
     前記第1修正経路に従って前記目的位置に到達するための第1予測時間と、前記第2修正経路に従って前記目的位置に到達するための第2予測時間とに基づいて、前記経路と前記旋回位置と前記旋回モードとを設定する、請求項1又は請求項2に記載の制御方法。
  6.  前記経路と前記旋回位置と前記旋回モードとを設定するステップにおいては、
     前記第1予測時間が前記第2予測時間よりも短い場合には、前記旋回モードとして前記通常旋回を設定し、前記第1修正経路を前記経路として、
     前記第2予測時間が前記第1予測時間よりも短い場合には、前記旋回モードとして前記信地旋回を設定し、前記第2修正経路を前記経路とする、請求項5に記載の制御方法。
  7.  前記作業領域は、対象物を搭載した運送車両が停車する駐車領域を含む、請求項1又は請求項2に記載の制御方法。
  8.  鉛直方向から見た車体外を回転中心として旋回する通常旋回と、鉛直方向から見た車体内を回転中心として旋回する信地旋回とが可能な移動体の制御方法をコンピュータに実行させるプログラムであって、
     前記移動体の目的位置を設定するステップと、
     前記移動体が移動する作業領域において前記移動体が移動可能な位置を示す移動可能情報を取得するステップと、
     前記目的位置及び前記移動可能情報に基づき、移動可能な位置を通って前記目的位置に向かう経路と、前記移動体が旋回する旋回位置と、前記旋回位置において通常旋回するか信地旋回するかの旋回モードと、を設定するステップと、
     前記経路、前記旋回位置、及び前記旋回モードに基づいて、前記移動体を移動させるステップと、
     をコンピュータに実行させる、
     プログラム。
  9.  鉛直方向から見た車体外を回転中心として旋回する通常旋回と、鉛直方向から見た車体内を回転中心として旋回する信地旋回とが可能な移動体であって、
     前記移動体の経路と、前記移動体が旋回する旋回位置と、前記旋回位置において通常旋回するか信地旋回するかの旋回モードとを取得する経路取得部と、
     前記経路、前記旋回位置、及び前記旋回モードに基づいて、前記移動体を移動させる移動制御部と、
     を含み、
     前記経路、前記旋回位置、及び前記旋回モードは、前記移動体の目的位置と、前記移動体が移動する作業領域において前記移動体が移動可能な位置を示す移動可能情報とに基づき設定され、
     前記経路は、移動可能な位置を通って前記目的位置に向かう経路である、
     移動体。
PCT/JP2023/035345 2023-03-27 2023-09-28 制御方法、プログラム及び移動体 WO2024202133A1 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2023050197A JP2024139314A (ja) 2023-03-27 2023-03-27 制御方法、プログラム及び移動体
JP2023-050197 2023-03-27

Publications (1)

Publication Number Publication Date
WO2024202133A1 true WO2024202133A1 (ja) 2024-10-03

Family

ID=92903742

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2023/035345 WO2024202133A1 (ja) 2023-03-27 2023-09-28 制御方法、プログラム及び移動体

Country Status (2)

Country Link
JP (1) JP2024139314A (ja)
WO (1) WO2024202133A1 (ja)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2012038011A (ja) * 2010-08-05 2012-02-23 Ihi Corp 移動体の経路生成装置
JP2017182636A (ja) * 2016-03-31 2017-10-05 本田技研工業株式会社 自律走行作業車の制御装置
JP2019041877A (ja) * 2017-08-30 2019-03-22 パナソニックIpマネジメント株式会社 ロボット
WO2019098082A1 (ja) * 2017-11-20 2019-05-23 ソニー株式会社 制御装置、および制御方法、プログラム、並びに移動体
JP2021149177A (ja) * 2020-03-16 2021-09-27 三菱重工業株式会社 制御装置、移動体、移動制御システム、制御方法及びプログラム
JP2022013388A (ja) * 2020-07-03 2022-01-18 パナソニックIpマネジメント株式会社 移動体
WO2022270048A1 (ja) * 2021-06-23 2022-12-29 日本電産株式会社 自律走行装置および自律走行装置の制御方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2012038011A (ja) * 2010-08-05 2012-02-23 Ihi Corp 移動体の経路生成装置
JP2017182636A (ja) * 2016-03-31 2017-10-05 本田技研工業株式会社 自律走行作業車の制御装置
JP2019041877A (ja) * 2017-08-30 2019-03-22 パナソニックIpマネジメント株式会社 ロボット
WO2019098082A1 (ja) * 2017-11-20 2019-05-23 ソニー株式会社 制御装置、および制御方法、プログラム、並びに移動体
JP2021149177A (ja) * 2020-03-16 2021-09-27 三菱重工業株式会社 制御装置、移動体、移動制御システム、制御方法及びプログラム
JP2022013388A (ja) * 2020-07-03 2022-01-18 パナソニックIpマネジメント株式会社 移動体
WO2022270048A1 (ja) * 2021-06-23 2022-12-29 日本電産株式会社 自律走行装置および自律走行装置の制御方法

Also Published As

Publication number Publication date
JP2024139314A (ja) 2024-10-09

Similar Documents

Publication Publication Date Title
US10875448B2 (en) Visually indicating vehicle caution regions
US20070179690A1 (en) Variable path automated guided vehicle
JP7081881B2 (ja) 移動体および移動体システム
ES2983756T3 (es) Método para controlar un vehículo de guiado automático y sistema de control adaptado para ejecutar el método
JP7164085B2 (ja) 移動体を用いたワークの搬送方法、コンピュータプログラム、および移動体
WO2019044499A1 (ja) 移動体、位置推定装置、およびコンピュータプログラム
JP7300413B2 (ja) 制御装置、移動体、移動制御システム、制御方法及びプログラム
JP2024128140A (ja) 移動体の制御方法、移動体、移動制御システム及びプログラム
WO2024202133A1 (ja) 制御方法、プログラム及び移動体
EP4206847B1 (en) Control method for mobile object, mobile object, and computer-readable storage medium
JP7022775B2 (ja) 演算装置、移動体、移動制御システム、演算方法及びプログラム
JP7052398B2 (ja) 無人搬送車の制御方法
JP7527322B2 (ja) 情報処理方法、情報処理装置及びプログラム
WO2024185175A1 (ja) 移動制御システム、移動制御方法及び移動制御プログラム
WO2024166432A1 (ja) 移動体の制御方法、プログラム及び情報処理装置
JP7397045B2 (ja) 無人搬送装置
JP7365619B2 (ja) 台車および乗り物
WO2024219054A1 (ja) 移動制御システム、移動制御方法及び移動制御プログラム
US20240035825A1 (en) Navigation Alignment Systems and Methods for a Material Handling Vehicle
JP7000870B2 (ja) 無人搬送車およびその制御方法
KR20240031719A (ko) 스마트 물류 차량 및 그 제어 방법
JP2024047235A (ja) 経路設定方法、プログラム及び移動体
KR20230168516A (ko) 스마트 물류 차량 및 그 제어 방법
TW202328843A (zh) 搬運系統、無人搬運車及無人搬運車的控制方法
JP2022070559A (ja) 移動体、移動制御システム、移動体の制御方法及びプログラム