WO2021245892A1 - Autonomous travel control device, autonomous travel control system, and warning information determination method - Google Patents

Autonomous travel control device, autonomous travel control system, and warning information determination method Download PDF

Info

Publication number
WO2021245892A1
WO2021245892A1 PCT/JP2020/022181 JP2020022181W WO2021245892A1 WO 2021245892 A1 WO2021245892 A1 WO 2021245892A1 JP 2020022181 W JP2020022181 W JP 2020022181W WO 2021245892 A1 WO2021245892 A1 WO 2021245892A1
Authority
WO
WIPO (PCT)
Prior art keywords
moving obstacle
information
moving
traveling
obstacle
Prior art date
Application number
PCT/JP2020/022181
Other languages
French (fr)
Japanese (ja)
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 三菱電機株式会社
Priority to PCT/JP2020/022181 priority Critical patent/WO2021245892A1/en
Priority to JP2022528358A priority patent/JP7158628B2/en
Priority to TW109143833A priority patent/TW202146264A/en
Publication of WO2021245892A1 publication Critical patent/WO2021245892A1/en

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions

Definitions

  • This disclosure relates to an automatic driving control device.
  • Patent Document 1 describes an automatic vehicle allocation system that controls each automatic driving of a plurality of automatic traveling vehicles.
  • the automatic vehicle allocation system includes a plurality of signs, each of which displays driving operation instruction information, and a plurality of automatic traveling vehicles, each of which automatically travels based on the driving operation instruction information displayed by the signs.
  • the present disclosure has been made to solve the above-mentioned problems, and an object of the present disclosure is to provide a technique capable of preventing a collision between an autonomous vehicle and a moving obstacle.
  • the automatic driving control device obtains driving instruction information indicating automatic driving of an automatic driving vehicle on a traveling road by being displayed by a display device, based on driving planning information related to a traveling plan of the automatic traveling vehicle on the traveling road. It is an automatic driving control device that determines the automatic driving, and it is a moving obstacle information acquisition unit that acquires moving obstacle information about moving obstacles moving on the traveling road, and an automatic traveling vehicle and a moving obstacle by being displayed by a display device. It is provided with a warning information determination unit that determines warning information for warning a collision with a moving obstacle based on the traveling plan information and the moving obstacle information acquired by the moving obstacle information acquisition unit.
  • FIG. 6A is a diagram showing a situation of the work area H at time t.
  • FIG. 6B is a diagram showing a situation of the work area H at time t + 1.
  • FIG. 8A is a block diagram showing a hardware configuration that realizes the functions of the automatic driving control device 11.
  • FIG. 8B is a block diagram showing a hardware configuration for executing software that realizes the functions of the automatic driving control device 11. It is a flowchart which shows the driving instruction information determination method by the automatic driving control device which concerns on Embodiment 2.
  • FIG. 1 is a block diagram showing a configuration of an automatic driving control system 100 according to the first embodiment.
  • FIG. 2 is a block diagram showing a detailed configuration of the server 1 according to the first embodiment.
  • the automatic driving control system 100 includes a sensor 2, a server 1, a display device 3, and an automatic driving vehicle 4.
  • the server 1 includes a storage device 10, an automatic driving control device 11, and a communication device 12.
  • the configuration in which the automatic driving control device 11 is installed in the server 1 will be described, but the installation location of the automatic driving control device 11 is not particularly limited.
  • the automatic driving control system 100 may include a plurality of sensors 2. ..
  • the automatic traveling control system 100 may include a plurality of display devices 3.
  • the automatic traveling control system 100 may include a plurality of automatic traveling vehicles 4.
  • the sensor 2 detects the moving obstacle information regarding the moving obstacle moving on the traveling path of the automatic traveling vehicle 4.
  • the moving obstacle information detected by the sensor 2 may include information about the autonomous vehicle 4.
  • the sensor 2 outputs the detected moving obstacle information and the time when the moving obstacle information is detected to the server 1. More specifically, in the first embodiment, the sensor 2 includes a communication device (not shown), and the communication device transmits the moving obstacle information and the time to the server 1.
  • the moving obstacle means a movable object that does not follow the control of the automatic traveling control device 11.
  • Examples of moving obstacles include humans moving on the road, vehicles driven by humans, and the like.
  • the traveling path is composed of a plurality of sections, and the sensor 2 is a weight sensor that detects the weight of each section.
  • the weight of each section detected by the sensor 2 is, for example, the weight of the autonomous vehicle 4 in a certain section at a certain time, the weight of a moving obstacle in a certain section at a certain time, or the automatic weight in a certain section at a certain time.
  • the weight of the traveling vehicle 4 and the weight of the moving obstacle is, for example, the weight of the autonomous vehicle 4 in a certain section at a certain time, the weight of a moving obstacle in a certain section at a certain time, or the automatic weight in a certain section at a certain time.
  • the sensor 2 may be a sensor such as a camera, a radar, or a sonar.
  • the sensor 2 acquires an image of a moving obstacle as moving obstacle information by photographing the moving obstacle.
  • the sensor 2 detects the position of the moving obstacle as the moving obstacle information by scanning the moving obstacle.
  • the storage device 10 of the server 1 stores the travel plan information regarding the travel plan of the automatic traveling vehicle 4 on the travel road.
  • the storage device 10 outputs the travel plan information to the automatic travel control device 11. More specifically, in the first embodiment, the travel plan information stored in the storage device 10 is assumed for each section based on the travel plan of the automatic traveling vehicle 4 on the traveling road and the traveling plan of the automatic traveling vehicle 4. Including weight.
  • the estimated weight for each section is, for example, the weight of the section assumed by the presence of the autonomous vehicle 4 in a certain section at a certain time based on the travel plan, or the estimated time based on the travel plan. In addition, the weight (for example, zero) of the section assumed by the absence of the autonomous vehicle 4 in the section.
  • the travel plan information including the travel plan and the assumed weight for each section includes, for example, the travel route and the travel time from the travel start point to the destination of the autonomous vehicle 4, the weight of the autonomous vehicle 4, and the travel time. This is information associated with weight data such as the weight of luggage carried by the autonomous vehicle 4.
  • the communication device 12 of the server 1 receives the moving obstacle information detected by the sensor 2 and the time when the sensor 2 detects the moving obstacle information.
  • Examples of the communication device 12 include Ethernet (registered trademark), USB (Universal Serial Bus) terminals, and the like.
  • the automatic driving control device 11 of the server 1 displays the traveling instruction information displayed by the display device 3 to instruct the automatic traveling of the automatic traveling vehicle 4 on the traveling road, and the traveling plan relating to the traveling plan of the automatic traveling vehicle 4 on the traveling road. Make an informed decision.
  • the automatic travel control device 11 determines the travel instruction information based on the travel plan information stored in the storage device 10.
  • the automatic driving control device 11 includes a traveling plan information acquisition unit 20, a moving obstacle information acquisition unit 21, a moving obstacle identification unit 22, and a collision. It includes a probability calculation unit 23, a warning information determination unit 24, and a driving instruction information determination unit 25.
  • the moving obstacle specifying unit 22 includes a moving obstacle position specifying unit 30, a moving obstacle moving direction specifying unit 31, and a moving obstacle moving speed specifying unit 32.
  • the travel plan information acquisition unit 20 acquires travel plan information related to the travel plan of the automatic traveling vehicle 4 on the travel road.
  • the travel plan information acquisition unit 20 outputs the acquired travel plan information to the movement obstacle position specifying unit 30, the collision probability calculation unit 23, and the travel instruction information determination unit 25, respectively.
  • the travel plan information acquisition unit 20 acquires the travel plan information stored in the storage device 10.
  • the travel plan information includes the travel plan of the automatic traveling vehicle 4 on the traveling road and the assumed weight for each section based on the traveling plan of the automatic traveling vehicle 4.
  • the travel plan information acquisition unit 20 is based on the travel plan of the automatic traveling vehicle 4 indicated by the acquired travel plan information and the total weight of the automatic traveling vehicle 4. The estimated weight for each section may be calculated.
  • the configuration in which the travel plan information acquisition unit 20 acquires the travel plan information from the storage device 10 will be described, but the acquisition destination from which the travel plan information acquisition unit 20 acquires the travel plan information is not particularly limited. ..
  • the moving obstacle information acquisition unit 21 acquires the moving obstacle information regarding the moving obstacle moving on the traveling path.
  • the moving obstacle information acquisition unit 21 outputs the acquired moving obstacle information to the moving obstacle position specifying unit 30 or records it in the storage device 10.
  • the moving obstacle information acquisition unit 21 acquires the moving obstacle information detected by the sensor 2. More specifically, in the first embodiment, the moving obstacle information acquisition unit 21 acquires the moving obstacle information received by the communication device 12. Further, in the first embodiment, the moving obstacle information acquisition unit 21 further acquires status information such as the position of the sensor 2 and the time when the sensor 2 detects the moving obstacle information.
  • the moving obstacle information acquisition unit 21 outputs the acquired moving obstacle information and status information to the moving obstacle position specifying unit 30 or records them in the storage device 10.
  • the storage device 10 outputs the stored moving obstacle information and status information to the moving obstacle position specifying unit 30, the moving obstacle moving direction specifying unit 31, and the moving obstacle moving speed specifying unit 32.
  • the moving obstacle information acquisition unit 21 may record the moving obstacle information and the status information in an external device other than the server 1 via the communication device 12.
  • the moving obstacle information acquisition unit 21 uses the weight of each section detected by the sensor 2 as the moving obstacle information. To get.
  • the configuration in which the moving obstacle information acquisition unit 21 acquires the weight of each section as the moving obstacle information will be described.
  • the moving obstacle information acquisition unit 21 may acquire an image of a moving obstacle as moving obstacle information.
  • the moving obstacle information acquisition unit 21 may acquire the position of the moving obstacle. In that case, the moving obstacle information acquisition unit 21 outputs the acquired position of the moving obstacle to the moving obstacle moving direction specifying unit 31, the moving obstacle moving speed specifying unit 32, and the collision probability calculation unit 23, respectively.
  • the moving obstacle identification unit 22 identifies information about the moving obstacle based on the moving obstacle information acquired by the moving obstacle information acquisition unit 21.
  • the moving obstacle position specifying unit 30 of the moving obstacle specifying unit 22 is called by the moving obstacle information acquisition unit 21.
  • the moving obstacle position specifying unit 30 identifies the position of the moving obstacle based on the moving obstacle information acquired by the moving obstacle information acquisition unit 21. More specifically, the moving obstacle position specifying unit 30 identifies the position of the moving obstacle for each time based on the moving obstacle information for each time acquired by the moving obstacle information acquisition unit 21.
  • the moving obstacle position specifying unit 30 outputs the position of the moving obstacle at the specified time to the moving obstacle moving direction specifying unit 31, the moving obstacle moving speed specifying unit 32, and the collision probability calculation unit 23, respectively. Or record in the storage device 10.
  • the moving obstacle position specifying unit 30 is the weight of each section indicated by the moving obstacle information acquired by the moving obstacle information acquisition unit 21. And, by comparing with the assumed weight for each section indicated by the travel plan information, the section in which the moving obstacle exists is specified, and the position of the moving obstacle is specified. In the first embodiment, at that time, the moving obstacle position specifying unit 30 uses the position of the sensor 2 indicated by the above-mentioned status information acquired by the moving obstacle information acquisition unit 21 as the position of the moving obstacle. In the first embodiment, the configuration in which the moving obstacle position specifying unit 30 identifies the position of the moving obstacle by comparing the weight of each section with the assumed weight of each section will be described. For example, the sensor 2 will be described. When is a camera, the moving obstacle position specifying unit 30 may specify the position of the moving obstacle based on the image acquired by the moving obstacle information acquisition unit 21.
  • the moving obstacle moving direction specifying unit 31 of the moving obstacle specifying unit 22 specifies the moving direction of the moving obstacle based on the position of the moving obstacle specified by the moving obstacle position specifying unit 30. More specifically, the moving obstacle moving direction specifying unit 31 identifies the moving direction of the moving obstacle based on the position of the moving obstacle stored in the storage device 10 for each time. In the first embodiment, at that time, the moving obstacle moving direction specifying unit 31 uses the above-mentioned time indicated by the status information acquired by the moving obstacle information acquisition unit 21. The moving obstacle moving direction specifying unit 31 outputs the moving direction of the specified moving obstacle to the collision probability calculation unit 23 or records it in the storage device 10.
  • the moving obstacle moving speed specifying unit 32 of the moving obstacle specifying unit 22 specifies the moving speed of the moving obstacle based on the position of the moving obstacle specified by the moving obstacle position specifying unit 30. More specifically, the moving obstacle moving speed specifying unit 32 identifies the moving speed of the moving obstacle based on the position of the moving obstacle stored in the storage device 10 for each time. In the first embodiment, at that time, the moving obstacle moving speed specifying unit 32 uses the above-mentioned time indicated by the status information acquired by the moving obstacle information acquisition unit 21. The moving obstacle moving speed specifying unit 32 outputs the moving speed of the specified moving obstacle to the collision probability calculation unit 23 or records it in the storage device 10.
  • the collision probability calculation unit 23 is called by the moving obstacle position specifying unit 30, the moving obstacle moving direction specifying unit 31, or the moving obstacle moving speed specifying unit 32.
  • the collision probability calculation unit 23 calculates the collision probability between the autonomous vehicle 4 and the moving obstacle based on the traveling plan information and the moving obstacle information acquired by the moving obstacle information acquisition unit 21.
  • the collision probability calculation unit 23 outputs the calculated collision probability to the warning information determination unit 24 or records it in the storage device 10.
  • the collision probability calculation unit 23 moves the traveling plan of the automatic traveling vehicle 4 indicated by the traveling plan information, the position of the moving obstacle specified by the moving obstacle position specifying unit 30, and the movement. Based on the moving direction of the moving obstacle specified by the obstacle moving direction specifying unit 31 and the moving speed of the moving obstacle specified by the moving obstacle moving speed specifying unit 32, the automatic traveling vehicle 4 and the moving obstacle Calculate the collision probability of.
  • the travel plan information here is travel plan information acquired from the storage device 10 by the travel plan information acquisition unit 20.
  • the warning information determination unit 24 is called by the collision probability calculation unit 23.
  • the warning information determination unit 24 acquires warning information that warns the moving obstacle of the collision between the automatic traveling vehicle 4 and the moving obstacle by being displayed by the display device 3, the traveling plan information, and the moving obstacle information. The decision is made based on the moving obstacle information acquired by the unit 21.
  • the warning information determination unit 24 outputs the determined warning information to the communication device 12.
  • the warning information determination unit 24 has a travel plan of the automatic traveling vehicle 4 indicated by the travel plan information, and the moving obstacle position specifying unit 30 has a movement obstacle.
  • the warning information is determined based on the position of the moving obstacle identified based on the object information. More specifically, in the first embodiment, the warning information determination unit 24 determines the warning information based on the movement direction of the moving obstacle specified by the moving obstacle moving direction specifying unit 31. More specifically, in the first embodiment, the warning information determination unit 24 determines the warning information based on the movement speed of the moving obstacle specified by the moving obstacle moving speed specifying unit 32.
  • the warning information determination unit 24 has a collision probability calculation unit 23 calculated based on the travel plan of the automatic traveling vehicle 4 and the position, moving direction, and moving speed of the moving obstacle. Determine warning information based on probability. For example, the warning information determination unit 24 determines whether or not the collision probability is equal to or higher than a predetermined threshold value, and if the collision probability is equal to or higher than a predetermined threshold value, determines the warning information. For example, a plurality of warning information is prepared in advance, and the warning information determination unit 24 determines the warning information for display by selecting one warning information from the plurality of warning information based on the collision probability. do.
  • the travel instruction information determination unit 25 converts the travel instruction information indicating the automatic driving of the automatic traveling vehicle 4 on the traveling road into the traveling plan information regarding the traveling plan of the automatic traveling vehicle 4 on the traveling road by being displayed by the display device 3. Determine based on.
  • the travel instruction information determination unit 25 outputs the determined travel instruction information to the communication device 12. For example, a plurality of travel instruction information is prepared in advance, and the travel instruction information determination unit 25 displays by selecting one travel plan information from the plurality of travel instruction information based on the travel plan information. Determine the driving instruction information of.
  • the communication device 12 transmits the warning information determined by the warning information determination unit 24 and the travel instruction information determined by the travel instruction information determination unit 25 to the display device 3, respectively.
  • the display device 3 displays the warning information determined by the warning information determination unit 24 and the travel instruction information determined by the travel instruction information determination unit 25, respectively. More specifically, in the first embodiment, the display device 3 displays the warning information and the travel instruction information transmitted by the communication device 12, respectively.
  • the display device 3 includes a communication device (not shown), and the communication device receives warning information and travel instruction information from the communication device 12.
  • the display device 3 is a video output device such as a liquid crystal monitor, and the video output device displays warning information and travel instruction information as images, respectively.
  • the display device 3 may further include a voice output unit that outputs voice, and when displaying warning information, the voice output unit may output voice that warns a moving obstacle.
  • the automatic traveling vehicle 4 automatically travels on the traveling road based on the traveling instruction information displayed by the display device 3.
  • An example of the automatic traveling vehicle 4 is an automatic guided vehicle that transports luggage.
  • the autonomous vehicle 4 includes, for example, a sensor such as a camera, LiDAR (Light Detection and Ringing), radar, sonar, or a positioning device, a drive system such as a steering wheel, a brake, or an accelerator, a processor, a storage device, a communication interface, or the like. It is equipped with such hardware.
  • the automatic traveling vehicle 4 automatically travels on a traveling road by controlling a drive system based on traveling instruction information indicated by an image obtained by taking a picture of a display device 3 by a camera.
  • FIG. 3 is a flowchart showing a warning information determination method by the automatic driving control device 11 according to the first embodiment. It is assumed that the sensor 2 detects the weight of each section before the automatic traveling control device 11 executes each of the following steps.
  • the travel plan information acquisition unit 20 acquires travel plan information regarding the travel plan of the automatic traveling vehicle 4 on the travel path from the storage device 10 (step ST1).
  • the travel plan information includes the travel plan of the automatic traveling vehicle 4 on the traveling road and the assumed weight for each section based on the traveling plan of the automatic traveling vehicle 4.
  • the travel plan information acquisition unit 20 records the acquired travel plan information in the storage device 10.
  • the storage device 10 outputs the stored travel plan information to the movement obstacle position specifying unit 30, the collision probability calculation unit 23, and the travel instruction information determination unit 25, respectively.
  • the moving obstacle information acquisition unit 21 acquires the weight and status information for each of the above-mentioned sections from the sensor 2 (step ST2).
  • the moving obstacle information acquisition unit 21 records the acquired weight and status information for each section in the storage device 10.
  • the storage device 10 outputs the weight and status information for each stored section to the moving obstacle position specifying unit 30, the moving obstacle moving direction specifying unit 31, and the moving obstacle moving speed specifying unit 32, respectively.
  • the moving obstacle position specifying unit 30 compares the weight of each section indicated by the moving obstacle information stored in the storage device 10 with the assumed weight of each section indicated by the travel plan information stored in the storage device 10. By specifying the section where the moving obstacle exists, the position of the moving obstacle is specified (step ST3). At that time, the moving obstacle position specifying unit 30 further uses the status information stored in the storage device 10 to specify the position of the moving obstacle for each time. The moving obstacle position specifying unit 30 records the position of the moving obstacle at the specified time in the storage device 10. The storage device 10 outputs the position of the moving obstacle for each stored time to the moving obstacle moving direction specifying unit 31, the moving obstacle moving speed specifying unit 32, and the collision probability calculation unit 23, respectively.
  • the moving obstacle moving direction specifying unit 31 specifies the moving direction of the moving obstacle based on the position of the moving obstacle stored in the storage device 10 for each time (step ST4).
  • the moving obstacle moving direction specifying unit 31 records the moving direction of the specified moving obstacle in the storage device 10.
  • the storage device 10 outputs the moving direction of the stored moving obstacle to the collision probability calculation unit 23.
  • the moving obstacle moving speed specifying unit 32 specifies the moving speed of the moving obstacle based on the position of the moving obstacle for each time stored in the storage device 10 (step ST5).
  • the moving obstacle moving speed specifying unit 32 records the moving speed of the specified moving obstacle in the storage device 10.
  • the storage device 10 outputs the moving speed of the stored moving obstacle to the collision probability calculation unit 23.
  • the collision probability calculation unit 23 describes the travel plan of the automatic traveling vehicle 4 indicated by the travel plan information stored in the storage device 10, the position of the moving obstacle stored in the storage device 10, the moving direction and movement of the moving obstacle. Based on the moving speed of the obstacle, the collision probability between the autonomous vehicle 4 and the moving obstacle is calculated (step ST6). The collision probability calculation unit 23 records the calculated collision probability in the storage device 10.
  • the travel instruction information determination unit 25 receives the travel instruction information displayed by the display device 3 to instruct the automatic travel of the automatic traveling vehicle 4 on the travel path based on the travel plan information stored in the storage device 10. Determine (step ST7).
  • the travel instruction information determination unit 25 outputs the determined travel plan information to the display device 3 via the communication device 12.
  • the warning information determination unit 24 stores the warning information in which the storage device 10 stores the warning information that warns the moving obstacle of the collision between the autonomous vehicle 4 and the moving obstacle by being displayed by the display device 3. Determined based on probability (step ST8).
  • the warning information determination unit 24 outputs the determined warning information to the display device 3 via the communication device 12.
  • the display device 3 displays the travel plan information determined by the travel instruction information determination unit 25 in step ST7 and the warning information determined by the warning information determination unit 24 in step ST8, respectively.
  • FIG. 4 is a diagram showing a configuration of a specific example in which the automatic driving control system 100 according to the first embodiment is operated.
  • the work area A which is the travel path of the autonomous vehicle 4 is composed of four sections, a section A1, a section A2, a section A3, and a section A4.
  • An example of work area A is the floor of a factory or warehouse. It is assumed that the compartments A1, the compartments A2, the compartments A3, and the compartments A4 are regions in which the work area A is divided into predetermined sizes, and the sensor 2 and the display device 3 are installed in each compartment (Fig.). In 4, only the section A1 is shown).
  • the senor 2 is a weight sensor that detects at least one of the weight of a human being existing in the installed section or the total weight of the autonomous vehicle 4.
  • the automatic traveling vehicle 4 is an automatic guided vehicle.
  • the display device 3 displays the above-mentioned warning information to the person B who freely moves in the work area A in the installed section, and the above-mentioned traveling instruction to the automatic traveling vehicle 4. Display information. In the specific example, the display device 3 displays warning information to the person B existing in the section A3.
  • the automatic traveling vehicle 4 travels from the current section toward any one of the other sections existing on the front, back, left, and right of the section according to the running instruction information displayed by the display device 3.
  • the automatic traveling vehicle 4 travels from the current section A3 toward the section A1 or the section A4 according to the running instruction information displayed by the display device 3.
  • the example in which the work area A, which is the travel path of the automatic traveling vehicle 4, is composed of four sections has been described, but the traveling path of the automatic traveling vehicle 4 is divided by the number of divisions other than that. It may have been done. Further, in the specific example, an example is shown in which only one automatic traveling vehicle 4 exists in the work area A and only one human B exists, but the automatic traveling vehicle 4 is on the traveling path of the automatic traveling vehicle 4. And there may be more than one human being.
  • FIG. 5 is a diagram showing specific examples of travel instruction information and warning information displayed by the display device 3 of the automatic travel control system 100 according to the first embodiment.
  • the travel instruction information C is travel instruction information instructing the automatic traveling vehicle 4 to go straight.
  • the travel instruction information D is travel instruction information for instructing the automatic traveling vehicle 4 to turn right.
  • the travel instruction information E is travel instruction information for instructing the automatic traveling vehicle 4 to turn left.
  • the travel instruction information F is travel instruction information for instructing the automatic traveling vehicle 4 to stop.
  • the warning information G is warning information for warning a moving obstacle of a collision with the autonomous vehicle 4.
  • the travel instruction information determination unit 25 displays the travel instruction information C, the travel instruction information D, the travel instruction information E, or the travel instruction information F based on the travel plan information. Determine the driving instruction information for.
  • the warning information determination unit 24 determines the warning information G as the warning information for display based on the collision probability.
  • the display device 3 displays the travel plan information determined by the travel instruction information determination unit 25 in step ST7 and the warning information determined by the warning information determination unit 24 in step ST8, respectively.
  • FIG. 6 is a diagram for explaining a specific example of the warning information determination method by the automatic driving control device 11 according to the first embodiment.
  • FIG. 6A shows the situation of the work area H at the time t
  • FIG. 6B shows the situation of the work area H at the time t + 1.
  • the work area H which is the travel path of the autonomous vehicle 4 is composed of four sections, a section H11, a section H12, a section H21, and a section H22.
  • Each of the compartments H11, the compartment H12, the compartment H21, and the compartment H22 is a region in which the work area H is divided into predetermined sizes, and although not shown, the sensor 2 and the display device 3 are installed in each compartment. And.
  • the travel plan information acquisition unit 20 acquires S11, t as the assumed weight of the section H11 at the time t from the storage device 10, and S as the assumed weight of the section H12 at the time t. 12, acquires the t, as envisaged by weight compartments H21 at time t, to get the S 21, t, as envisaged by weight compartments H22 at time t, to obtain the S 22, t. Further, the travel plan information acquisition unit 20 acquires S11, t + 1 as the assumed weight of the section H11 at the time t + 1 from the storage device 10, and acquires S12, t + 1 as the assumed weight of the section H12 at the time t + 1.
  • the moving obstacle information acquisition unit 21 acquires W11, t as the weight of the compartment H11 at the time t from the sensor 2 installed in the work area H, and the compartment at the time t. as the weight of H12, acquires W 12, t, as the weight of the compartment H21 at time t, to get the W 21, t, as compartments H22 at time t, to obtain a W 22, t. Further, the moving obstacle information acquisition unit 21 acquires W11 and t + 1 as the weight of the compartment H11 at the time t + 1 from the sensor 2 installed in the work area H, and W 12 as the weight of the compartment H12 at the time t + 1.
  • the mobile obstacle information acquiring unit 21 as position information of the partition H11 (status information), to get the x 11, as the position information of the partition H12, acquires x 12, as the position information of the partition H21, x 21 Is acquired, and x 22 is acquired as the position information of the section H22. It is assumed that x 11 , x 12 , x 21 and x 22 are three-dimensional vectors, respectively.
  • the moving obstacle position specifying unit 30 identifies the section in which the moving obstacle exists by comparing the weight of each section with the assumed weight of each section, thereby causing the moving obstacle. Identify the position of an object. More specifically, for example, moving obstacle position specifying unit 30 calculates the difference between W 11, t -S 11, t and assuming the weight of the weight and the section H11 compartments H11 at time t, the calculation result is given If it is less than the threshold value, it is determined that there is no moving obstacle in the compartment H11.
  • the moving obstacle position specifying unit 30 calculates the difference W11, t- S11, t between the weight of the section H11 and the assumed weight of the section H11 at time t , and the calculation result is equal to or higher than a predetermined threshold value. in some cases, it is determined that the moving obstacle is present in the compartment H11, the position of the moving obstacle at the time t is identified as the x 11.
  • moving obstacle position specifying unit 30 the position of the moving obstacle at the time t is identified as x 12 . Further, since the human B who is a moving obstacle exists in the section H22 at the time t + 1, the moving obstacle position specifying unit 30 specifies that the position of the moving obstacle at the time t + 1 is x 22 .
  • the moving obstacle moving direction specifying unit 31 specifies the moving direction of the moving obstacle based on the position of the moving obstacle at each time.
  • the moving obstacle moving direction specifying unit 31 is based on the moving obstacle position x 22 at the time t + 1 specified by the moving obstacle position specifying unit 30 and the moving obstacle position x 12 at the time t.
  • is calculated as the moving direction of the moving obstacle from the time t to the time t + 1.
  • is the length of the vector x 22 ⁇ x 12.
  • the moving obstacle moving speed specifying unit 32 specifies the moving speed of the moving obstacle based on the position of the moving obstacle at each time.
  • the moving obstacle moving speed specifying unit 32 is the moving obstacle moving speed specifying unit 32 at the moving obstacle position x 22 and the time t at the time t + 1 specified by the moving obstacle position specifying unit 30.
  • / (t + 1-t) is calculated as the moving speed of the moving obstacle from the time t to the time t + 1.
  • the collision probability calculation unit 23 determines the travel plan of the automatic traveling vehicle 4 indicated by the travel plan information, the position of the moving obstacle, the moving direction of the moving obstacle, and the moving speed of the moving obstacle. , The collision probability between the autonomous vehicle 4 and the moving obstacle is calculated.
  • the collision probability calculation unit 23 may use the positions of the moving obstacles at the time t and the time t + 1 specified in the above steps ST3, ST4 and ST5, and the moving direction of the moving obstacles from the time t to the time t + 1.
  • the position of the moving obstacle at a future time is estimated based on the moving speed, and if the position is close to the traveling position of the automatic traveling vehicle 4 at the future time indicated by the traveling plan written in the storage device 10.
  • the collision probability calculation unit 23 determines whether or not the calculated collision probability is equal to or higher than a predetermined threshold value, and if the collision probability is determined to be equal to or higher than a predetermined threshold value, the storage device 10 has a high collision probability.
  • the warning information determination unit 24 determines the warning information to be displayed by the display device 3 based on the information.
  • FIG. 7 is a flowchart showing specific examples of steps ST7 and ST8 in the warning information determination method by the automatic driving control device 11 according to the first embodiment.
  • the display device 3 is installed in each of a plurality of sections.
  • the storage device 10 stores a plurality of travel instruction information and warning information in advance.
  • the collision probability calculation unit 23 determines whether or not the collision probability calculated in step ST6 described above is equal to or higher than a predetermined threshold value, and if the collision probability is equal to or higher than the predetermined threshold value, the storage device 10 has a collision probability. It is assumed that the information indicating that the value is high is recorded.
  • the travel instruction information determination unit 25 reads the travel plan information recorded in the storage device 10 by the travel plan information acquisition unit 20 in step ST1, and the warning information determination unit 24 calculates the collision probability in step ST6.
  • the unit 23 reads the information regarding the collision probability recorded in the storage device 10 (step ST10).
  • the travel instruction information determination unit 25 selects the travel instruction information for display from the plurality of travel instruction information stored in the storage device 10 for each section based on the read travel plan information (the travel instruction information determination unit 25). Step ST11).
  • the travel instruction information determination unit 25 outputs the determined travel plan information to the display device 3 via the communication device 12.
  • the travel instruction information determination unit 25 does not select the travel instruction information for display with respect to the section in which the automatic traveling vehicle 4 does not travel, based on the travel plan information. That is, the display device 3 installed in the section does not display the travel instruction information.
  • the warning information determination unit 24 determines whether or not the read information regarding the collision probability indicates that the collision probability is high (step ST12).
  • the warning information determination unit 24 determines that the read information regarding the collision probability indicates that the collision probability is high (YES in step ST12)
  • the warning information determination unit 24 is among the display information stored in the storage device 10. , Select warning information (step ST13).
  • the warning information determination unit 24 outputs the selected warning information to the display device 3 via the communication device 12.
  • the warning information determination unit 24 is specified by the moving obstacle moving direction specifying unit 31 in the above step ST5 from the position of the moving obstacle specified by the moving obstacle position specifying unit 30 in the above step ST4. Determines the warning information to be displayed in the section existing in the moving direction of the moving obstacle. That is, the display device 3 installed in the section displays the warning information. This makes it easier for the moving obstacle to recognize the warning information displayed by the display device 3.
  • the automatic driving control device 11 ends the process.
  • the automatic traveling control device 11 includes a processing circuit for executing the processing of each step shown in FIGS. 3 and 7.
  • This processing circuit may be dedicated hardware, or may be a CPU (Central Processing Unit) that executes a program stored in the memory.
  • FIG. 8A is a block diagram showing a hardware configuration that realizes the function of the automatic driving control device 11.
  • FIG. 8B is a block diagram showing a hardware configuration for executing software that realizes the functions of the automatic driving control device 11.
  • the storage device 102 shown in FIGS. 8A and 8B has the same function as that of the storage device 10 described above.
  • the communication device 103 shown in FIGS. 8A and 8B has the same function as the above-mentioned communication device 12.
  • the processing circuit 101 may be, for example, a single circuit, a composite circuit, a programmed processor, a parallel programmed processor, or an ASIC (Application Specific Integrated Circuitd). Circuit), FPGA (Field-Programmable Gate Array) or a combination thereof is applicable.
  • ASIC Application Specific Integrated Circuitd
  • FPGA Field-Programmable Gate Array
  • Functions of the travel plan information acquisition unit 20, the movement obstacle information acquisition unit 21, the movement obstacle identification unit 22, the collision probability calculation unit 23, the warning information determination unit 24, and the travel instruction information determination unit 25 in the automatic travel control device 11. May be realized by separate processing circuits, or these functions may be collectively realized by one processing circuit.
  • the processing circuit is the processor 104 shown in FIG. 8B, the travel plan information acquisition unit 20, the moving obstacle information acquisition unit 21, the moving obstacle identification unit 22, the collision probability calculation unit 23, and the warning in the automatic driving control device 11.
  • Each function of the information determination unit 24 and the travel instruction information determination unit 25 is realized by software, firmware, or a combination of software and firmware.
  • the software or firmware is described as a program and stored in the memory 105.
  • the processor 104 By reading and executing the program stored in the memory 105, the processor 104 reads and executes the travel plan information acquisition unit 20, the movement obstacle information acquisition unit 21, the movement obstacle identification unit 22, and the collision probability in the automatic travel control device 11. Each function of the calculation unit 23, the warning information determination unit 24, and the travel instruction information determination unit 25 is realized. That is, the automatic driving control device 11 is a memory 105 for storing a program in which the processing of each step shown in FIGS. 3 and 7 is executed as a result when each of these functions is executed by the processor 104. To prepare for.
  • These programs include a travel plan information acquisition unit 20, a movement obstacle information acquisition unit 21, a movement obstacle identification unit 22, a collision probability calculation unit 23, a warning information determination unit 24, and a travel instruction information determination in the automatic travel control device 11.
  • the memory 105 uses the computer as a travel plan information acquisition unit 20, a movement obstacle information acquisition unit 21, a movement obstacle identification unit 22, a collision probability calculation unit 23, a warning information determination unit 24, and a travel instruction in the automatic travel control device 11. It may be a computer-readable storage medium in which a program for functioning as the information determination unit 25 is stored.
  • the processor 104 corresponds to, for example, a CPU (Central Processing Unit), a processing device, a computing device, a processor, a microprocessor, a microcomputer, a DSP (Digital Signal Processor), or the like.
  • the memory 105 may include, for example, a RAM (Random Access Memory), a ROM (Read Only Memory), a flash memory, an EPROM (Erasable Programmable Read Only Memory), an EEPROM (Electrically-EPROM), or an EEPROM (Electrically-EPROM).
  • a RAM Random Access Memory
  • ROM Read Only Memory
  • flash memory an EPROM (Erasable Programmable Read Only Memory)
  • EEPROM Electrically-EPROM
  • EEPROM Electrically-EPROM
  • each function of the travel plan information acquisition unit 20, the movement obstacle information acquisition unit 21, and the movement obstacle identification unit 22 is realized by a processing circuit as dedicated hardware.
  • the functions of the collision probability calculation unit 23, the warning information determination unit 24, and the travel instruction information determination unit 25 may be realized by the processor 104 reading and executing the program stored in the memory 105.
  • the processing circuit can realize each of the above functions by hardware, software, firmware, or a combination thereof.
  • the automatic driving control device 11 automatically travels on the traveling road by displaying the traveling instruction information indicating the automatic traveling of the automatic traveling vehicle 4 on the traveling road by being displayed by the display device 3.
  • the automatic driving control device 11 that determines based on the driving plan information related to the driving plan of the vehicle 4, the moving obstacle information acquisition unit 21 that acquires the moving obstacle information about the moving obstacle moving on the traveling road, and the display device.
  • the traveling plan information and the moving obstacle information acquired by the moving obstacle information acquisition unit 21 provide warning information for warning the moving obstacle of the collision between the autonomous vehicle 4 and the moving obstacle by being displayed by 3.
  • the warning information determination unit 24, which determines based on the above, is provided. According to the above configuration, by appropriately displaying the determined warning information, it is possible to give a warning to a moving obstacle and prevent a collision between the autonomous vehicle and the moving obstacle.
  • self-driving cars that automatically move in a specific environment without the need for human control have been actively put into practical use.
  • examples of an automatic traveling vehicle that has been put into practical use include an automatic guided vehicle, an automatic cleaning device for cleaning purposes, a security robot, and the like.
  • these self-driving cars are expected to be put into practical use in environments such as factories, warehouses or offices where there are moving obstacles such as humans or vehicles other than self-driving cars. Therefore, according to the above configuration, for example, it is possible to give a warning to a moving obstacle existing in these environments, and it is possible to prevent a collision between the autonomous vehicle and the moving obstacle.
  • the traveling path is composed of a plurality of sections
  • the moving obstacle information acquired by the moving obstacle information acquisition unit 21 is the weight of each section, and the traveling plan information. Includes the assumed weight for each section based on the travel plan of the autonomous vehicle 4, the weight for each section indicated by the moving obstacle information acquired by the moving obstacle information acquisition unit 21, and each section indicated by the traveling plan information.
  • a moving obstacle position specifying unit 30 for specifying the position of the moving obstacle by specifying the section where the moving obstacle exists by comparing with the assumed weight is further provided, and the warning information determination unit 24 is the traveling plan information.
  • the warning information is determined based on the travel plan of the automatic traveling vehicle 4 indicated by the above and the position of the moving obstacle specified by the moving obstacle position specifying unit 30 based on the moving obstacle information.
  • the position of the moving obstacle can be specified based on the weight of each section, and the warning information can be suitably determined based on the position of the moving obstacle, and the autonomous vehicle and the moving vehicle can be moved. It is possible to prevent a collision with an obstacle.
  • the automatic traveling control device 11 has a moving obstacle moving direction specifying unit 31 that specifies the moving direction of the moving obstacle based on the position of the moving obstacle specified by the moving obstacle position specifying unit 30. Further, the warning information determination unit 24 determines the warning information based on the movement direction of the moving obstacle specified by the moving obstacle moving direction specifying unit 31.
  • the moving direction of the moving obstacle can be specified based on the position of the specified moving obstacle, and the warning information can be suitably determined based on the moving direction of the moving obstacle. , It is possible to prevent a collision between an autonomous vehicle and a moving obstacle.
  • the automatic traveling control device 11 has a moving obstacle moving speed specifying unit 32 that specifies the moving speed of the moving obstacle based on the position of the moving obstacle specified by the moving obstacle position specifying unit 30. Further, the warning information determination unit 24 determines the warning information based on the movement speed of the moving obstacle specified by the moving obstacle moving speed specifying unit 32.
  • the moving speed of the moving obstacle can be specified based on the position of the specified moving obstacle, and the warning information can be suitably determined based on the moving speed of the moving obstacle. , It is possible to prevent a collision between an autonomous vehicle and a moving obstacle.
  • the automatic traveling control device 11 has a traveling plan of the automatic traveling vehicle 4 indicated by the traveling plan information, a position of a moving obstacle specified by a moving obstacle position specifying unit 30, and a moving obstacle moving direction identification.
  • the collision probability between the autonomous vehicle 4 and the moving obstacle is calculated based on the moving direction of the moving obstacle specified by the unit 31 and the moving speed of the moving obstacle specified by the moving obstacle specifying unit 32.
  • the collision probability calculation unit 23 is further provided, and the warning information determination unit 24 determines the warning information based on the collision probability calculated by the collision probability calculation unit 23.
  • the collision probability can be calculated based on the position, the moving direction, and the moving speed of the specified moving obstacle, and the warning information can be suitably determined based on the collision probability. Can prevent collisions with moving obstacles.
  • the automatic driving control system 100 has an automatic driving control device 11 according to the first embodiment, a display device 3, an automatic traveling vehicle 4, and a sensor 2 that detects moving obstacle information related to a moving obstacle. And, including. According to the above configuration, in the automatic driving control system 100, the above-mentioned effect played by the automatic driving control device 11 according to the first embodiment can be obtained.
  • the warning information determination method relates to the traveling instruction information indicating the automatic traveling of the automatic traveling vehicle 4 on the traveling road by being displayed by the display device 3 with respect to the traveling plan of the automatic traveling vehicle 4 on the traveling road. It is an automatic driving control method that is determined based on the driving plan information, and is automatically displayed by the moving obstacle information acquisition step for acquiring the moving obstacle information regarding the moving obstacle moving on the traveling path and the display device 3. Warning information determination step to determine warning information to warn the moving obstacle of the collision between the traveling vehicle 4 and the moving obstacle based on the traveling plan information and the moving obstacle information acquired in the moving obstacle information acquisition step. And, including. According to the above configuration, the same effect as that of the automatic driving control device 11 according to the first embodiment is obtained.
  • Embodiment 2 the automatic driving control system 100 according to the first embodiment is used.
  • the first embodiment a configuration assuming a case where only one automatic traveling vehicle 4 exists in a certain section at a certain time has been described.
  • a configuration assuming a case where a plurality of autonomous vehicles 4 exist at the same time in a certain section at a certain time will be described.
  • Each of the traveling instruction information determining units 25 displays a plurality of traveling instruction information indicating the automatic traveling of the corresponding automatic traveling vehicle 4 on the traveling road by displaying the display device 3 on the traveling road. It is determined based on the travel plan information about each travel plan of the plurality of automatic traveling vehicles 4 in the above.
  • the travel instruction information determination unit 25 further determines the display method of the display device 3 for each travel instruction information to be determined. In other words, the travel instruction information determination unit 25 further determines the display method of the display device 3 for each automatic traveling vehicle 4 instructed by the travel instruction information to be determined. That is, the display device 3 displays the travel instruction information determined by the travel instruction information determination unit 25 in the display method determined by the travel instruction information determination unit 25. Then, each of the plurality of automatic traveling vehicles 4 automatically travels on the traveling road based on the traveling instruction information displayed by the display device 3 in the corresponding display method. Therefore, each of the plurality of automatic traveling vehicles 4 automatically travels according to only the traveling instruction information displayed by the corresponding display method. As a result, even when a plurality of automatic traveling vehicles 4 exist at the same time in a certain section at a certain time, it is possible to give a traveling instruction to the target automatic traveling vehicle 4.
  • the travel plan information referred to by the travel instruction information determination unit 25 includes the travel route and travel time from the travel start point of the autonomous vehicle 4 to the destination, and the weight or automatic travel of the autonomous vehicle 4. This is information in which weight data including the weight of luggage carried by the vehicle 4 and the display method of the display device 3 allocated to the autonomous vehicle 4 without duplication are associated with each other.
  • the travel instruction information determination unit 25 determines the display method of the display device 3 together with the travel instruction information for each automatic traveling vehicle 4 based on the travel plan information. In the second embodiment, it is assumed that the travel plan information is recorded in the storage device 10 in advance.
  • the travel instruction information determination unit 25 determines the display color of the display device 3 as the display method for each travel instruction information to be determined.
  • the display color is, for example, red, green or blue.
  • the display device 3 displays the travel instruction information determined by the travel instruction information determination unit 25 in the red display color determined by the travel instruction information determination unit 25.
  • the automatic traveling vehicle 4 corresponding to the red display color automatically travels on the traveling road based on the traveling instruction information displayed in red by the display device 3.
  • the display device 3 further displays the travel instruction information determined by the travel instruction information determination unit 25 in the green display color determined by the travel instruction information determination unit 25.
  • another automatic traveling vehicle 4 corresponding to the green display color automatically travels on the traveling road based on the traveling instruction information displayed in green by the display device 3.
  • the travel instruction information determination unit 25 determines the blinking cycle of the display device 3 as a display method for each travel instruction information to be determined. More specifically, for example, the display device 3 displays the travel instruction information determined by the travel instruction information determination unit 25 at a blinking cycle of 3 times per second determined by the travel instruction information determination unit 25. Then, the automatic traveling vehicle 4 corresponding to the blinking cycle of 3 times per second automatically travels on the traveling road based on the traveling instruction information displayed by the display device 3 in the blinking cycle of 3 times per second. On the other hand, the display device 3 further displays the travel instruction information determined by the travel instruction information determination unit 25 at a blinking cycle of 4 times per second determined by the travel instruction information determination unit 25. Then, another automatic traveling vehicle 4 corresponding to the blinking cycle of 4 times per second automatically travels on the traveling road based on the traveling instruction information displayed by the display device 3 in the blinking cycle of 4 times per second. ..
  • FIG. 9 is a flowchart showing a driving instruction information determination method by the automatic driving control device 11 according to the second embodiment. From step ST20 to step ST23 of the driving instruction information determination method by the automatic driving control device 11 according to the second embodiment, from step ST10 in the specific example of the warning information determination method by the automatic driving control device 11 according to the first embodiment. This is the same as step ST13. Therefore, the description of steps ST20 to ST23 of the driving instruction information determination method by the automatic driving control device 11 according to the second embodiment will be omitted. It is assumed that the storage device 10 stores in advance a plurality of display methods of the display device 3 allocated to the automatic traveling vehicle 4 without duplication.
  • the travel instruction information determination unit 25 has a plurality of displays stored in the storage device 10 for each travel instruction information selected in step ST21.
  • One display method is selected from the methods (step ST24).
  • the display device 3 displays the travel instruction information determined by the travel instruction information determination unit 25 in step ST21 in the display method selected by the travel instruction information determination unit 25 in step ST24. Then, each of the plurality of automatic traveling vehicles 4 automatically travels on the traveling road based on the traveling instruction information displayed by the display device 3 in the corresponding display method.
  • the automatic traveling control device 11 according to the second embodiment includes a processing circuit for executing the processing from step ST20 to step ST24 shown in FIG.
  • This processing circuit may be dedicated hardware, or may be a CPU (Central Processing Unit) that executes a program stored in the memory.
  • the hardware configuration that realizes the function of the automatic driving control device 11 according to the second embodiment is the same as the hardware configuration shown in FIG. 8A. Further, the hardware configuration for executing the software that realizes the function of the automatic driving control device 11 according to the second embodiment is the same as the hardware configuration shown in FIG. 8B.
  • each of the automatic driving control devices 11 according to the second embodiment is displayed by the display device 3 to indicate a plurality of driving instruction information for instructing the automatic driving of the corresponding automatic driving vehicle 4 on the traveling road. Further includes a travel instruction information determination unit 25 that determines based on the travel plan information regarding each travel plan of the plurality of automatic traveling vehicles 4 on the travel road, and the travel instruction information determination unit 25 determines each travel instruction information. The display method of the display device 3 is further determined.
  • the plurality of automatic traveling vehicles 4 appropriately travel on the traveling road based on the traveling instruction information displayed in the corresponding display method, respectively, thereby performing the desired automatic driving. It is possible to give a driving instruction to a traveling vehicle.
  • the travel instruction information determination unit 25 in the automatic travel control device 11 determines the display color of the display device 3 as a display method for each travel instruction information to be determined. According to the above configuration, a plurality of automatic traveling vehicles 4 appropriately travel on a traveling road based on the traveling instruction information displayed in the corresponding display colors, respectively, thereby performing the desired automatic driving. It is possible to give a traveling instruction to the traveling vehicle 4.
  • the travel instruction information determination unit 25 in the automatic travel control device 11 determines the blinking cycle of the display device 3 as a display method for each travel instruction information to be determined.
  • the plurality of automatic traveling vehicles 4 appropriately travel on the traveling road based on the traveling instruction information displayed in the corresponding blinking cycle, respectively, thereby performing the desired automatic driving. It is possible to give a traveling instruction to the traveling vehicle 4. It should be noted that any combination of the embodiments can be freely combined, any component of the embodiment can be modified, or any component can be omitted in each embodiment.
  • the automatic driving control device can be used for an automatic driving control system because it can prevent a collision between an automatic driving vehicle and a moving obstacle.

Abstract

The present invention provides a technology that enables prevention of collision between an autonomous travel vehicle and a moving obstacle. This autonomous travel control device (11) is provided with a warning information determination unit (24) for determining, on the basis of travel plan information and moving obstacle information acquired by a moving obstacle information acquiring unit (21), warning information that gives a warning of collision between an autonomous travel vehicle (4) and a moving obstacle to the moving obstacle by being displayed on a display device (3).

Description

自動走行制御装置、自動走行制御システム、及び警告情報決定方法Automatic driving control device, automatic driving control system, and warning information determination method
 本開示は、自動走行制御装置に関する。 This disclosure relates to an automatic driving control device.
 特許文献1には、複数の自動走行車の各自動走行を制御する自動配車システムが記載されている。当該自動配車システムは、それぞれが走行動作指示情報を表示する複数の標識と、それぞれが、標識が表示した走行動作指示情報に基づいて自動走行を行う複数の自動走行車とを含む。 Patent Document 1 describes an automatic vehicle allocation system that controls each automatic driving of a plurality of automatic traveling vehicles. The automatic vehicle allocation system includes a plurality of signs, each of which displays driving operation instruction information, and a plurality of automatic traveling vehicles, each of which automatically travels based on the driving operation instruction information displayed by the signs.
特開2000-194417号公報Japanese Unexamined Patent Publication No. 2000-194417
 上記のような技術では、自動走行車同士の衝突を防止することができるが、自動走行車と、人間、又は自動走行車以外の車両等の移動する障害物(以下、移動障害物と呼称する)との衝突を防止することができないという問題がある。
 本開示は、上記のような問題点を解決するためになされたものであり、自動走行車と移動障害物との衝突を防止することができる技術を提供することを目的とする。
With the above technology, it is possible to prevent collisions between autonomous vehicles, but moving obstacles such as autonomous vehicles and humans or vehicles other than autonomous vehicles (hereinafter referred to as moving obstacles). ), There is a problem that it cannot be prevented.
The present disclosure has been made to solve the above-mentioned problems, and an object of the present disclosure is to provide a technique capable of preventing a collision between an autonomous vehicle and a moving obstacle.
 本開示に係る自動走行制御装置は、表示装置によって表示されることにより走行路における自動走行車の自動走行を指示する走行指示情報を、走行路における自動走行車の走行計画に関する走行計画情報に基づいて決定する自動走行制御装置であって、走行路において移動する移動障害物に関する移動障害物情報を取得する移動障害物情報取得部と、表示装置によって表示されることにより自動走行車と移動障害物との衝突を移動障害物に対して警告する警告情報を、走行計画情報、及び移動障害物情報取得部が取得した移動障害物情報に基づいて決定する警告情報決定部と、を備えている。 The automatic driving control device according to the present disclosure obtains driving instruction information indicating automatic driving of an automatic driving vehicle on a traveling road by being displayed by a display device, based on driving planning information related to a traveling plan of the automatic traveling vehicle on the traveling road. It is an automatic driving control device that determines the automatic driving, and it is a moving obstacle information acquisition unit that acquires moving obstacle information about moving obstacles moving on the traveling road, and an automatic traveling vehicle and a moving obstacle by being displayed by a display device. It is provided with a warning information determination unit that determines warning information for warning a collision with a moving obstacle based on the traveling plan information and the moving obstacle information acquired by the moving obstacle information acquisition unit.
 本開示によれば、自動走行車と移動障害物との衝突を防止することができる。 According to the present disclosure, it is possible to prevent a collision between an autonomous vehicle and a moving obstacle.
実施の形態1に係る自動走行制御システムの構成を示すブロック図である。It is a block diagram which shows the structure of the automatic driving control system which concerns on Embodiment 1. FIG. 実施の形態1に係るサーバの詳細な構成を示すブロック図である。It is a block diagram which shows the detailed structure of the server which concerns on Embodiment 1. FIG. 実施の形態1に係る自動走行制御装置による警告情報決定方法を示すフローチャートである。It is a flowchart which shows the warning information determination method by the automatic driving control device which concerns on Embodiment 1. 実施の形態1に係る自動走行制御システムを運用した具体例の構成を示す図である。It is a figure which shows the structure of the specific example which operated the automatic driving control system which concerns on Embodiment 1. FIG. 実施の形態1に係る自動走行制御システムの表示装置が表示する走行指示情報及び警告情報の具体例を示す図である。It is a figure which shows the specific example of the driving instruction information and warning information displayed by the display device of the automatic driving control system which concerns on Embodiment 1. FIG. 図6Aは、時刻tにおける作業領域Hの状況を示す図である。図6Bは、時刻t+1における作業領域Hの状況を示す図である。FIG. 6A is a diagram showing a situation of the work area H at time t. FIG. 6B is a diagram showing a situation of the work area H at time t + 1. 実施の形態1に係る自動走行制御装置による警告情報決定方法におけるステップST7及びステップST8の具体例を示すフローチャートである。It is a flowchart which shows the specific example of step ST7 and step ST8 in the warning information determination method by the automatic driving control device which concerns on Embodiment 1. FIG. 図8Aは、自動走行制御装置11の機能を実現するハードウェア構成を示すブロック図である。図8Bは、自動走行制御装置11の機能を実現するソフトウェアを実行するハードウェア構成を示すブロック図である。FIG. 8A is a block diagram showing a hardware configuration that realizes the functions of the automatic driving control device 11. FIG. 8B is a block diagram showing a hardware configuration for executing software that realizes the functions of the automatic driving control device 11. 実施の形態2に係る自動走行制御装置による走行指示情報決定方法を示すフローチャートである。It is a flowchart which shows the driving instruction information determination method by the automatic driving control device which concerns on Embodiment 2.
 以下、本開示をより詳細に説明するため、本開示を実施するための形態について、添付の図面に従って説明する。
実施の形態1.
 図1は、実施の形態1に係る自動走行制御システム100の構成を示すブロック図である。図2は、実施の形態1に係るサーバ1の詳細な構成を示すブロック図である。図1が示すように、自動走行制御システム100は、センサ2、サーバ1、表示装置3、及び自動走行車4を含む。サーバ1は、記憶装置10、自動走行制御装置11、及び通信装置12を備えている。なお、実施の形態1では、自動走行制御装置11がサーバ1に設置されている構成を説明するが、自動走行制御装置11の設置場所は、特に限定されない。
Hereinafter, in order to explain the present disclosure in more detail, a mode for carrying out the present disclosure will be described with reference to the accompanying drawings.
Embodiment 1.
FIG. 1 is a block diagram showing a configuration of an automatic driving control system 100 according to the first embodiment. FIG. 2 is a block diagram showing a detailed configuration of the server 1 according to the first embodiment. As shown in FIG. 1, the automatic driving control system 100 includes a sensor 2, a server 1, a display device 3, and an automatic driving vehicle 4. The server 1 includes a storage device 10, an automatic driving control device 11, and a communication device 12. In the first embodiment, the configuration in which the automatic driving control device 11 is installed in the server 1 will be described, but the installation location of the automatic driving control device 11 is not particularly limited.
 また、実施の形態1では、自動走行制御システム100がセンサ2、表示装置3及び自動走行車4をそれぞれ1つ含む構成を説明するが、自動走行制御システム100は、センサ2を複数含んでもよい。自動走行制御システム100は、表示装置3を複数含んでもよい。自動走行制御システム100は、自動走行車4を複数含んでもよい。 Further, in the first embodiment, the configuration in which the automatic driving control system 100 includes one sensor 2, the display device 3, and the automatic driving vehicle 4 will be described, but the automatic driving control system 100 may include a plurality of sensors 2. .. The automatic traveling control system 100 may include a plurality of display devices 3. The automatic traveling control system 100 may include a plurality of automatic traveling vehicles 4.
 センサ2は、自動走行車4の走行路において移動する移動障害物に関する移動障害物情報を検出する。実施の形態1では、センサ2が検出する移動障害物情報は、自動走行車4に関する情報を含み得る。センサ2は、検出した移動障害物情報、及び移動障害物情報を検出した時刻をサーバ1に出力する。より詳細には、実施の形態1では、センサ2は、図示しない通信装置を備え、当該通信装置が当該移動障害物情報及び当該時刻をサーバ1に送信する。 The sensor 2 detects the moving obstacle information regarding the moving obstacle moving on the traveling path of the automatic traveling vehicle 4. In the first embodiment, the moving obstacle information detected by the sensor 2 may include information about the autonomous vehicle 4. The sensor 2 outputs the detected moving obstacle information and the time when the moving obstacle information is detected to the server 1. More specifically, in the first embodiment, the sensor 2 includes a communication device (not shown), and the communication device transmits the moving obstacle information and the time to the server 1.
 なお、本明細書において、移動障害物は、自動走行制御装置11の制御に従わない移動可能な物体を意味する。移動障害物の例として、走行路において移動する人間、又は人間が運転する車両等が挙げられる。 In the present specification, the moving obstacle means a movable object that does not follow the control of the automatic traveling control device 11. Examples of moving obstacles include humans moving on the road, vehicles driven by humans, and the like.
 センサ2の構成についてより詳細には、実施の形態1では、走行路は、複数の区画から構成されており、センサ2は、区画毎の重量を検出する重量センサである。センサ2が検出する区画毎の重量は、例えば、ある時刻の、ある区画における自動走行車4の重量、ある時刻の、ある区画における移動障害物の重量、又は、ある時刻の、ある区画における自動走行車4の重量及び移動障害物の重量である。 More specifically about the configuration of the sensor 2, in the first embodiment, the traveling path is composed of a plurality of sections, and the sensor 2 is a weight sensor that detects the weight of each section. The weight of each section detected by the sensor 2 is, for example, the weight of the autonomous vehicle 4 in a certain section at a certain time, the weight of a moving obstacle in a certain section at a certain time, or the automatic weight in a certain section at a certain time. The weight of the traveling vehicle 4 and the weight of the moving obstacle.
 なお、実施の形態1では、センサ2が重量センサである構成について説明するが、センサ2は、カメラ、レーダ、又はソナー等のセンサであってもよい。例えば、センサ2がカメラである場合、センサ2は、移動障害物を撮影することにより、移動障害物情報として移動障害物の画像を取得する。例えば、センサ2がレーダ又はソナー等である場合、センサ2は、移動障害物を走査することにより、移動障害物情報として移動障害物の位置を検出する。 Although the configuration in which the sensor 2 is a weight sensor will be described in the first embodiment, the sensor 2 may be a sensor such as a camera, a radar, or a sonar. For example, when the sensor 2 is a camera, the sensor 2 acquires an image of a moving obstacle as moving obstacle information by photographing the moving obstacle. For example, when the sensor 2 is a radar, sonar, or the like, the sensor 2 detects the position of the moving obstacle as the moving obstacle information by scanning the moving obstacle.
 サーバ1の記憶装置10は、走行路における自動走行車4の走行計画に関する走行計画情報を記憶している。記憶装置10は、走行計画情報を自動走行制御装置11に出力する。より詳細には、実施の形態1では、記憶装置10が記憶している走行計画情報は、走行路における自動走行車4の走行計画、及び自動走行車4の走行計画に基づいた区画毎の想定重量を含む。当該区画毎の想定重量は、例えば、走行計画に基づいて、ある時刻に、ある区画において自動走行車4が存在することにより想定される当該区画の重量、又は、走行計画に基づいて、ある時刻に、ある区画において自動走行車4が存在しないことにより想定される当該区画の重量(例えば、ゼロ)等である。より具体的には、走行計画及び区画毎の想定重量を含む走行計画情報は、例えば、自動走行車4の走行開始地点から目的地までの走行経路及び走行時刻と、自動走行車4の重量及び自動走行車4が運搬する荷物の重量等の重量データとが対応付けられた情報である。 The storage device 10 of the server 1 stores the travel plan information regarding the travel plan of the automatic traveling vehicle 4 on the travel road. The storage device 10 outputs the travel plan information to the automatic travel control device 11. More specifically, in the first embodiment, the travel plan information stored in the storage device 10 is assumed for each section based on the travel plan of the automatic traveling vehicle 4 on the traveling road and the traveling plan of the automatic traveling vehicle 4. Including weight. The estimated weight for each section is, for example, the weight of the section assumed by the presence of the autonomous vehicle 4 in a certain section at a certain time based on the travel plan, or the estimated time based on the travel plan. In addition, the weight (for example, zero) of the section assumed by the absence of the autonomous vehicle 4 in the section. More specifically, the travel plan information including the travel plan and the assumed weight for each section includes, for example, the travel route and the travel time from the travel start point to the destination of the autonomous vehicle 4, the weight of the autonomous vehicle 4, and the travel time. This is information associated with weight data such as the weight of luggage carried by the autonomous vehicle 4.
 サーバ1の通信装置12は、センサ2が検出した移動障害物情報と、センサ2が移動障害物情報を検出した時刻とを受信する。通信装置12の例として、Ethernet(登録商標)、又はUSB(Universal Serial Bus)の端子等が挙げられる。 The communication device 12 of the server 1 receives the moving obstacle information detected by the sensor 2 and the time when the sensor 2 detects the moving obstacle information. Examples of the communication device 12 include Ethernet (registered trademark), USB (Universal Serial Bus) terminals, and the like.
 サーバ1の自動走行制御装置11は、表示装置3によって表示されることにより走行路における自動走行車4の自動走行を指示する走行指示情報を、走行路における自動走行車4の走行計画に関する走行計画情報に基づいて決定する。実施の形態1では、自動走行制御装置11は、記憶装置10が記憶している走行計画情報に基づいて、走行指示情報を決定する。 The automatic driving control device 11 of the server 1 displays the traveling instruction information displayed by the display device 3 to instruct the automatic traveling of the automatic traveling vehicle 4 on the traveling road, and the traveling plan relating to the traveling plan of the automatic traveling vehicle 4 on the traveling road. Make an informed decision. In the first embodiment, the automatic travel control device 11 determines the travel instruction information based on the travel plan information stored in the storage device 10.
 自動走行制御装置11の構成についてより詳細には、図2が示すように、自動走行制御装置11は、走行計画情報取得部20、移動障害物情報取得部21、移動障害物特定部22、衝突確率算出部23、警告情報決定部24、及び走行指示情報決定部25を備えている。移動障害物特定部22は、移動障害物位置特定部30、移動障害物移動方向特定部31及び移動障害物移動速度特定部32を備えている。 More specifically about the configuration of the automatic driving control device 11, as shown in FIG. 2, the automatic driving control device 11 includes a traveling plan information acquisition unit 20, a moving obstacle information acquisition unit 21, a moving obstacle identification unit 22, and a collision. It includes a probability calculation unit 23, a warning information determination unit 24, and a driving instruction information determination unit 25. The moving obstacle specifying unit 22 includes a moving obstacle position specifying unit 30, a moving obstacle moving direction specifying unit 31, and a moving obstacle moving speed specifying unit 32.
 走行計画情報取得部20は、走行路における自動走行車4の走行計画に関する走行計画情報を取得する。走行計画情報取得部20は、取得した走行計画情報を、移動障害物位置特定部30、衝突確率算出部23及び走行指示情報決定部25にそれぞれ出力する。 The travel plan information acquisition unit 20 acquires travel plan information related to the travel plan of the automatic traveling vehicle 4 on the travel road. The travel plan information acquisition unit 20 outputs the acquired travel plan information to the movement obstacle position specifying unit 30, the collision probability calculation unit 23, and the travel instruction information determination unit 25, respectively.
 より詳細には、実施の形態1では、走行計画情報取得部20は、記憶装置10が記憶している走行計画情報を取得する。上述の通り、実施の形態1では、走行計画情報は、走行路における自動走行車4の走行計画、及び自動走行車4の走行計画に基づいた区画毎の想定重量を含む。走行計画情報が区画毎の想定重量を含まない場合、走行計画情報取得部20は、取得した走行計画情報が示す自動走行車4の走行計画と、自動走行車4の総重量とに基づいて、区画毎の想定重量を算出してもよい。 More specifically, in the first embodiment, the travel plan information acquisition unit 20 acquires the travel plan information stored in the storage device 10. As described above, in the first embodiment, the travel plan information includes the travel plan of the automatic traveling vehicle 4 on the traveling road and the assumed weight for each section based on the traveling plan of the automatic traveling vehicle 4. When the travel plan information does not include the assumed weight for each section, the travel plan information acquisition unit 20 is based on the travel plan of the automatic traveling vehicle 4 indicated by the acquired travel plan information and the total weight of the automatic traveling vehicle 4. The estimated weight for each section may be calculated.
 なお、実施の形態1では、走行計画情報取得部20が走行計画情報を記憶装置10から取得する構成について説明するが、走行計画情報取得部20が走行計画情報を取得する取得先は特に限定されない。 In the first embodiment, the configuration in which the travel plan information acquisition unit 20 acquires the travel plan information from the storage device 10 will be described, but the acquisition destination from which the travel plan information acquisition unit 20 acquires the travel plan information is not particularly limited. ..
 移動障害物情報取得部21は、走行路において移動する移動障害物に関する移動障害物情報を取得する。移動障害物情報取得部21は、取得した移動障害物情報を、移動障害物位置特定部30に出力するか、又は記憶装置10に記録する。 The moving obstacle information acquisition unit 21 acquires the moving obstacle information regarding the moving obstacle moving on the traveling path. The moving obstacle information acquisition unit 21 outputs the acquired moving obstacle information to the moving obstacle position specifying unit 30 or records it in the storage device 10.
 より詳細には、実施の形態1では、移動障害物情報取得部21は、センサ2が検出した移動障害物情報を取得する。さらに詳細には、実施の形態1では、移動障害物情報取得部21は、通信装置12が受信した移動障害物情報を取得する。また、実施の形態1では、移動障害物情報取得部21は、センサ2の位置及びセンサ2が移動障害物情報を検出した時刻等のステータス情報をさらに取得する。移動障害物情報取得部21は、取得した移動障害物情報及びステータス情報を移動障害物位置特定部30に出力するか、又は記憶装置10に記録する。記憶装置10は、記憶している移動障害物情報及びステータス情報を移動障害物位置特定部30、移動障害物移動方向特定部31及び移動障害物移動速度特定部32に出力する。なお、移動障害物情報取得部21は、移動障害物情報及びステータス情報を、通信装置12を介してサーバ1以外の外部装置に記録してもよい。 More specifically, in the first embodiment, the moving obstacle information acquisition unit 21 acquires the moving obstacle information detected by the sensor 2. More specifically, in the first embodiment, the moving obstacle information acquisition unit 21 acquires the moving obstacle information received by the communication device 12. Further, in the first embodiment, the moving obstacle information acquisition unit 21 further acquires status information such as the position of the sensor 2 and the time when the sensor 2 detects the moving obstacle information. The moving obstacle information acquisition unit 21 outputs the acquired moving obstacle information and status information to the moving obstacle position specifying unit 30 or records them in the storage device 10. The storage device 10 outputs the stored moving obstacle information and status information to the moving obstacle position specifying unit 30, the moving obstacle moving direction specifying unit 31, and the moving obstacle moving speed specifying unit 32. The moving obstacle information acquisition unit 21 may record the moving obstacle information and the status information in an external device other than the server 1 via the communication device 12.
 移動障害物情報取得部21が取得する移動障害物情報についてより詳細には、実施の形態1では、移動障害物情報取得部21は、移動障害物情報として、センサ2が検出した区画毎の重量を取得する。なお、実施の形態1では、移動障害物情報取得部21が移動障害物情報として区画毎の重量を取得する構成について説明するが、例えば、センサ2がカメラである場合、移動障害物情報取得部21は、移動障害物情報として、移動障害物の画像を取得してもよい。または、例えば、センサ2がレーダ又はソナー等である場合、移動障害物情報取得部21は、移動障害物の位置を取得してもよい。その場合、移動障害物情報取得部21は、取得した移動障害物の位置を、移動障害物移動方向特定部31、移動障害物移動速度特定部32及び衝突確率算出部23にそれぞれ出力する。 More specifically, regarding the moving obstacle information acquired by the moving obstacle information acquisition unit 21, in the first embodiment, the moving obstacle information acquisition unit 21 uses the weight of each section detected by the sensor 2 as the moving obstacle information. To get. In the first embodiment, the configuration in which the moving obstacle information acquisition unit 21 acquires the weight of each section as the moving obstacle information will be described. For example, when the sensor 2 is a camera, the moving obstacle information acquisition unit 21 will be described. 21 may acquire an image of a moving obstacle as moving obstacle information. Alternatively, for example, when the sensor 2 is a radar, sonar, or the like, the moving obstacle information acquisition unit 21 may acquire the position of the moving obstacle. In that case, the moving obstacle information acquisition unit 21 outputs the acquired position of the moving obstacle to the moving obstacle moving direction specifying unit 31, the moving obstacle moving speed specifying unit 32, and the collision probability calculation unit 23, respectively.
 移動障害物特定部22は、移動障害物情報取得部21が取得した移動障害物情報に基づいて、移動障害物に関する情報を特定する。
 移動障害物特定部22の移動障害物位置特定部30は、移動障害物情報取得部21によって呼び出される。移動障害物位置特定部30は、移動障害物情報取得部21が取得した移動障害物情報に基づいて、移動障害物の位置を特定する。より詳細には、移動障害物位置特定部30は、移動障害物情報取得部21が取得した時刻毎の移動障害物情報に基づいて、時刻毎の移動障害物の位置を特定する。移動障害物位置特定部30は、特定した時刻毎の移動障害物の位置を、移動障害物移動方向特定部31、移動障害物移動速度特定部32及び衝突確率算出部23にそれぞれ出力するか、又は記憶装置10に記録する。
The moving obstacle identification unit 22 identifies information about the moving obstacle based on the moving obstacle information acquired by the moving obstacle information acquisition unit 21.
The moving obstacle position specifying unit 30 of the moving obstacle specifying unit 22 is called by the moving obstacle information acquisition unit 21. The moving obstacle position specifying unit 30 identifies the position of the moving obstacle based on the moving obstacle information acquired by the moving obstacle information acquisition unit 21. More specifically, the moving obstacle position specifying unit 30 identifies the position of the moving obstacle for each time based on the moving obstacle information for each time acquired by the moving obstacle information acquisition unit 21. The moving obstacle position specifying unit 30 outputs the position of the moving obstacle at the specified time to the moving obstacle moving direction specifying unit 31, the moving obstacle moving speed specifying unit 32, and the collision probability calculation unit 23, respectively. Or record in the storage device 10.
 移動障害物位置特定部30の構成についてより詳細には、実施の形態1では、移動障害物位置特定部30は、移動障害物情報取得部21が取得した移動障害物情報が示す区画毎の重量と、走行計画情報が示す区画毎の想定重量とを比較することにより移動障害物が存在する区画を特定することによって、移動障害物の位置を特定する。なお、実施の形態1では、その際、移動障害物位置特定部30は、移動障害物の位置として、移動障害物情報取得部21が取得した上述のステータス情報が示すセンサ2の位置を用いる。なお、実施の形態1では、移動障害物位置特定部30が区画毎の重量と区画毎の想定重量とを比較することにより移動障害物の位置を特定する構成を説明するが、例えば、センサ2がカメラである場合、移動障害物位置特定部30は、移動障害物情報取得部21が取得した画像に基づいて、移動障害物の位置を特定してもよい。 More specifically about the configuration of the moving obstacle position specifying unit 30, in the first embodiment, the moving obstacle position specifying unit 30 is the weight of each section indicated by the moving obstacle information acquired by the moving obstacle information acquisition unit 21. And, by comparing with the assumed weight for each section indicated by the travel plan information, the section in which the moving obstacle exists is specified, and the position of the moving obstacle is specified. In the first embodiment, at that time, the moving obstacle position specifying unit 30 uses the position of the sensor 2 indicated by the above-mentioned status information acquired by the moving obstacle information acquisition unit 21 as the position of the moving obstacle. In the first embodiment, the configuration in which the moving obstacle position specifying unit 30 identifies the position of the moving obstacle by comparing the weight of each section with the assumed weight of each section will be described. For example, the sensor 2 will be described. When is a camera, the moving obstacle position specifying unit 30 may specify the position of the moving obstacle based on the image acquired by the moving obstacle information acquisition unit 21.
 移動障害物特定部22の移動障害物移動方向特定部31は、移動障害物位置特定部30が特定した移動障害物の位置に基づいて、移動障害物の移動方向を特定する。より詳細には、移動障害物移動方向特定部31は、記憶装置10に記憶された時刻毎の移動障害物の位置に基づいて、移動障害物の移動方向を特定する。なお、実施の形態1では、その際、移動障害物移動方向特定部31は、移動障害物情報取得部21が取得したステータス情報が示す上述の時刻を用いる。移動障害物移動方向特定部31は、特定した移動障害物の移動方向を、衝突確率算出部23に出力するか、又は記憶装置10に記録する。 The moving obstacle moving direction specifying unit 31 of the moving obstacle specifying unit 22 specifies the moving direction of the moving obstacle based on the position of the moving obstacle specified by the moving obstacle position specifying unit 30. More specifically, the moving obstacle moving direction specifying unit 31 identifies the moving direction of the moving obstacle based on the position of the moving obstacle stored in the storage device 10 for each time. In the first embodiment, at that time, the moving obstacle moving direction specifying unit 31 uses the above-mentioned time indicated by the status information acquired by the moving obstacle information acquisition unit 21. The moving obstacle moving direction specifying unit 31 outputs the moving direction of the specified moving obstacle to the collision probability calculation unit 23 or records it in the storage device 10.
 移動障害物特定部22の移動障害物移動速度特定部32は、移動障害物位置特定部30が特定した移動障害物の位置に基づいて、移動障害物の移動速度を特定する。より詳細には、移動障害物移動速度特定部32は、記憶装置10に記憶された時刻毎の移動障害物の位置に基づいて、移動障害物の移動速度を特定する。なお、実施の形態1では、その際、移動障害物移動速度特定部32は、移動障害物情報取得部21が取得したステータス情報が示す上述の時刻を用いる。移動障害物移動速度特定部32は、特定した移動障害物の移動速度を、衝突確率算出部23に出力するか、又は記憶装置10に記録する。 The moving obstacle moving speed specifying unit 32 of the moving obstacle specifying unit 22 specifies the moving speed of the moving obstacle based on the position of the moving obstacle specified by the moving obstacle position specifying unit 30. More specifically, the moving obstacle moving speed specifying unit 32 identifies the moving speed of the moving obstacle based on the position of the moving obstacle stored in the storage device 10 for each time. In the first embodiment, at that time, the moving obstacle moving speed specifying unit 32 uses the above-mentioned time indicated by the status information acquired by the moving obstacle information acquisition unit 21. The moving obstacle moving speed specifying unit 32 outputs the moving speed of the specified moving obstacle to the collision probability calculation unit 23 or records it in the storage device 10.
 実施の形態1では、衝突確率算出部23は、移動障害物位置特定部30、移動障害物移動方向特定部31、又は移動障害物移動速度特定部32によって呼び出される。衝突確率算出部23は、走行計画情報、及び移動障害物情報取得部21が取得した移動障害物情報に基づいて、自動走行車4と移動障害物との衝突確率を算出する。衝突確率算出部23は、算出した衝突確率を警告情報決定部24に出力するか、又は記憶装置10に記録する。 In the first embodiment, the collision probability calculation unit 23 is called by the moving obstacle position specifying unit 30, the moving obstacle moving direction specifying unit 31, or the moving obstacle moving speed specifying unit 32. The collision probability calculation unit 23 calculates the collision probability between the autonomous vehicle 4 and the moving obstacle based on the traveling plan information and the moving obstacle information acquired by the moving obstacle information acquisition unit 21. The collision probability calculation unit 23 outputs the calculated collision probability to the warning information determination unit 24 or records it in the storage device 10.
 より詳細には、実施の形態1では、衝突確率算出部23は、走行計画情報が示す自動走行車4の走行計画と、移動障害物位置特定部30が特定した移動障害物の位置と、移動障害物移動方向特定部31が特定した移動障害物の移動方向と、移動障害物移動速度特定部32が特定した移動障害物の移動速度と、に基づいて、自動走行車4と移動障害物との衝突確率を算出する。なお、実施の形態1では、ここにおける走行計画情報は、走行計画情報取得部20が記憶装置10から取得した走行計画情報である。 More specifically, in the first embodiment, the collision probability calculation unit 23 moves the traveling plan of the automatic traveling vehicle 4 indicated by the traveling plan information, the position of the moving obstacle specified by the moving obstacle position specifying unit 30, and the movement. Based on the moving direction of the moving obstacle specified by the obstacle moving direction specifying unit 31 and the moving speed of the moving obstacle specified by the moving obstacle moving speed specifying unit 32, the automatic traveling vehicle 4 and the moving obstacle Calculate the collision probability of. In the first embodiment, the travel plan information here is travel plan information acquired from the storage device 10 by the travel plan information acquisition unit 20.
 実施の形態1では、警告情報決定部24は、衝突確率算出部23によって呼び出される。警告情報決定部24は、表示装置3によって表示されることにより自動走行車4と移動障害物との衝突を移動障害物に対して警告する警告情報を、走行計画情報、及び移動障害物情報取得部21が取得した移動障害物情報に基づいて決定する。警告情報決定部24は、決定した警告情報を通信装置12に出力する。 In the first embodiment, the warning information determination unit 24 is called by the collision probability calculation unit 23. The warning information determination unit 24 acquires warning information that warns the moving obstacle of the collision between the automatic traveling vehicle 4 and the moving obstacle by being displayed by the display device 3, the traveling plan information, and the moving obstacle information. The decision is made based on the moving obstacle information acquired by the unit 21. The warning information determination unit 24 outputs the determined warning information to the communication device 12.
 警告情報決定部24の構成についてより詳細には、実施の形態1では、警告情報決定部24は、走行計画情報が示す自動走行車4の走行計画と、移動障害物位置特定部30が移動障害物情報に基づいて特定した移動障害物の位置と、に基づいて、警告情報を決定する。さらに詳細には、実施の形態1では、警告情報決定部24は、移動障害物移動方向特定部31が特定した移動障害物の移動方向にさらに基づいて、警告情報を決定する。さらに詳細には、実施の形態1では、警告情報決定部24は、移動障害物移動速度特定部32が特定した移動障害物の移動速度にさらに基づいて、警告情報を決定する。 More specifically about the configuration of the warning information determination unit 24, in the first embodiment, the warning information determination unit 24 has a travel plan of the automatic traveling vehicle 4 indicated by the travel plan information, and the moving obstacle position specifying unit 30 has a movement obstacle. The warning information is determined based on the position of the moving obstacle identified based on the object information. More specifically, in the first embodiment, the warning information determination unit 24 determines the warning information based on the movement direction of the moving obstacle specified by the moving obstacle moving direction specifying unit 31. More specifically, in the first embodiment, the warning information determination unit 24 determines the warning information based on the movement speed of the moving obstacle specified by the moving obstacle moving speed specifying unit 32.
 さらに詳細には、実施の形態1では、警告情報決定部24は、衝突確率算出部23が自動走行車4の走行計画、並びに移動障害物の位置、移動方向及び移動速度に基づいて算出した衝突確率に基づいて、警告情報を決定する。例えば、警告情報決定部24は、衝突確率が所定の閾値以上であるか否かを判定し、衝突確率が所定の閾値以上である場合、警告情報を決定する。例えば、複数の警告情報が予め用意されており、警告情報決定部24は、衝突確率に基づいて、当該複数の警告情報のうちから1つの警告情報を選択することにより表示用の警告情報を決定する。 More specifically, in the first embodiment, the warning information determination unit 24 has a collision probability calculation unit 23 calculated based on the travel plan of the automatic traveling vehicle 4 and the position, moving direction, and moving speed of the moving obstacle. Determine warning information based on probability. For example, the warning information determination unit 24 determines whether or not the collision probability is equal to or higher than a predetermined threshold value, and if the collision probability is equal to or higher than a predetermined threshold value, determines the warning information. For example, a plurality of warning information is prepared in advance, and the warning information determination unit 24 determines the warning information for display by selecting one warning information from the plurality of warning information based on the collision probability. do.
 走行指示情報決定部25は、表示装置3によって表示されることにより走行路における自動走行車4の自動走行を指示する走行指示情報を、走行路における自動走行車4の走行計画に関する走行計画情報に基づいて決定する。走行指示情報決定部25は、決定した走行指示情報を通信装置12に出力する。例えば、複数の走行指示情報が予め用意されており、走行指示情報決定部25は、走行計画情報に基づいて、当該複数の走行指示情報のうちから1つの走行計画情報を選択することにより表示用の走行指示情報を決定する。 The travel instruction information determination unit 25 converts the travel instruction information indicating the automatic driving of the automatic traveling vehicle 4 on the traveling road into the traveling plan information regarding the traveling plan of the automatic traveling vehicle 4 on the traveling road by being displayed by the display device 3. Determine based on. The travel instruction information determination unit 25 outputs the determined travel instruction information to the communication device 12. For example, a plurality of travel instruction information is prepared in advance, and the travel instruction information determination unit 25 displays by selecting one travel plan information from the plurality of travel instruction information based on the travel plan information. Determine the driving instruction information of.
 通信装置12は、警告情報決定部24が決定した警告情報、及び走行指示情報決定部25が決定した走行指示情報をそれぞれ表示装置3に送信する。
 表示装置3は、警告情報決定部24が決定した警告情報、及び走行指示情報決定部25が決定した走行指示情報をそれぞれ表示する。より詳細には、実施の形態1では、表示装置3は、通信装置12が送信した警告情報及び走行指示情報をそれぞれ表示する。例えば、表示装置3は、図示しない通信装置を備え、当該通信装置が警告情報及び走行指示情報を通信装置12から受信する。例えば、表示装置3は、液晶モニタ等の映像出力装置であり、当該映像出力装置は、警告情報、及び走行指示情報をそれぞれ画像で表示する。表示装置3は、音声を出力する音声出力部をさらに備え、警告情報を表示する際に、当該音声出力部が移動障害物に警告する音声を出力してもよい。
The communication device 12 transmits the warning information determined by the warning information determination unit 24 and the travel instruction information determined by the travel instruction information determination unit 25 to the display device 3, respectively.
The display device 3 displays the warning information determined by the warning information determination unit 24 and the travel instruction information determined by the travel instruction information determination unit 25, respectively. More specifically, in the first embodiment, the display device 3 displays the warning information and the travel instruction information transmitted by the communication device 12, respectively. For example, the display device 3 includes a communication device (not shown), and the communication device receives warning information and travel instruction information from the communication device 12. For example, the display device 3 is a video output device such as a liquid crystal monitor, and the video output device displays warning information and travel instruction information as images, respectively. The display device 3 may further include a voice output unit that outputs voice, and when displaying warning information, the voice output unit may output voice that warns a moving obstacle.
 自動走行車4は、表示装置3が表示した走行指示情報に基づいて、走行路において自動走行を行う。自動走行車4の例として、荷物を搬送する自動搬送車が挙げられる。自動走行車4は、例えば、カメラ、LiDAR(Light Detection and Ranging)、レーダ、ソナー、又は測位装置等のセンサと、ステアリング、ブレーキ又はアクセル等の駆動系と、プロセッサ、記憶装置、又は通信インターフェイス等といったハードウェアを備えている。自動走行車4は、例えば、カメラが表示装置3を撮影することにより得られた画像が示す走行指示情報に基づいて、駆動系を制御することにより走行路において自動走行を行う。 The automatic traveling vehicle 4 automatically travels on the traveling road based on the traveling instruction information displayed by the display device 3. An example of the automatic traveling vehicle 4 is an automatic guided vehicle that transports luggage. The autonomous vehicle 4 includes, for example, a sensor such as a camera, LiDAR (Light Detection and Ringing), radar, sonar, or a positioning device, a drive system such as a steering wheel, a brake, or an accelerator, a processor, a storage device, a communication interface, or the like. It is equipped with such hardware. For example, the automatic traveling vehicle 4 automatically travels on a traveling road by controlling a drive system based on traveling instruction information indicated by an image obtained by taking a picture of a display device 3 by a camera.
 以下で、実施の形態1に係る自動走行制御装置11の動作について図面を参照して説明する。図3は、実施の形態1に係る自動走行制御装置11による警告情報決定方法を示すフローチャートである。なお、自動走行制御装置11が以下の各ステップを実行する前に、センサ2は、区画毎の重量を検出したものとする。 Hereinafter, the operation of the automatic driving control device 11 according to the first embodiment will be described with reference to the drawings. FIG. 3 is a flowchart showing a warning information determination method by the automatic driving control device 11 according to the first embodiment. It is assumed that the sensor 2 detects the weight of each section before the automatic traveling control device 11 executes each of the following steps.
 図3が示すように、走行計画情報取得部20は、記憶装置10から、走行路における自動走行車4の走行計画に関する走行計画情報を取得する(ステップST1)。上述の通り、実施の形態1では、走行計画情報は、走行路における自動走行車4の走行計画、及び自動走行車4の走行計画に基づいた区画毎の想定重量を含む。走行計画情報取得部20は、取得した走行計画情報を、記憶装置10に記録する。記憶装置10は、記憶した走行計画情報を移動障害物位置特定部30、衝突確率算出部23及び走行指示情報決定部25にそれぞれ出力する。 As shown in FIG. 3, the travel plan information acquisition unit 20 acquires travel plan information regarding the travel plan of the automatic traveling vehicle 4 on the travel path from the storage device 10 (step ST1). As described above, in the first embodiment, the travel plan information includes the travel plan of the automatic traveling vehicle 4 on the traveling road and the assumed weight for each section based on the traveling plan of the automatic traveling vehicle 4. The travel plan information acquisition unit 20 records the acquired travel plan information in the storage device 10. The storage device 10 outputs the stored travel plan information to the movement obstacle position specifying unit 30, the collision probability calculation unit 23, and the travel instruction information determination unit 25, respectively.
 次に、移動障害物情報取得部21は、センサ2から、上述の区画毎の重量及びステータス情報を取得する(ステップST2)。移動障害物情報取得部21は、取得した区画毎の重量及びステータス情報を記憶装置10に記録する。記憶装置10は、記憶した区画毎の重量及びステータス情報を移動障害物位置特定部30、移動障害物移動方向特定部31及び移動障害物移動速度特定部32にそれぞれ出力する。 Next, the moving obstacle information acquisition unit 21 acquires the weight and status information for each of the above-mentioned sections from the sensor 2 (step ST2). The moving obstacle information acquisition unit 21 records the acquired weight and status information for each section in the storage device 10. The storage device 10 outputs the weight and status information for each stored section to the moving obstacle position specifying unit 30, the moving obstacle moving direction specifying unit 31, and the moving obstacle moving speed specifying unit 32, respectively.
 次に、移動障害物位置特定部30は、記憶装置10が記憶した移動障害物情報が示す区画毎の重量と、記憶装置10が記憶した走行計画情報が示す区画毎の想定重量とを比較することにより移動障害物が存在する区画を特定することによって、移動障害物の位置を特定する(ステップST3)。なお、その際、移動障害物位置特定部30は、記憶装置10が記憶したステータス情報をさらに用いて時刻毎の移動障害物の位置を特定する。移動障害物位置特定部30は、特定した時刻毎の移動障害物の位置を記憶装置10に記録する。記憶装置10は、記憶した時刻毎の移動障害物の位置を移動障害物移動方向特定部31、移動障害物移動速度特定部32及び衝突確率算出部23にそれぞれ出力する。 Next, the moving obstacle position specifying unit 30 compares the weight of each section indicated by the moving obstacle information stored in the storage device 10 with the assumed weight of each section indicated by the travel plan information stored in the storage device 10. By specifying the section where the moving obstacle exists, the position of the moving obstacle is specified (step ST3). At that time, the moving obstacle position specifying unit 30 further uses the status information stored in the storage device 10 to specify the position of the moving obstacle for each time. The moving obstacle position specifying unit 30 records the position of the moving obstacle at the specified time in the storage device 10. The storage device 10 outputs the position of the moving obstacle for each stored time to the moving obstacle moving direction specifying unit 31, the moving obstacle moving speed specifying unit 32, and the collision probability calculation unit 23, respectively.
 次に、移動障害物移動方向特定部31は、記憶装置10が記憶した時刻毎の移動障害物の位置に基づいて、移動障害物の移動方向を特定する(ステップST4)。移動障害物移動方向特定部31は、特定した移動障害物の移動方向を記憶装置10に記録する。記憶装置10は、記憶した移動障害物の移動方向を衝突確率算出部23に出力する。 Next, the moving obstacle moving direction specifying unit 31 specifies the moving direction of the moving obstacle based on the position of the moving obstacle stored in the storage device 10 for each time (step ST4). The moving obstacle moving direction specifying unit 31 records the moving direction of the specified moving obstacle in the storage device 10. The storage device 10 outputs the moving direction of the stored moving obstacle to the collision probability calculation unit 23.
 次に、移動障害物移動速度特定部32は、記憶装置10が記憶した時刻毎の移動障害物の位置に基づいて、移動障害物の移動速度を特定する(ステップST5)。移動障害物移動速度特定部32は、特定した移動障害物の移動速度を記憶装置10に記録する。記憶装置10は、記憶した移動障害物の移動速度を衝突確率算出部23に出力する。 Next, the moving obstacle moving speed specifying unit 32 specifies the moving speed of the moving obstacle based on the position of the moving obstacle for each time stored in the storage device 10 (step ST5). The moving obstacle moving speed specifying unit 32 records the moving speed of the specified moving obstacle in the storage device 10. The storage device 10 outputs the moving speed of the stored moving obstacle to the collision probability calculation unit 23.
 次に、衝突確率算出部23は、記憶装置10が記憶した走行計画情報が示す自動走行車4の走行計画と、記憶装置10が記憶した移動障害物の位置、移動障害物の移動方向及び移動障害物の移動速度と、に基づいて、自動走行車4と移動障害物との衝突確率を算出する(ステップST6)。衝突確率算出部23は、算出した衝突確率を記憶装置10に記録する。 Next, the collision probability calculation unit 23 describes the travel plan of the automatic traveling vehicle 4 indicated by the travel plan information stored in the storage device 10, the position of the moving obstacle stored in the storage device 10, the moving direction and movement of the moving obstacle. Based on the moving speed of the obstacle, the collision probability between the autonomous vehicle 4 and the moving obstacle is calculated (step ST6). The collision probability calculation unit 23 records the calculated collision probability in the storage device 10.
 次に、走行指示情報決定部25は、表示装置3によって表示されることにより走行路における自動走行車4の自動走行を指示する走行指示情報を、記憶装置10が記憶した走行計画情報に基づいて決定する(ステップST7)。走行指示情報決定部25は、決定した走行計画情報を、通信装置12を介して表示装置3に出力する。 Next, the travel instruction information determination unit 25 receives the travel instruction information displayed by the display device 3 to instruct the automatic travel of the automatic traveling vehicle 4 on the travel path based on the travel plan information stored in the storage device 10. Determine (step ST7). The travel instruction information determination unit 25 outputs the determined travel plan information to the display device 3 via the communication device 12.
 次に、警告情報決定部24は、表示装置3によって表示されることにより自動走行車4と移動障害物との衝突を移動障害物に対して警告する警告情報を、記憶装置10が記憶した衝突確率に基づいて決定する(ステップST8)。警告情報決定部24は、決定した警告情報を、通信装置12を介して表示装置3に出力する。
 表示装置3は、走行指示情報決定部25がステップST7で決定した走行計画情報、及び警告情報決定部24がステップST8で決定した警告情報をそれぞれ表示する。
Next, the warning information determination unit 24 stores the warning information in which the storage device 10 stores the warning information that warns the moving obstacle of the collision between the autonomous vehicle 4 and the moving obstacle by being displayed by the display device 3. Determined based on probability (step ST8). The warning information determination unit 24 outputs the determined warning information to the display device 3 via the communication device 12.
The display device 3 displays the travel plan information determined by the travel instruction information determination unit 25 in step ST7 and the warning information determined by the warning information determination unit 24 in step ST8, respectively.
 以下で、実施の形態1に係る自動走行制御システム100を運用した具体例について図面を参照して説明する。図4は、実施の形態1に係る自動走行制御システム100を運用した具体例の構成を示す図である。
 図4が示すように、自動走行車4の走行路である作業領域Aは、区画A1、区画A2、区画A3及び区画A4の4つの区画から構成されている。作業領域Aの例として、工場又は倉庫のフロアが挙げられる。区画A1、区画A2、区画A3及び区画A4は、それぞれ、作業領域Aを所定の大きさに分割した領域であり、各区画にはセンサ2と表示装置3が設置されているものとする(図4では区画A1にのみ図示)。
Hereinafter, a specific example of operating the automatic driving control system 100 according to the first embodiment will be described with reference to the drawings. FIG. 4 is a diagram showing a configuration of a specific example in which the automatic driving control system 100 according to the first embodiment is operated.
As shown in FIG. 4, the work area A, which is the travel path of the autonomous vehicle 4, is composed of four sections, a section A1, a section A2, a section A3, and a section A4. An example of work area A is the floor of a factory or warehouse. It is assumed that the compartments A1, the compartments A2, the compartments A3, and the compartments A4 are regions in which the work area A is divided into predetermined sizes, and the sensor 2 and the display device 3 are installed in each compartment (Fig.). In 4, only the section A1 is shown).
 当該具体例では、センサ2は、設置された区画内に存在する人間の重量又は自動走行車4の総重量のうちの少なくとも一方を検出する重量センサである。なお、当該具体例では、自動走行車4は、自動搬送車である。 In the specific example, the sensor 2 is a weight sensor that detects at least one of the weight of a human being existing in the installed section or the total weight of the autonomous vehicle 4. In the specific example, the automatic traveling vehicle 4 is an automatic guided vehicle.
 当該具体例では、表示装置3は、設置された区画内において、作業領域A内を自由に移動する人間Bに対して上述の警告情報を表示し、自動走行車4に対して上述の走行指示情報を表示する。当該具体例では、表示装置3は、区画A3に存在する人間Bに対して警告情報を表示する。 In the specific example, the display device 3 displays the above-mentioned warning information to the person B who freely moves in the work area A in the installed section, and the above-mentioned traveling instruction to the automatic traveling vehicle 4. Display information. In the specific example, the display device 3 displays warning information to the person B existing in the section A3.
 自動走行車4は、表示装置3が表示する走行指示情報に従って、現在いる区画から当該区画の前後左右に存在する他の区画の何れか1つの区画に向かって走行する。当該具体例では、自動走行車4は、表示装置3が表示する走行指示情報に従って、現在いる区画A3から区画A1又は区画A4に向かって走行する。 The automatic traveling vehicle 4 travels from the current section toward any one of the other sections existing on the front, back, left, and right of the section according to the running instruction information displayed by the display device 3. In the specific example, the automatic traveling vehicle 4 travels from the current section A3 toward the section A1 or the section A4 according to the running instruction information displayed by the display device 3.
 なお、当該具体例では、自動走行車4の走行路である作業領域Aが4つの区画から構成されている例を説明したが、自動走行車4の走行路は、それ以外の分割数で分割されていてもよい。また、当該具体例では、作業領域A内に自動走行車4が1両だけ存在し、人間Bが1人だけ存在する例を示したが、自動走行車4の走行路に、自動走行車4及び人間がそれぞれ複数存在していてもよい。 In the specific example, the example in which the work area A, which is the travel path of the automatic traveling vehicle 4, is composed of four sections has been described, but the traveling path of the automatic traveling vehicle 4 is divided by the number of divisions other than that. It may have been done. Further, in the specific example, an example is shown in which only one automatic traveling vehicle 4 exists in the work area A and only one human B exists, but the automatic traveling vehicle 4 is on the traveling path of the automatic traveling vehicle 4. And there may be more than one human being.
 以下で、実施の形態1に係る自動走行制御システム100の表示装置3が表示する走行指示情報及び警告情報の具体例について図面を参照して説明する。図5は、実施の形態1に係る自動走行制御システム100の表示装置3が表示する走行指示情報及び警告情報の具体例を示す図である。 Hereinafter, specific examples of the travel instruction information and the warning information displayed by the display device 3 of the automatic travel control system 100 according to the first embodiment will be described with reference to the drawings. FIG. 5 is a diagram showing specific examples of travel instruction information and warning information displayed by the display device 3 of the automatic travel control system 100 according to the first embodiment.
 図5において、走行指示情報Cは、自動走行車4に直進を指示する走行指示情報である。走行指示情報Dは、自動走行車4に右折を指示する走行指示情報である。走行指示情報Eは、自動走行車4に左折を指示する走行指示情報である。走行指示情報Fは、自動走行車4に停止を指示する走行指示情報である。警告情報Gは、移動障害物に対して自動走行車4との衝突を警告する警告情報である。 In FIG. 5, the travel instruction information C is travel instruction information instructing the automatic traveling vehicle 4 to go straight. The travel instruction information D is travel instruction information for instructing the automatic traveling vehicle 4 to turn right. The travel instruction information E is travel instruction information for instructing the automatic traveling vehicle 4 to turn left. The travel instruction information F is travel instruction information for instructing the automatic traveling vehicle 4 to stop. The warning information G is warning information for warning a moving obstacle of a collision with the autonomous vehicle 4.
 当該具体例では、上述のステップST7において、走行指示情報決定部25は、走行計画情報に基づいて、走行指示情報C、走行指示情報D、走行指示情報E又は走行指示情報Fのうちから、表示用の走行指示情報を決定する。 In the specific example, in the above-mentioned step ST7, the travel instruction information determination unit 25 displays the travel instruction information C, the travel instruction information D, the travel instruction information E, or the travel instruction information F based on the travel plan information. Determine the driving instruction information for.
 また、当該具体例では、上述のステップST8において、警告情報決定部24は、衝突確率に基づいて、表示用の警告情報として、警告情報Gを決定する。
 表示装置3は、走行指示情報決定部25がステップST7で決定した走行計画情報、及び警告情報決定部24がステップST8で決定した警告情報をそれぞれ表示する。
Further, in the specific example, in the above-mentioned step ST8, the warning information determination unit 24 determines the warning information G as the warning information for display based on the collision probability.
The display device 3 displays the travel plan information determined by the travel instruction information determination unit 25 in step ST7 and the warning information determined by the warning information determination unit 24 in step ST8, respectively.
 以下で、実施の形態1に係る自動走行制御装置11による警告情報決定方法の具体例について図面を参照して説明する。図6は、実施の形態1に係る自動走行制御装置11による警告情報決定方法の具体例を説明するための図である。図6Aは、時刻tにおける作業領域Hの状況を示し、図6Bは、時刻t+1における作業領域Hの状況を示す。 Hereinafter, a specific example of the warning information determination method by the automatic driving control device 11 according to the first embodiment will be described with reference to the drawings. FIG. 6 is a diagram for explaining a specific example of the warning information determination method by the automatic driving control device 11 according to the first embodiment. FIG. 6A shows the situation of the work area H at the time t, and FIG. 6B shows the situation of the work area H at the time t + 1.
 図6が示すように、自動走行車4の走行路である作業領域Hは、区画H11、区画H12、区画H21及び区画H22の4つの区画から構成されている。区画H11、区画H12、区画H21及び区画H22は、それぞれ、作業領域Hを所定の大きさに分割した領域であり、図示しないが、各区画にはセンサ2及び表示装置3が設置されているものとする。 As shown in FIG. 6, the work area H, which is the travel path of the autonomous vehicle 4, is composed of four sections, a section H11, a section H12, a section H21, and a section H22. Each of the compartments H11, the compartment H12, the compartment H21, and the compartment H22 is a region in which the work area H is divided into predetermined sizes, and although not shown, the sensor 2 and the display device 3 are installed in each compartment. And.
 まず、上述のステップST1において、走行計画情報取得部20は、記憶装置10から、時刻tにおける区画H11の想定重量として、S11,tを取得し、時刻tにおける区画H12の想定重量として、S12,tを取得し、時刻tにおける区画H21の想定重量として、S21,tを取得し、時刻tにおける区画H22の想定重量として、S22,tを取得する。また、走行計画情報取得部20は、記憶装置10から、時刻t+1における区画H11の想定重量として、S11,t+1を取得し、時刻t+1における区画H12の想定重量として、S12,t+1を取得し、時刻t+1における区画H21の想定重量として、S21,t+1を取得し、時刻t+1における区画H22の想定重量として、S22,t+1を取得する。なお、図6の例では、自動走行車4は、時刻t及び時刻t+1において、区画H11に存在するため、S11,t及びS11,t+1は、それぞれ、他の想定重量より大きい。 First, in step ST1 described above, the travel plan information acquisition unit 20 acquires S11, t as the assumed weight of the section H11 at the time t from the storage device 10, and S as the assumed weight of the section H12 at the time t. 12, acquires the t, as envisaged by weight compartments H21 at time t, to get the S 21, t, as envisaged by weight compartments H22 at time t, to obtain the S 22, t. Further, the travel plan information acquisition unit 20 acquires S11, t + 1 as the assumed weight of the section H11 at the time t + 1 from the storage device 10, and acquires S12, t + 1 as the assumed weight of the section H12 at the time t + 1. as envisioned by weight compartments H21 at time t + 1, to get the S 21, t + 1, as contemplated by weight compartments H22 at time t + 1, to obtain the S 22, t + 1. In the example of FIG. 6, since the automatic traveling vehicle 4 exists in the section H11 at the time t and the time t + 1, S 11, t and S 11, t + 1 are each larger than the other assumed weights.
 次に、上述のステップST2において、移動障害物情報取得部21は、作業領域Hに設置されたセンサ2から、時刻tにおける区画H11の重量として、W11,tを取得し、時刻tにおける区画H12の重量として、W12,tを取得し、時刻tにおける区画H21の重量として、W21,tを取得し、時刻tにおける区画H22として、W22,tを取得する。また、移動障害物情報取得部21は、作業領域Hに設置されたセンサ2から、時刻t+1における区画H11の重量として、W11,t+1を取得し、時刻t+1における区画H12の重量として、W12,t+1を取得し、時刻t+1における区画H21の重量として、W21,t+1を取得し、時刻t+1における区画H22として、W22,t+1を取得する。また、移動障害物情報取得部21は、区画H11の位置情報(ステータス情報)として、x11を取得し、区画H12の位置情報として、x12を取得し、区画H21の位置情報として、x21を取得し、区画H22の位置情報として、x22を取得する。なお、x11、x12、x21及びx22は、それぞれ、3次元ベクトルであるものとする。 Next, in step ST2 described above, the moving obstacle information acquisition unit 21 acquires W11, t as the weight of the compartment H11 at the time t from the sensor 2 installed in the work area H, and the compartment at the time t. as the weight of H12, acquires W 12, t, as the weight of the compartment H21 at time t, to get the W 21, t, as compartments H22 at time t, to obtain a W 22, t. Further, the moving obstacle information acquisition unit 21 acquires W11 and t + 1 as the weight of the compartment H11 at the time t + 1 from the sensor 2 installed in the work area H, and W 12 as the weight of the compartment H12 at the time t + 1. obtains t + 1, as the weight of the compartment H21 at time t + 1, and acquires the W 21, t + 1, as a partition H22 at time t + 1, to obtain a W 22, t + 1. The mobile obstacle information acquiring unit 21, as position information of the partition H11 (status information), to get the x 11, as the position information of the partition H12, acquires x 12, as the position information of the partition H21, x 21 Is acquired, and x 22 is acquired as the position information of the section H22. It is assumed that x 11 , x 12 , x 21 and x 22 are three-dimensional vectors, respectively.
 次に、上述のステップST3において、移動障害物位置特定部30は、区画毎の重量と、区画毎の想定重量とを比較することにより移動障害物が存在する区画を特定することによって、移動障害物の位置を特定する。より詳細には、例えば、移動障害物位置特定部30は、時刻tにおける区画H11の重量と区画H11の想定重量との差W11,t-S11,tを算出し、算出結果が所定の閾値未満である場合、区画H11には移動障害物が存在しないと判定する。または、例えば、移動障害物位置特定部30は、時刻tにおける区画H11の重量と区画H11の想定重量との差W11,t-S11,tを算出し、算出結果が所定の閾値以上である場合、区画H11に移動障害物が存在すると判定し、時刻tにおける移動障害物の位置がx11であると特定する。 Next, in step ST3 described above, the moving obstacle position specifying unit 30 identifies the section in which the moving obstacle exists by comparing the weight of each section with the assumed weight of each section, thereby causing the moving obstacle. Identify the position of an object. More specifically, for example, moving obstacle position specifying unit 30 calculates the difference between W 11, t -S 11, t and assuming the weight of the weight and the section H11 compartments H11 at time t, the calculation result is given If it is less than the threshold value, it is determined that there is no moving obstacle in the compartment H11. Alternatively, for example, the moving obstacle position specifying unit 30 calculates the difference W11, t- S11, t between the weight of the section H11 and the assumed weight of the section H11 at time t , and the calculation result is equal to or higher than a predetermined threshold value. in some cases, it is determined that the moving obstacle is present in the compartment H11, the position of the moving obstacle at the time t is identified as the x 11.
 図6の例では、時刻tにおいて、移動障害物である人間Bが区画H12に存在するため、移動障害物位置特定部30は、時刻tにおける移動障害物の位置がx12であると特定する。また、時刻t+1において、移動障害物である人間Bが区画H22に存在するため、移動障害物位置特定部30は、時刻t+1における移動障害物の位置がx22であると特定する。 In the example of FIG. 6, at time t, since the human B is a moving obstacle is present in the compartment H12, moving obstacle position specifying unit 30, the position of the moving obstacle at the time t is identified as x 12 .. Further, since the human B who is a moving obstacle exists in the section H22 at the time t + 1, the moving obstacle position specifying unit 30 specifies that the position of the moving obstacle at the time t + 1 is x 22 .
 次に、上述のステップST4において、移動障害物移動方向特定部31は、時刻毎の移動障害物の位置に基づいて、移動障害物の移動方向を特定する。図6の例では、移動障害物移動方向特定部31は、移動障害物位置特定部30が特定した時刻t+1における移動障害物の位置x22と時刻tにおける移動障害物の位置x12とに基づいて、時刻tから時刻t+1までの移動障害物の移動方向として、x22-x12/|x22-x12|を算出する。なお、|x22-x12|は、ベクトルx22-x12の長さである。 Next, in step ST4 described above, the moving obstacle moving direction specifying unit 31 specifies the moving direction of the moving obstacle based on the position of the moving obstacle at each time. In the example of FIG. 6, the moving obstacle moving direction specifying unit 31 is based on the moving obstacle position x 22 at the time t + 1 specified by the moving obstacle position specifying unit 30 and the moving obstacle position x 12 at the time t. Then, x 22- x 12 / | x 22- x 12 | is calculated as the moving direction of the moving obstacle from the time t to the time t + 1. Note that | x 22 − x 12 | is the length of the vector x 22 −x 12.
 次に、上述のステップST5において、移動障害物移動速度特定部32は、時刻毎の移動障害物の位置に基づいて、移動障害物の移動速度を特定する。図6の例では、移動障害物移動速度特定部32は、移動障害物移動速度特定部32は、移動障害物位置特定部30が特定した時刻t+1における移動障害物の位置x22と時刻tにおける移動障害物の位置x12とに基づいて、時刻tから時刻t+1までの移動障害物の移動速度として、|x22-x12|/(t+1-t)を算出する。 Next, in step ST5 described above, the moving obstacle moving speed specifying unit 32 specifies the moving speed of the moving obstacle based on the position of the moving obstacle at each time. In the example of FIG. 6, the moving obstacle moving speed specifying unit 32 is the moving obstacle moving speed specifying unit 32 at the moving obstacle position x 22 and the time t at the time t + 1 specified by the moving obstacle position specifying unit 30. Based on the position x 12 of the moving obstacle, | x 22- x 12 | / (t + 1-t) is calculated as the moving speed of the moving obstacle from the time t to the time t + 1.
 次に、上述のステップST6において、衝突確率算出部23は、走行計画情報が示す自動走行車4の走行計画と、移動障害物の位置、移動障害物の移動方向及び移動障害物の移動速度と、に基づいて、自動走行車4と移動障害物との衝突確率を算出する。例えば、衝突確率算出部23は、上述のステップST3、ステップST4及びステップST5で特定された時刻t及び時刻t+1における移動障害物の各位置並びに時刻tから時刻t+1までの移動障害物の移動方向及び移動速度に基づいて、未来の時刻における移動障害物の位置を推定し、当該位置と、記憶装置10に書き込まれた走行計画が示す当該未来の時刻における自動走行車4の走行位置とが近ければ近いほど、衝突確率を高く算出する。例えば、衝突確率算出部23は、算出した衝突確率が所定の閾値以上であるか否かを判定し、衝突確率が所定の閾値以上であると判定した場合、記憶装置10に衝突確率が高いことを示す情報を記録し、上述のステップST8において、警告情報決定部24は、当該情報に基づいて、表示装置3が表示する警告情報を決定する。 Next, in step ST6 described above, the collision probability calculation unit 23 determines the travel plan of the automatic traveling vehicle 4 indicated by the travel plan information, the position of the moving obstacle, the moving direction of the moving obstacle, and the moving speed of the moving obstacle. , The collision probability between the autonomous vehicle 4 and the moving obstacle is calculated. For example, the collision probability calculation unit 23 may use the positions of the moving obstacles at the time t and the time t + 1 specified in the above steps ST3, ST4 and ST5, and the moving direction of the moving obstacles from the time t to the time t + 1. The position of the moving obstacle at a future time is estimated based on the moving speed, and if the position is close to the traveling position of the automatic traveling vehicle 4 at the future time indicated by the traveling plan written in the storage device 10. The closer it is, the higher the collision probability is calculated. For example, the collision probability calculation unit 23 determines whether or not the calculated collision probability is equal to or higher than a predetermined threshold value, and if the collision probability is determined to be equal to or higher than a predetermined threshold value, the storage device 10 has a high collision probability. In step ST8 described above, the warning information determination unit 24 determines the warning information to be displayed by the display device 3 based on the information.
 以下で、実施の形態1に係る自動走行制御装置11による警告情報決定方法におけるステップST7及びステップST8の具体例について図面を参照して説明する。図7は、実施の形態1に係る自動走行制御装置11による警告情報決定方法におけるステップST7及びステップST8の具体例を示すフローチャートである。なお、当該具体例では、表示装置3は、複数の区画にそれぞれ設置されているものとする。また、記憶装置10は、複数の走行指示情報と、警告情報とを予め記憶しているものとする。また、衝突確率算出部23は、上述のステップST6において算出した衝突確率が所定の閾値以上であるか否かを判定し、衝突確率が所定の閾値以上である場合、記憶装置10に衝突確率が高いことを示す情報を記録したものとする。 Hereinafter, specific examples of steps ST7 and ST8 in the warning information determination method by the automatic driving control device 11 according to the first embodiment will be described with reference to the drawings. FIG. 7 is a flowchart showing specific examples of steps ST7 and ST8 in the warning information determination method by the automatic driving control device 11 according to the first embodiment. In the specific example, it is assumed that the display device 3 is installed in each of a plurality of sections. Further, it is assumed that the storage device 10 stores a plurality of travel instruction information and warning information in advance. Further, the collision probability calculation unit 23 determines whether or not the collision probability calculated in step ST6 described above is equal to or higher than a predetermined threshold value, and if the collision probability is equal to or higher than the predetermined threshold value, the storage device 10 has a collision probability. It is assumed that the information indicating that the value is high is recorded.
 図7が示すように、走行指示情報決定部25は、ステップST1で走行計画情報取得部20が記憶装置10に記録した走行計画情報を読み込み、警告情報決定部24は、ステップST6で衝突確率算出部23が記憶装置10に記録した衝突確率に関する情報を読み込む(ステップST10)。 As shown in FIG. 7, the travel instruction information determination unit 25 reads the travel plan information recorded in the storage device 10 by the travel plan information acquisition unit 20 in step ST1, and the warning information determination unit 24 calculates the collision probability in step ST6. The unit 23 reads the information regarding the collision probability recorded in the storage device 10 (step ST10).
 次に、走行指示情報決定部25は、読み込んだ走行計画情報に基づいて、記憶装置10が記憶している複数の走行指示情報のうちから、表示用の走行指示情報を区画毎に選択する(ステップST11)。走行指示情報決定部25は、決定した走行計画情報を、通信装置12を介して表示装置3に出力する。なお、ステップST11において、走行指示情報決定部25は、走行計画情報に基づいて、自動走行車4が走行しない区画に関しては、表示用の走行指示情報を選択しない。つまり、当該区画に設置された表示装置3は、走行指示情報を表示しない。
 次に、警告情報決定部24は、読み込んだ衝突確率に関する情報が、衝突確率が高いことを示しているか否かを判定する(ステップST12)。
Next, the travel instruction information determination unit 25 selects the travel instruction information for display from the plurality of travel instruction information stored in the storage device 10 for each section based on the read travel plan information (the travel instruction information determination unit 25). Step ST11). The travel instruction information determination unit 25 outputs the determined travel plan information to the display device 3 via the communication device 12. In step ST11, the travel instruction information determination unit 25 does not select the travel instruction information for display with respect to the section in which the automatic traveling vehicle 4 does not travel, based on the travel plan information. That is, the display device 3 installed in the section does not display the travel instruction information.
Next, the warning information determination unit 24 determines whether or not the read information regarding the collision probability indicates that the collision probability is high (step ST12).
 警告情報決定部24は、読み込んだ衝突確率に関する情報が、衝突確率が高いことを示していると判定した場合(ステップST12のYES)、記憶装置10が記憶している表示用の情報のうちから、警告情報を選択する(ステップST13)。警告情報決定部24は、選択した警告情報を、通信装置12を介して表示装置3に出力する。なお、ステップST13において、警告情報決定部24は、上述のステップST4で移動障害物位置特定部30が特定した移動障害物の位置から上述のステップST5で移動障害物移動方向特定部31が特定した移動障害物の移動方向に存在する区画において表示するための警告情報を決定する。つまり、当該区画に設置された表示装置3が、警告情報を表示する。これにより、移動障害物は、表示装置3が表示した警告情報を認識しやすくなる。 When the warning information determination unit 24 determines that the read information regarding the collision probability indicates that the collision probability is high (YES in step ST12), the warning information determination unit 24 is among the display information stored in the storage device 10. , Select warning information (step ST13). The warning information determination unit 24 outputs the selected warning information to the display device 3 via the communication device 12. In step ST13, the warning information determination unit 24 is specified by the moving obstacle moving direction specifying unit 31 in the above step ST5 from the position of the moving obstacle specified by the moving obstacle position specifying unit 30 in the above step ST4. Determines the warning information to be displayed in the section existing in the moving direction of the moving obstacle. That is, the display device 3 installed in the section displays the warning information. This makes it easier for the moving obstacle to recognize the warning information displayed by the display device 3.
 警告情報決定部24が、読み込んだ衝突確率に関する情報が、衝突確率が高いことを示していないと判定した場合(ステップST12のNO)、自動走行制御装置11は処理を終了する。 When the warning information determination unit 24 determines that the read information on the collision probability does not indicate that the collision probability is high (NO in step ST12), the automatic driving control device 11 ends the process.
 自動走行制御装置11における、走行計画情報取得部20、移動障害物情報取得部21、移動障害物特定部22、衝突確率算出部23、警告情報決定部24及び走行指示情報決定部25の各機能は、処理回路により実現される。すなわち、自動走行制御装置11は、図3及びず7に示した各ステップの処理を実行するための処理回路を備える。この処理回路は、専用のハードウェアであってもよいが、メモリに記憶されたプログラムを実行するCPU(Central Processing Unit)であってもよい。 Functions of the travel plan information acquisition unit 20, the movement obstacle information acquisition unit 21, the movement obstacle identification unit 22, the collision probability calculation unit 23, the warning information determination unit 24, and the travel instruction information determination unit 25 in the automatic travel control device 11. Is realized by the processing circuit. That is, the automatic traveling control device 11 includes a processing circuit for executing the processing of each step shown in FIGS. 3 and 7. This processing circuit may be dedicated hardware, or may be a CPU (Central Processing Unit) that executes a program stored in the memory.
 図8Aは、自動走行制御装置11の機能を実現するハードウェア構成を示すブロック図である。図8Bは、自動走行制御装置11の機能を実現するソフトウェアを実行するハードウェア構成を示すブロック図である。図8A及び図8Bがそれぞれ示す記憶装置102は、上述の記憶装置10の機能と同様の機能を有する。図8A及び図8Bがそれぞれ示す通信装置103は、上述の通信装置12と同様の機能を有する。 FIG. 8A is a block diagram showing a hardware configuration that realizes the function of the automatic driving control device 11. FIG. 8B is a block diagram showing a hardware configuration for executing software that realizes the functions of the automatic driving control device 11. The storage device 102 shown in FIGS. 8A and 8B has the same function as that of the storage device 10 described above. The communication device 103 shown in FIGS. 8A and 8B has the same function as the above-mentioned communication device 12.
 上記処理回路が図8Aに示す専用のハードウェアの処理回路101である場合、処理回路101は、例えば、単一回路、複合回路、プログラム化したプロセッサ、並列プログラム化したプロセッサ、ASIC(Application Specific Integrated Circuit)、FPGA(Field-Programmable Gate Array)又はこれらを組み合わせたものが該当する。 When the processing circuit is the processing circuit 101 of the dedicated hardware shown in FIG. 8A, the processing circuit 101 may be, for example, a single circuit, a composite circuit, a programmed processor, a parallel programmed processor, or an ASIC (Application Specific Integrated Circuitd). Circuit), FPGA (Field-Programmable Gate Array) or a combination thereof is applicable.
 自動走行制御装置11における、走行計画情報取得部20、移動障害物情報取得部21、移動障害物特定部22、衝突確率算出部23、警告情報決定部24及び走行指示情報決定部25の各機能を別々の処理回路で実現してもよいし、これらの機能をまとめて1つの処理回路で実現してもよい。 Functions of the travel plan information acquisition unit 20, the movement obstacle information acquisition unit 21, the movement obstacle identification unit 22, the collision probability calculation unit 23, the warning information determination unit 24, and the travel instruction information determination unit 25 in the automatic travel control device 11. May be realized by separate processing circuits, or these functions may be collectively realized by one processing circuit.
 上記処理回路が図8Bに示すプロセッサ104である場合、自動走行制御装置11における、走行計画情報取得部20、移動障害物情報取得部21、移動障害物特定部22、衝突確率算出部23、警告情報決定部24及び走行指示情報決定部25の各機能は、ソフトウェア、ファームウェア又はソフトウェアとファームウェアとの組み合わせによって実現される。
 なお、ソフトウェア又はファームウェアは、プログラムとして記述されてメモリ105に記憶される。
When the processing circuit is the processor 104 shown in FIG. 8B, the travel plan information acquisition unit 20, the moving obstacle information acquisition unit 21, the moving obstacle identification unit 22, the collision probability calculation unit 23, and the warning in the automatic driving control device 11. Each function of the information determination unit 24 and the travel instruction information determination unit 25 is realized by software, firmware, or a combination of software and firmware.
The software or firmware is described as a program and stored in the memory 105.
 プロセッサ104は、メモリ105に記憶されたプログラムを読み出して実行することにより、自動走行制御装置11における、走行計画情報取得部20、移動障害物情報取得部21、移動障害物特定部22、衝突確率算出部23、警告情報決定部24及び走行指示情報決定部25の各機能を実現する。すなわち、自動走行制御装置11は、これらの各機能がプロセッサ104によって実行されるときに、図3及び図7に示した各ステップの処理が結果的に実行されるプログラムを記憶するためのメモリ105を備える。 By reading and executing the program stored in the memory 105, the processor 104 reads and executes the travel plan information acquisition unit 20, the movement obstacle information acquisition unit 21, the movement obstacle identification unit 22, and the collision probability in the automatic travel control device 11. Each function of the calculation unit 23, the warning information determination unit 24, and the travel instruction information determination unit 25 is realized. That is, the automatic driving control device 11 is a memory 105 for storing a program in which the processing of each step shown in FIGS. 3 and 7 is executed as a result when each of these functions is executed by the processor 104. To prepare for.
 これらのプログラムは、自動走行制御装置11における、走行計画情報取得部20、移動障害物情報取得部21、移動障害物特定部22、衝突確率算出部23、警告情報決定部24及び走行指示情報決定部25の各手順又は方法をコンピュータに実行させる。メモリ105は、コンピュータを、自動走行制御装置11における、走行計画情報取得部20、移動障害物情報取得部21、移動障害物特定部22、衝突確率算出部23、警告情報決定部24及び走行指示情報決定部25として機能させるためのプログラムが記憶されたコンピュータ可読記憶媒体であってもよい。 These programs include a travel plan information acquisition unit 20, a movement obstacle information acquisition unit 21, a movement obstacle identification unit 22, a collision probability calculation unit 23, a warning information determination unit 24, and a travel instruction information determination in the automatic travel control device 11. Have the computer perform each procedure or method of Part 25. The memory 105 uses the computer as a travel plan information acquisition unit 20, a movement obstacle information acquisition unit 21, a movement obstacle identification unit 22, a collision probability calculation unit 23, a warning information determination unit 24, and a travel instruction in the automatic travel control device 11. It may be a computer-readable storage medium in which a program for functioning as the information determination unit 25 is stored.
 プロセッサ104には、例えば、CPU(Central Processing Unit)、処理装置、演算装置、プロセッサ、マイクロプロセッサ、マイクロコンピュータ、またはDSP(Digital Signal Processor)などが該当する。 The processor 104 corresponds to, for example, a CPU (Central Processing Unit), a processing device, a computing device, a processor, a microprocessor, a microcomputer, a DSP (Digital Signal Processor), or the like.
 メモリ105には、例えば、RAM(Random Access Memory)、ROM(Read Only Memory)、フラッシュメモリ、EPROM(Erasable Programmable Read Only Memory)、EEPROM(Electrically-EPROM)などの不揮発性又は揮発性の半導体メモリ、ハードディスク、フレキシブルディスク等の磁気ディスク、フレキシブルディスク、光ディスク、コンパクトディスク、ミニディスク、CD(Compact Disc)、DVD(Digital Versatile Disc)などが該当する。 The memory 105 may include, for example, a RAM (Random Access Memory), a ROM (Read Only Memory), a flash memory, an EPROM (Erasable Programmable Read Only Memory), an EEPROM (Electrically-EPROM), or an EEPROM (Electrically-EPROM). This includes hard disks, magnetic disks such as flexible disks, flexible disks, optical discs, compact disks, mini disks, CDs (Compact Disc), DVDs (Digital Versailles Disc), and the like.
 自動走行制御装置11における、走行計画情報取得部20、移動障害物情報取得部21、移動障害物特定部22、衝突確率算出部23、警告情報決定部24及び走行指示情報決定部25の各機能について一部を専用のハードウェアで実現し、一部をソフトウェア又はファームウェアで実現してもよい。 Functions of the travel plan information acquisition unit 20, the movement obstacle information acquisition unit 21, the movement obstacle identification unit 22, the collision probability calculation unit 23, the warning information determination unit 24, and the travel instruction information determination unit 25 in the automatic travel control device 11. Some may be realized by dedicated hardware, and some may be realized by software or firmware.
 例えば、走行計画情報取得部20、移動障害物情報取得部21及び移動障害物特定部22の各機能は、専用のハードウェアとしての処理回路で機能を実現する。衝突確率算出部23、警告情報決定部24及び走行指示情報決定部25については、プロセッサ104がメモリ105に記憶されたプログラムを読み出して実行することにより機能を実現してもよい。
 このように、処理回路は、ハードウェア、ソフトウェア、ファームウェア又はこれらの組み合わせにより上記機能のそれぞれを実現することができる。
For example, each function of the travel plan information acquisition unit 20, the movement obstacle information acquisition unit 21, and the movement obstacle identification unit 22 is realized by a processing circuit as dedicated hardware. The functions of the collision probability calculation unit 23, the warning information determination unit 24, and the travel instruction information determination unit 25 may be realized by the processor 104 reading and executing the program stored in the memory 105.
As described above, the processing circuit can realize each of the above functions by hardware, software, firmware, or a combination thereof.
 以上のように、実施の形態1に係る自動走行制御装置11は、表示装置3によって表示されることにより走行路における自動走行車4の自動走行を指示する走行指示情報を、走行路における自動走行車4の走行計画に関する走行計画情報に基づいて決定する自動走行制御装置11であって、走行路において移動する移動障害物に関する移動障害物情報を取得する移動障害物情報取得部21と、表示装置3によって表示されることにより自動走行車4と移動障害物との衝突を移動障害物に対して警告する警告情報を、走行計画情報、及び移動障害物情報取得部21が取得した移動障害物情報に基づいて決定する警告情報決定部24と、を備えている。
 上記の構成によれば、決定した警告情報を適宜表示することにより、移動障害物に対して、警告を行うことができ、自動走行車と移動障害物との衝突を防止することができる。
As described above, the automatic driving control device 11 according to the first embodiment automatically travels on the traveling road by displaying the traveling instruction information indicating the automatic traveling of the automatic traveling vehicle 4 on the traveling road by being displayed by the display device 3. The automatic driving control device 11 that determines based on the driving plan information related to the driving plan of the vehicle 4, the moving obstacle information acquisition unit 21 that acquires the moving obstacle information about the moving obstacle moving on the traveling road, and the display device. The traveling plan information and the moving obstacle information acquired by the moving obstacle information acquisition unit 21 provide warning information for warning the moving obstacle of the collision between the autonomous vehicle 4 and the moving obstacle by being displayed by 3. The warning information determination unit 24, which determines based on the above, is provided.
According to the above configuration, by appropriately displaying the determined warning information, it is possible to give a warning to a moving obstacle and prevent a collision between the autonomous vehicle and the moving obstacle.
 例えば、近年、特定の環境下において人間による操縦を必要とせずに自動的に移動する自動走行車の実用化が盛んに行われている。例えば、実用化されている自動走行車の例として、自動搬送車、清掃を目的とした自動清掃装置、又は警備ロボット等が挙げられる。例えば、これらの自動走行車は、人間、又は自動走行車以外の車両等の移動障害物が存在する工場、倉庫又はオフィス等の環境下での実用化が期待される。そこで、上記の構成によれば、例えば、これらの環境下に存在する移動障害物に対して、警告を行うことができ、自動走行車と移動障害物との衝突を防止することができる。 For example, in recent years, self-driving cars that automatically move in a specific environment without the need for human control have been actively put into practical use. For example, examples of an automatic traveling vehicle that has been put into practical use include an automatic guided vehicle, an automatic cleaning device for cleaning purposes, a security robot, and the like. For example, these self-driving cars are expected to be put into practical use in environments such as factories, warehouses or offices where there are moving obstacles such as humans or vehicles other than self-driving cars. Therefore, according to the above configuration, for example, it is possible to give a warning to a moving obstacle existing in these environments, and it is possible to prevent a collision between the autonomous vehicle and the moving obstacle.
 実施の形態1に係る自動走行制御装置11において、走行路は、複数の区画から構成され、移動障害物情報取得部21が取得する移動障害物情報は、区画毎の重量であり、走行計画情報は、自動走行車4の走行計画に基づいた区画毎の想定重量を含み、移動障害物情報取得部21が取得した移動障害物情報が示す区画毎の重量と、走行計画情報が示す区画毎の想定重量とを比較することにより移動障害物が存在する区画を特定することによって、移動障害物の位置を特定する移動障害物位置特定部30をさらに備え、警告情報決定部24は、走行計画情報が示す自動走行車4の走行計画と、移動障害物位置特定部30が移動障害物情報に基づいて特定した移動障害物の位置と、に基づいて、警告情報を決定する。
 上記の構成によれば、区画毎の重量に基づいて、移動障害物の位置を特定し、当該移動障害物の位置に基づいて、警告情報を好適に決定することができ、自動走行車と移動障害物との衝突を防止することができる。
In the automatic driving control device 11 according to the first embodiment, the traveling path is composed of a plurality of sections, and the moving obstacle information acquired by the moving obstacle information acquisition unit 21 is the weight of each section, and the traveling plan information. Includes the assumed weight for each section based on the travel plan of the autonomous vehicle 4, the weight for each section indicated by the moving obstacle information acquired by the moving obstacle information acquisition unit 21, and each section indicated by the traveling plan information. A moving obstacle position specifying unit 30 for specifying the position of the moving obstacle by specifying the section where the moving obstacle exists by comparing with the assumed weight is further provided, and the warning information determination unit 24 is the traveling plan information. The warning information is determined based on the travel plan of the automatic traveling vehicle 4 indicated by the above and the position of the moving obstacle specified by the moving obstacle position specifying unit 30 based on the moving obstacle information.
According to the above configuration, the position of the moving obstacle can be specified based on the weight of each section, and the warning information can be suitably determined based on the position of the moving obstacle, and the autonomous vehicle and the moving vehicle can be moved. It is possible to prevent a collision with an obstacle.
 実施の形態1に係る自動走行制御装置11は、移動障害物位置特定部30が特定した移動障害物の位置に基づいて、移動障害物の移動方向を特定する移動障害物移動方向特定部31をさらに備え、警告情報決定部24は、移動障害物移動方向特定部31が特定した移動障害物の移動方向にさらに基づいて、警告情報を決定する。 The automatic traveling control device 11 according to the first embodiment has a moving obstacle moving direction specifying unit 31 that specifies the moving direction of the moving obstacle based on the position of the moving obstacle specified by the moving obstacle position specifying unit 30. Further, the warning information determination unit 24 determines the warning information based on the movement direction of the moving obstacle specified by the moving obstacle moving direction specifying unit 31.
 上記の構成によれば、特定した移動障害物の位置に基づいて、移動障害物の移動方向を特定し、当該移動障害物の移動方向にさらに基づいて、警告情報を好適に決定することができ、自動走行車と移動障害物との衝突を防止することができる。 According to the above configuration, the moving direction of the moving obstacle can be specified based on the position of the specified moving obstacle, and the warning information can be suitably determined based on the moving direction of the moving obstacle. , It is possible to prevent a collision between an autonomous vehicle and a moving obstacle.
 実施の形態1に係る自動走行制御装置11は、移動障害物位置特定部30が特定した移動障害物の位置に基づいて、移動障害物の移動速度を特定する移動障害物移動速度特定部32をさらに備え、警告情報決定部24は、移動障害物移動速度特定部32が特定した移動障害物の移動速度にさらに基づいて、警告情報を決定する。 The automatic traveling control device 11 according to the first embodiment has a moving obstacle moving speed specifying unit 32 that specifies the moving speed of the moving obstacle based on the position of the moving obstacle specified by the moving obstacle position specifying unit 30. Further, the warning information determination unit 24 determines the warning information based on the movement speed of the moving obstacle specified by the moving obstacle moving speed specifying unit 32.
 上記の構成によれば、特定した移動障害物の位置に基づいて、移動障害物の移動速度を特定し、当該移動障害物の移動速度にさらに基づいて、警告情報を好適に決定することができ、自動走行車と移動障害物との衝突を防止することができる。 According to the above configuration, the moving speed of the moving obstacle can be specified based on the position of the specified moving obstacle, and the warning information can be suitably determined based on the moving speed of the moving obstacle. , It is possible to prevent a collision between an autonomous vehicle and a moving obstacle.
 実施の形態1に係る自動走行制御装置11は、走行計画情報が示す自動走行車4の走行計画と、移動障害物位置特定部30が特定した移動障害物の位置と、移動障害物移動方向特定部31が特定した移動障害物の移動方向と、移動障害物移動速度特定部32が特定した移動障害物の移動速度と、に基づいて、自動走行車4と移動障害物との衝突確率を算出する衝突確率算出部23をさらに備え、警告情報決定部24は、衝突確率算出部23が算出した衝突確率に基づいて、警告情報を決定する。
 上記の構成によれば、特定した移動障害物の位置、移動方向及び移動速度に基づいて、衝突確率を算出し、当該衝突確率に基づいて警告情報を好適に決定することができ、自動走行車と移動障害物との衝突を防止することができる。
The automatic traveling control device 11 according to the first embodiment has a traveling plan of the automatic traveling vehicle 4 indicated by the traveling plan information, a position of a moving obstacle specified by a moving obstacle position specifying unit 30, and a moving obstacle moving direction identification. The collision probability between the autonomous vehicle 4 and the moving obstacle is calculated based on the moving direction of the moving obstacle specified by the unit 31 and the moving speed of the moving obstacle specified by the moving obstacle specifying unit 32. The collision probability calculation unit 23 is further provided, and the warning information determination unit 24 determines the warning information based on the collision probability calculated by the collision probability calculation unit 23.
According to the above configuration, the collision probability can be calculated based on the position, the moving direction, and the moving speed of the specified moving obstacle, and the warning information can be suitably determined based on the collision probability. Can prevent collisions with moving obstacles.
 実施の形態1に係る自動走行制御システム100は、実施の形態1に係る自動走行制御装置11と、表示装置3と、自動走行車4と、移動障害物に関する移動障害物情報を検出するセンサ2と、を含む。
 上記の構成によれば、自動走行制御システム100において、実施の形態1に係る自動走行制御装置11が奏する上述の効果を奏することができる。
The automatic driving control system 100 according to the first embodiment has an automatic driving control device 11 according to the first embodiment, a display device 3, an automatic traveling vehicle 4, and a sensor 2 that detects moving obstacle information related to a moving obstacle. And, including.
According to the above configuration, in the automatic driving control system 100, the above-mentioned effect played by the automatic driving control device 11 according to the first embodiment can be obtained.
 実施の形態1に係る警告情報決定方法は、表示装置3によって表示されることにより走行路における自動走行車4の自動走行を指示する走行指示情報を、走行路における自動走行車4の走行計画に関する走行計画情報に基づいて決定する自動走行制御方法であって、走行路において移動する移動障害物に関する移動障害物情報を取得する移動障害物情報取得ステップと、表示装置3によって表示されることにより自動走行車4と移動障害物との衝突を移動障害物に対して警告する警告情報を、走行計画情報、及び移動障害物情報取得ステップで取得した移動障害物情報に基づいて決定する警告情報決定ステップと、を含む。
 上記の構成によれば、実施の形態1に係る自動走行制御装置11が奏する効果と同様の効果を奏する。
The warning information determination method according to the first embodiment relates to the traveling instruction information indicating the automatic traveling of the automatic traveling vehicle 4 on the traveling road by being displayed by the display device 3 with respect to the traveling plan of the automatic traveling vehicle 4 on the traveling road. It is an automatic driving control method that is determined based on the driving plan information, and is automatically displayed by the moving obstacle information acquisition step for acquiring the moving obstacle information regarding the moving obstacle moving on the traveling path and the display device 3. Warning information determination step to determine warning information to warn the moving obstacle of the collision between the traveling vehicle 4 and the moving obstacle based on the traveling plan information and the moving obstacle information acquired in the moving obstacle information acquisition step. And, including.
According to the above configuration, the same effect as that of the automatic driving control device 11 according to the first embodiment is obtained.
実施の形態2.
 以下で、実施の形態2について図面を参照して説明する。なお、実施の形態2においても、実施の形態1に係る自動走行制御システム100を用いる。実施の形態1では、ある時刻の、ある区画において自動走行車4が1両のみ存在する場合を想定した構成について説明した。実施の形態2では、ある時刻の、ある区画において複数の自動走行車4が同時に存在する場合を想定した構成について説明する。
Embodiment 2.
Hereinafter, the second embodiment will be described with reference to the drawings. Also in the second embodiment, the automatic driving control system 100 according to the first embodiment is used. In the first embodiment, a configuration assuming a case where only one automatic traveling vehicle 4 exists in a certain section at a certain time has been described. In the second embodiment, a configuration assuming a case where a plurality of autonomous vehicles 4 exist at the same time in a certain section at a certain time will be described.
 実施の形態2に係る走行指示情報決定部25は、それぞれが、表示装置3によって表示されることにより走行路における対応する自動走行車4の自動走行を指示する複数の走行指示情報を、走行路における複数の自動走行車4の各走行計画に関する走行計画情報に基づいて決定する。 Each of the traveling instruction information determining units 25 according to the second embodiment displays a plurality of traveling instruction information indicating the automatic traveling of the corresponding automatic traveling vehicle 4 on the traveling road by displaying the display device 3 on the traveling road. It is determined based on the travel plan information about each travel plan of the plurality of automatic traveling vehicles 4 in the above.
 走行指示情報決定部25は、決定する走行指示情報毎に、表示装置3の表示方式をさらに決定する。換言すれば、走行指示情報決定部25は、決定する走行指示情報が指示する自動走行車4毎に、表示装置3の表示方式をさらに決定する。つまり、表示装置3は、走行指示情報決定部25が決定した走行指示情報を、走行指示情報決定部25が決定した表示方式で表示する。そして、複数の自動走行車4は、それぞれ、対応する表示方式で表示装置3が表示した走行指示情報に基づいて、走行路において自動走行を行う。よって、複数の自動走行車4が、それぞれ、対応する表示方式によって表示された走行指示情報のみに従って自動走行を行う。これにより、ある時刻の、ある区画において複数の自動走行車4が同時に存在する場合でも、目的の自動走行車4に対して走行指示を行うことができる。 The travel instruction information determination unit 25 further determines the display method of the display device 3 for each travel instruction information to be determined. In other words, the travel instruction information determination unit 25 further determines the display method of the display device 3 for each automatic traveling vehicle 4 instructed by the travel instruction information to be determined. That is, the display device 3 displays the travel instruction information determined by the travel instruction information determination unit 25 in the display method determined by the travel instruction information determination unit 25. Then, each of the plurality of automatic traveling vehicles 4 automatically travels on the traveling road based on the traveling instruction information displayed by the display device 3 in the corresponding display method. Therefore, each of the plurality of automatic traveling vehicles 4 automatically travels according to only the traveling instruction information displayed by the corresponding display method. As a result, even when a plurality of automatic traveling vehicles 4 exist at the same time in a certain section at a certain time, it is possible to give a traveling instruction to the target automatic traveling vehicle 4.
 より詳細には、例えば、走行指示情報決定部25が参照する走行計画情報は、自動走行車4の走行開始地点から目的地までの走行経路及び走行時刻と、自動走行車4の重量又は自動走行車4が運搬する荷物の重量等を含む重量データと、自動走行車4に重複なく割り振られた表示装置3の表示方式とが対応付けされた情報である。例えば、走行指示情報決定部25は、当該走行計画情報に基づいて、自動走行車4毎に、走行指示情報とともに、表示装置3の表示方式を決定する。なお、実施の形態2では、当該走行計画情報は、記憶装置10に予め記録されているものとする。 More specifically, for example, the travel plan information referred to by the travel instruction information determination unit 25 includes the travel route and travel time from the travel start point of the autonomous vehicle 4 to the destination, and the weight or automatic travel of the autonomous vehicle 4. This is information in which weight data including the weight of luggage carried by the vehicle 4 and the display method of the display device 3 allocated to the autonomous vehicle 4 without duplication are associated with each other. For example, the travel instruction information determination unit 25 determines the display method of the display device 3 together with the travel instruction information for each automatic traveling vehicle 4 based on the travel plan information. In the second embodiment, it is assumed that the travel plan information is recorded in the storage device 10 in advance.
 さらに詳細には、例えば、走行指示情報決定部25は、決定する走行指示情報毎に、表示装置3の表示色を表示方式として決定する。当該表示色は、例えば、赤、緑又は青である。より具体的には、例えば、表示装置3は、走行指示情報決定部25が決定した走行指示情報を、走行指示情報決定部25が決定した赤の表示色で表示する。そして、赤の表示色に対応する自動走行車4は、表示装置3が赤で表示した走行指示情報に基づいて、走行路において自動走行を行う。一方で、表示装置3は、走行指示情報決定部25が決定した走行指示情報を、走行指示情報決定部25が決定した緑の表示色でさらに表示する。そして、緑の表示色に対応する別の自動走行車4は、表示装置3が緑で表示した走行指示情報に基づいて、走行路において自動走行を行う。 More specifically, for example, the travel instruction information determination unit 25 determines the display color of the display device 3 as the display method for each travel instruction information to be determined. The display color is, for example, red, green or blue. More specifically, for example, the display device 3 displays the travel instruction information determined by the travel instruction information determination unit 25 in the red display color determined by the travel instruction information determination unit 25. Then, the automatic traveling vehicle 4 corresponding to the red display color automatically travels on the traveling road based on the traveling instruction information displayed in red by the display device 3. On the other hand, the display device 3 further displays the travel instruction information determined by the travel instruction information determination unit 25 in the green display color determined by the travel instruction information determination unit 25. Then, another automatic traveling vehicle 4 corresponding to the green display color automatically travels on the traveling road based on the traveling instruction information displayed in green by the display device 3.
 または、例えば、走行指示情報決定部25は、決定する走行指示情報毎に、表示装置3の点滅周期を表示方式として決定する。より具体的には、例えば、表示装置3は、走行指示情報決定部25が決定した走行指示情報を、走行指示情報決定部25が決定した1秒当たり3回の点滅周期で表示する。そして、1秒当たり3回の点滅周期に対応する自動走行車4は、表示装置3が1秒当たり3回の点滅周期で表示した走行指示情報に基づいて、走行路において自動走行を行う。一方で、表示装置3は、走行指示情報決定部25が決定した走行指示情報を、走行指示情報決定部25が決定した1秒当たり4回の点滅周期でさらに表示する。そして、1秒当たり4回の点滅周期に対応する別の自動走行車4は、表示装置3が1秒当たり4回の点滅周期で表示した走行指示情報に基づいて、走行路において自動走行を行う。 Alternatively, for example, the travel instruction information determination unit 25 determines the blinking cycle of the display device 3 as a display method for each travel instruction information to be determined. More specifically, for example, the display device 3 displays the travel instruction information determined by the travel instruction information determination unit 25 at a blinking cycle of 3 times per second determined by the travel instruction information determination unit 25. Then, the automatic traveling vehicle 4 corresponding to the blinking cycle of 3 times per second automatically travels on the traveling road based on the traveling instruction information displayed by the display device 3 in the blinking cycle of 3 times per second. On the other hand, the display device 3 further displays the travel instruction information determined by the travel instruction information determination unit 25 at a blinking cycle of 4 times per second determined by the travel instruction information determination unit 25. Then, another automatic traveling vehicle 4 corresponding to the blinking cycle of 4 times per second automatically travels on the traveling road based on the traveling instruction information displayed by the display device 3 in the blinking cycle of 4 times per second. ..
 以下で、実施の形態2に係る自動走行制御装置11の動作について図面を参照して説明する。図9は、実施の形態2に係る自動走行制御装置11による走行指示情報決定方法を示すフローチャートである。なお、実施の形態2に係る自動走行制御装置11による走行指示情報決定方法のステップST20からステップST23は、実施の形態1に係る自動走行制御装置11による警告情報決定方法の具体例におけるステップST10からステップST13と同様である。そのため、実施の形態2に係る自動走行制御装置11による走行指示情報決定方法のステップST20からステップST23についての説明を省略する。なお、記憶装置10は、自動走行車4に重複なく割り振られた表示装置3の表示方式を複数予め記憶しているものとする。 Hereinafter, the operation of the automatic driving control device 11 according to the second embodiment will be described with reference to the drawings. FIG. 9 is a flowchart showing a driving instruction information determination method by the automatic driving control device 11 according to the second embodiment. From step ST20 to step ST23 of the driving instruction information determination method by the automatic driving control device 11 according to the second embodiment, from step ST10 in the specific example of the warning information determination method by the automatic driving control device 11 according to the first embodiment. This is the same as step ST13. Therefore, the description of steps ST20 to ST23 of the driving instruction information determination method by the automatic driving control device 11 according to the second embodiment will be omitted. It is assumed that the storage device 10 stores in advance a plurality of display methods of the display device 3 allocated to the automatic traveling vehicle 4 without duplication.
 図9が示すように、ステップST22のNO又はステップST23の次のステップとして、走行指示情報決定部25は、ステップST21で選択した走行指示情報毎に、記憶装置10が記憶している複数の表示方式のうちから1つの表示方式を選択する(ステップST24)。 As shown in FIG. 9, as a step next to NO in step ST22 or step ST23, the travel instruction information determination unit 25 has a plurality of displays stored in the storage device 10 for each travel instruction information selected in step ST21. One display method is selected from the methods (step ST24).
 表示装置3は、走行指示情報決定部25がステップST21で決定した走行指示情報を、走行指示情報決定部25がステップST24で選択した表示方式で表示する。そして、複数の自動走行車4は、それぞれ、対応する表示方式で表示装置3が表示した走行指示情報に基づいて、走行路において自動走行を行う。 The display device 3 displays the travel instruction information determined by the travel instruction information determination unit 25 in step ST21 in the display method selected by the travel instruction information determination unit 25 in step ST24. Then, each of the plurality of automatic traveling vehicles 4 automatically travels on the traveling road based on the traveling instruction information displayed by the display device 3 in the corresponding display method.
 なお、実施の形態2に係る自動走行制御装置11における、走行計画情報取得部20、移動障害物情報取得部21、移動障害物特定部22、衝突確率算出部23、警告情報決定部24及び走行指示情報決定部25のそれぞれの機能は、処理回路により実現される。すなわち、実施の形態2に係る自動走行制御装置11は、図9に示したステップST20からステップST24までの処理を実行するための処理回路を備える。この処理回路は、専用のハードウェアであってもよいが、メモリに記憶されたプログラムを実行するCPU(Central Processing Unit)であってもよい。実施の形態2に係る自動走行制御装置11の機能を実現するハードウェア構成は、図8Aが示すハードウェア構成と同様である。また、実施の形態2に係る自動走行制御装置11の機能を実現するソフトウェアを実行するハードウェア構成は、図8Bが示すハードウェア構成と同様である。 In the automatic driving control device 11 according to the second embodiment, the traveling plan information acquisition unit 20, the movement obstacle information acquisition unit 21, the movement obstacle identification unit 22, the collision probability calculation unit 23, the warning information determination unit 24, and the travel Each function of the instruction information determination unit 25 is realized by a processing circuit. That is, the automatic traveling control device 11 according to the second embodiment includes a processing circuit for executing the processing from step ST20 to step ST24 shown in FIG. This processing circuit may be dedicated hardware, or may be a CPU (Central Processing Unit) that executes a program stored in the memory. The hardware configuration that realizes the function of the automatic driving control device 11 according to the second embodiment is the same as the hardware configuration shown in FIG. 8A. Further, the hardware configuration for executing the software that realizes the function of the automatic driving control device 11 according to the second embodiment is the same as the hardware configuration shown in FIG. 8B.
 以上のように、実施の形態2に係る自動走行制御装置11は、それぞれが、表示装置3によって表示されることにより走行路における対応する自動走行車4の自動走行を指示する複数の走行指示情報を、走行路における複数の自動走行車4の各走行計画に関する走行計画情報に基づいて決定する走行指示情報決定部25をさらに備え、走行指示情報決定部25は、決定する走行指示情報毎に、表示装置3の表示方式をさらに決定する。 As described above, each of the automatic driving control devices 11 according to the second embodiment is displayed by the display device 3 to indicate a plurality of driving instruction information for instructing the automatic driving of the corresponding automatic driving vehicle 4 on the traveling road. Further includes a travel instruction information determination unit 25 that determines based on the travel plan information regarding each travel plan of the plurality of automatic traveling vehicles 4 on the travel road, and the travel instruction information determination unit 25 determines each travel instruction information. The display method of the display device 3 is further determined.
 上記の構成によれば、適宜、複数の自動走行車4が、ぞれぞれ、対応する表示方式で表示された走行指示情報に基づいて、走行路において自動走行を行うことにより、目的の自動走行車に走行指示を行うことができる。 According to the above configuration, the plurality of automatic traveling vehicles 4 appropriately travel on the traveling road based on the traveling instruction information displayed in the corresponding display method, respectively, thereby performing the desired automatic driving. It is possible to give a driving instruction to a traveling vehicle.
 実施の形態2に係る自動走行制御装置11における走行指示情報決定部25は、決定する走行指示情報毎に、表示装置3の表示色を表示方式として決定する。
 上記の構成によれば、適宜、複数の自動走行車4が、ぞれぞれ、対応する表示色で表示された走行指示情報に基づいて、走行路において自動走行を行うことにより、目的の自動走行車4に対して走行指示を行うことができる。
The travel instruction information determination unit 25 in the automatic travel control device 11 according to the second embodiment determines the display color of the display device 3 as a display method for each travel instruction information to be determined.
According to the above configuration, a plurality of automatic traveling vehicles 4 appropriately travel on a traveling road based on the traveling instruction information displayed in the corresponding display colors, respectively, thereby performing the desired automatic driving. It is possible to give a traveling instruction to the traveling vehicle 4.
 実施の形態2に係る自動走行制御装置11における走行指示情報決定部25は、決定する走行指示情報毎に、表示装置3の点滅周期を表示方式として決定する。 The travel instruction information determination unit 25 in the automatic travel control device 11 according to the second embodiment determines the blinking cycle of the display device 3 as a display method for each travel instruction information to be determined.
 上記の構成によれば、適宜、複数の自動走行車4が、ぞれぞれ、対応する点滅周期で表示された走行指示情報に基づいて、走行路において自動走行を行うことにより、目的の自動走行車4に対して走行指示を行うことができる。
 なお、各実施の形態の自由な組み合わせ、あるいは各実施の形態の任意の構成要素の変形、もしくは各実施の形態において任意の構成要素の省略が可能である。
According to the above configuration, the plurality of automatic traveling vehicles 4 appropriately travel on the traveling road based on the traveling instruction information displayed in the corresponding blinking cycle, respectively, thereby performing the desired automatic driving. It is possible to give a traveling instruction to the traveling vehicle 4.
It should be noted that any combination of the embodiments can be freely combined, any component of the embodiment can be modified, or any component can be omitted in each embodiment.
 本開示に係る自動走行制御装置は、自動走行車と移動障害物との衝突を防止することができるため、自動走行制御システムに利用可能である。 The automatic driving control device according to the present disclosure can be used for an automatic driving control system because it can prevent a collision between an automatic driving vehicle and a moving obstacle.
 1 サーバ、2 センサ、3 表示装置、4 自動走行車、10 記憶装置、11 自動走行制御装置、12 通信装置、20 走行計画情報取得部、21 移動障害物情報取得部、22 移動障害物特定部、23 衝突確率算出部、24 警告情報決定部、25 走行指示情報決定部、30 移動障害物位置特定部、31 移動障害物移動方向特定部、32 移動障害物移動速度特定部、100 自動走行制御システム、101 処理回路、102 記憶装置、103 通信装置、104 プロセッサ、105 メモリ。 1 server, 2 sensor, 3 display device, 4 automatic driving vehicle, 10 storage device, 11 automatic driving control device, 12 communication device, 20 driving plan information acquisition unit, 21 mobile obstacle information acquisition unit, 22 mobile obstacle identification unit , 23 collision probability calculation unit, 24 warning information determination unit, 25 travel instruction information determination unit, 30 movement obstacle position identification unit, 31 movement obstacle movement direction identification unit, 32 movement obstacle movement speed identification unit, 100 automatic driving control System, 101 processing circuit, 102 storage device, 103 communication device, 104 processor, 105 memory.

Claims (10)

  1.  表示装置によって表示されることにより走行路における自動走行車の自動走行を指示する走行指示情報を、前記走行路における前記自動走行車の走行計画に関する走行計画情報に基づいて決定する自動走行制御装置であって、
     前記走行路において移動する移動障害物に関する移動障害物情報を取得する移動障害物情報取得部と、
     前記表示装置によって表示されることにより前記自動走行車と前記移動障害物との衝突を前記移動障害物に対して警告する警告情報を、前記走行計画情報、及び前記移動障害物情報取得部が取得した移動障害物情報に基づいて決定する警告情報決定部と、を備えていることを特徴とする、自動走行制御装置。
    An automatic driving control device that determines driving instruction information that is displayed by a display device to indicate automatic driving of an automatic traveling vehicle on a traveling road based on driving planning information related to a traveling plan of the automatic traveling vehicle on the traveling road. There,
    A moving obstacle information acquisition unit that acquires moving obstacle information regarding a moving obstacle moving on the traveling path, and a moving obstacle information acquisition unit.
    The travel plan information and the moving obstacle information acquisition unit acquire warning information that warns the moving obstacle of a collision between the autonomous vehicle and the moving obstacle by being displayed by the display device. An automatic driving control device including a warning information determination unit that determines based on the movement obstacle information.
  2.  前記走行路は、複数の区画から構成され、
     前記移動障害物情報取得部が取得する移動障害物情報は、区画毎の重量であり、
     前記走行計画情報は、前記自動走行車の走行計画に基づいた区画毎の想定重量を含み、
     前記移動障害物情報取得部が取得した移動障害物情報が示す区画毎の重量と、前記走行計画情報が示す区画毎の想定重量とを比較することにより前記移動障害物が存在する区画を特定することによって、前記移動障害物の位置を特定する移動障害物位置特定部をさらに備え、
     前記警告情報決定部は、前記走行計画情報が示す自動走行車の走行計画と、前記移動障害物位置特定部が前記移動障害物情報に基づいて特定した移動障害物の位置と、に基づいて、前記警告情報を決定することを特徴とする、請求項1に記載の自動走行制御装置。
    The runway is composed of a plurality of sections.
    The moving obstacle information acquired by the moving obstacle information acquisition unit is the weight of each section.
    The travel plan information includes an assumed weight for each section based on the travel plan of the automatic traveling vehicle.
    By comparing the weight of each section indicated by the moving obstacle information acquired by the moving obstacle information acquisition unit with the assumed weight of each section indicated by the travel plan information, the section in which the moving obstacle exists is specified. Thereby, a moving obstacle position specifying unit for specifying the position of the moving obstacle is further provided.
    The warning information determination unit is based on the travel plan of the autonomous vehicle indicated by the travel plan information and the position of the moving obstacle specified by the moving obstacle position specifying unit based on the moving obstacle information. The automatic driving control device according to claim 1, wherein the warning information is determined.
  3.  前記移動障害物位置特定部が特定した移動障害物の位置に基づいて、前記移動障害物の移動方向を特定する移動障害物移動方向特定部をさらに備え、
     前記警告情報決定部は、前記移動障害物移動方向特定部が特定した移動障害物の移動方向にさらに基づいて、前記警告情報を決定することを特徴とする、請求項2に記載の自動走行制御装置。
    A moving obstacle moving direction specifying unit for specifying the moving direction of the moving obstacle based on the position of the moving obstacle specified by the moving obstacle position specifying unit is further provided.
    The automatic traveling control according to claim 2, wherein the warning information determining unit determines the warning information based on the moving direction of the moving obstacle specified by the moving obstacle moving direction specifying unit. Device.
  4.  前記移動障害物位置特定部が特定した移動障害物の位置に基づいて、前記移動障害物の移動速度を特定する移動障害物移動速度特定部をさらに備え、
     前記警告情報決定部は、前記移動障害物移動速度特定部が特定した移動障害物の移動速度にさらに基づいて、前記警告情報を決定することを特徴とする、請求項3に記載の自動走行制御装置。
    A moving obstacle moving speed specifying unit for specifying the moving speed of the moving obstacle based on the position of the moving obstacle specified by the moving obstacle position specifying unit is further provided.
    The automatic traveling control according to claim 3, wherein the warning information determining unit determines the warning information based on the moving speed of the moving obstacle specified by the moving obstacle moving speed specifying unit. Device.
  5.  前記走行計画情報が示す自動走行車の走行計画と、前記移動障害物位置特定部が特定した移動障害物の位置と、前記移動障害物移動方向特定部が特定した移動障害物の移動方向と、前記移動障害物移動速度特定部が特定した移動障害物の移動速度と、に基づいて、前記自動走行車と前記移動障害物との衝突確率を算出する衝突確率算出部をさらに備え、
     前記警告情報決定部は、前記衝突確率算出部が算出した衝突確率に基づいて、前記警告情報を決定することを特徴とする、請求項4に記載の自動走行制御装置。
    The driving plan of the automatic traveling vehicle indicated by the traveling plan information, the position of the moving obstacle specified by the moving obstacle position specifying part, and the moving direction of the moving obstacle specified by the moving obstacle moving direction specifying part. A collision probability calculation unit for calculating the collision probability between the autonomous vehicle and the moving obstacle based on the moving speed of the moving obstacle specified by the moving obstacle moving speed specifying unit is further provided.
    The automatic driving control device according to claim 4, wherein the warning information determination unit determines the warning information based on the collision probability calculated by the collision probability calculation unit.
  6.  それぞれが、前記表示装置によって表示されることにより前記走行路における対応する自動走行車の自動走行を指示する複数の走行指示情報を、前記走行路における複数の自動走行車の各走行計画に関する走行計画情報に基づいて決定する走行指示情報決定部をさらに備え、
     前記走行指示情報決定部は、決定する走行指示情報毎に、前記表示装置の表示方式をさらに決定することを特徴とする、請求項1に記載の自動走行制御装置。
    Each of them displays a plurality of driving instruction information indicating the automatic driving of the corresponding automatic traveling vehicle on the traveling road by being displayed by the display device, and the traveling plan for each traveling plan of the plurality of automatic traveling vehicles on the traveling road. It also has a driving instruction information determination unit that determines based on information.
    The automatic driving control device according to claim 1, wherein the traveling instruction information determining unit further determines a display method of the display device for each traveling instruction information to be determined.
  7.  前記走行指示情報決定部は、決定する走行指示情報毎に、前記表示装置の表示色を前記表示方式として決定することを特徴とする、請求項6に記載の自動走行制御装置。 The automatic driving control device according to claim 6, wherein the traveling instruction information determining unit determines a display color of the display device as the display method for each traveling instruction information to be determined.
  8.  前記走行指示情報決定部は、決定する走行指示情報毎に、前記表示装置の点滅周期を前記表示方式として決定することを特徴とする、請求項6に記載の自動走行制御装置。 The automatic driving control device according to claim 6, wherein the traveling instruction information determining unit determines a blinking cycle of the display device as the display method for each traveling instruction information to be determined.
  9.  請求項1に記載の自動走行制御装置と、
     前記表示装置と、
     前記自動走行車と、
     前記移動障害物に関する移動障害物情報を検出するセンサと、を含むことを特徴とする、自動走行制御システム。
    The automatic driving control device according to claim 1 and
    With the display device
    With the self-driving car
    An automatic driving control system comprising a sensor for detecting moving obstacle information regarding the moving obstacle.
  10.  表示装置によって表示されることにより走行路における自動走行車の自動走行を指示する走行指示情報を、前記走行路における前記自動走行車の走行計画に関する走行計画情報に基づいて決定する自動走行制御方法であって、
     前記走行路において移動する移動障害物に関する移動障害物情報を取得する移動障害物情報取得ステップと、
     前記表示装置によって表示されることにより前記自動走行車と前記移動障害物との衝突を前記移動障害物に対して警告する警告情報を、前記走行計画情報、及び前記移動障害物情報取得ステップで取得した移動障害物情報に基づいて決定する警告情報決定ステップと、を含むことを特徴とする、警告情報決定方法。
    It is an automatic driving control method that determines driving instruction information indicating automatic driving of an automatic driving vehicle on a traveling road by being displayed by a display device based on driving planning information related to the traveling plan of the automatic traveling vehicle on the traveling road. There,
    A moving obstacle information acquisition step for acquiring moving obstacle information regarding a moving obstacle moving on the traveling path, and a step for acquiring the moving obstacle information.
    Warning information that warns the moving obstacle of a collision between the autonomous vehicle and the moving obstacle by being displayed by the display device is acquired in the traveling plan information and the moving obstacle information acquisition step. A method for determining warning information, which comprises a warning information determination step for determining based on the moving obstacle information.
PCT/JP2020/022181 2020-06-04 2020-06-04 Autonomous travel control device, autonomous travel control system, and warning information determination method WO2021245892A1 (en)

Priority Applications (3)

Application Number Priority Date Filing Date Title
PCT/JP2020/022181 WO2021245892A1 (en) 2020-06-04 2020-06-04 Autonomous travel control device, autonomous travel control system, and warning information determination method
JP2022528358A JP7158628B2 (en) 2020-06-04 2020-06-04 Automatic cruise control device, automatic cruise control system, and warning information determination method
TW109143833A TW202146264A (en) 2020-06-04 2020-12-11 Autonomous driving control device, autonomous driving control system, and warning information determination method can warn the moving obstacle for the collision between the autonomous driving vehicle and the moving obstacle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2020/022181 WO2021245892A1 (en) 2020-06-04 2020-06-04 Autonomous travel control device, autonomous travel control system, and warning information determination method

Publications (1)

Publication Number Publication Date
WO2021245892A1 true WO2021245892A1 (en) 2021-12-09

Family

ID=78830715

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2020/022181 WO2021245892A1 (en) 2020-06-04 2020-06-04 Autonomous travel control device, autonomous travel control system, and warning information determination method

Country Status (3)

Country Link
JP (1) JP7158628B2 (en)
TW (1) TW202146264A (en)
WO (1) WO2021245892A1 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2024013799A1 (en) * 2022-07-11 2024-01-18 株式会社Fuji Transport system, and operation instruction method for automatic transport device

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11184521A (en) * 1997-12-24 1999-07-09 Mitsubishi Electric Corp Automatic vehicle allocation system
JP2000194417A (en) * 1998-12-28 2000-07-14 Mitsubishi Electric Corp Automatic vehicle allocation system
JP2006285635A (en) * 2005-03-31 2006-10-19 Toshiba Corp Display guidance apparatus, robot system, and method of display guidance in robot system
WO2013011543A1 (en) * 2011-07-15 2013-01-24 株式会社日立製作所 Autonomous locomotion equipment and control method therefor
JP2017220129A (en) * 2016-06-09 2017-12-14 株式会社デンソー Road traffic control device and road traffic control method
JP2018022304A (en) * 2016-08-03 2018-02-08 住友電気工業株式会社 Roadside communication device, on-vehicle communication device, traffic system, and communication method
WO2018185831A1 (en) * 2017-04-04 2018-10-11 株式会社オプティム Mobile body, control system, control method and program
JP2019067282A (en) * 2017-10-04 2019-04-25 パナソニック株式会社 Roadside apparatus, communication system and risk detection method
WO2019116643A1 (en) * 2017-12-12 2019-06-20 ソニー株式会社 Information processing device and information processing method

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11184521A (en) * 1997-12-24 1999-07-09 Mitsubishi Electric Corp Automatic vehicle allocation system
JP2000194417A (en) * 1998-12-28 2000-07-14 Mitsubishi Electric Corp Automatic vehicle allocation system
JP2006285635A (en) * 2005-03-31 2006-10-19 Toshiba Corp Display guidance apparatus, robot system, and method of display guidance in robot system
WO2013011543A1 (en) * 2011-07-15 2013-01-24 株式会社日立製作所 Autonomous locomotion equipment and control method therefor
JP2017220129A (en) * 2016-06-09 2017-12-14 株式会社デンソー Road traffic control device and road traffic control method
JP2018022304A (en) * 2016-08-03 2018-02-08 住友電気工業株式会社 Roadside communication device, on-vehicle communication device, traffic system, and communication method
WO2018185831A1 (en) * 2017-04-04 2018-10-11 株式会社オプティム Mobile body, control system, control method and program
JP2019067282A (en) * 2017-10-04 2019-04-25 パナソニック株式会社 Roadside apparatus, communication system and risk detection method
WO2019116643A1 (en) * 2017-12-12 2019-06-20 ソニー株式会社 Information processing device and information processing method

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2024013799A1 (en) * 2022-07-11 2024-01-18 株式会社Fuji Transport system, and operation instruction method for automatic transport device

Also Published As

Publication number Publication date
TW202146264A (en) 2021-12-16
JPWO2021245892A1 (en) 2021-12-09
JP7158628B2 (en) 2022-10-21

Similar Documents

Publication Publication Date Title
CN108693878B (en) Course setting device and course setting method
JP7188338B2 (en) automatic parking system
US11175673B2 (en) Drive assist apparatus
CN108602466B (en) System and method for tracking moving objects to avoid interference with door operation
KR101105139B1 (en) Autonomously moving robot device and method of the device for avoiding sudden collision
JP7270834B2 (en) Autonomous vehicle parking behavior
JP7259698B2 (en) automatic parking system
US10353394B2 (en) Driving assistance device and driving assistance method
JP2017102907A (en) Method of selecting optimized rail track
US11345341B2 (en) Information processing apparatus, information processing method and computer readable recording medium for recording information processing program for providing autonomous movement of stationary vehicles
JP7456442B2 (en) Information processing device, information processing method, and program
US11417120B2 (en) Vehicle which indicates passenger movability, and method for controlling the same
JP7194130B2 (en) A method and apparatus for detecting emergency vehicles in real time and planning driving routes to deal with situations expected to be caused by emergency vehicles.
KR20200102013A (en) Parking space notification device and method thereof
CN112918465B (en) Automatic parking system
JP2021077163A (en) Automatic parking system
JP2020167551A (en) Control device, control method, and program
US20220153266A1 (en) Vehicle adaptive cruise control system, method and computer readable medium for implementing the method
JP2021018744A (en) Image display device
EP3599141B1 (en) A multi hypothesis prediction device for a vehicle
WO2021245892A1 (en) Autonomous travel control device, autonomous travel control system, and warning information determination method
CN115546756A (en) Enhancing situational awareness within a vehicle
KR20180126224A (en) vehicle handling methods and devices during vehicle driving
KR102184929B1 (en) Collision Avoidance System and Method of Autonomous Vehicle
CN114763159A (en) Automatic audio data tagging with autonomous driving vehicles

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 20938757

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2022528358

Country of ref document: JP

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 20938757

Country of ref document: EP

Kind code of ref document: A1