WO2016027830A1 - 管制制御装置及び運搬車両の走行シミュレーション方法 - Google Patents

管制制御装置及び運搬車両の走行シミュレーション方法 Download PDF

Info

Publication number
WO2016027830A1
WO2016027830A1 PCT/JP2015/073230 JP2015073230W WO2016027830A1 WO 2016027830 A1 WO2016027830 A1 WO 2016027830A1 JP 2015073230 W JP2015073230 W JP 2015073230W WO 2016027830 A1 WO2016027830 A1 WO 2016027830A1
Authority
WO
WIPO (PCT)
Prior art keywords
vehicle
travel
virtual
map data
actual
Prior art date
Application number
PCT/JP2015/073230
Other languages
English (en)
French (fr)
Inventor
政樹 金井
荒井 雅嗣
加藤 学
朋之 濱田
Original Assignee
日立建機株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 日立建機株式会社 filed Critical 日立建機株式会社
Publication of WO2016027830A1 publication Critical patent/WO2016027830A1/ja

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • 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
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/09Arrangements for giving variable traffic instructions

Definitions

  • the present invention relates to a control control device and a traveling simulation method for a transport vehicle, and more particularly to a travel simulation technique for a transport vehicle that travels autonomously in a mine.
  • an autonomous traveling system in which a transportation vehicle (hereinafter referred to as “unmanned dump truck”) that autonomously travels without boarding an operator is connected to a control device via a wireless communication line.
  • the control control device performs control control based on map data generated in advance and the position of the unmanned dump so that the unmanned dump does not interfere with other vehicles. If you want to add a new unmanned dump truck to this autonomous driving system, you want to check whether it is possible to drive safely and efficiently even if the number of operating units increases before actually introducing a new vehicle and operating the system. There is a request.
  • a method of performing a running simulation using a nonexistent vehicle hereinafter referred to as “virtual vehicle” and verifying the result can be considered.
  • Patent Document 1 discloses a pseudo operation that operates a pseudo mobile body (pseudo bus) by changing the operation status associated with each passing place of the mobile body with the passage of time.
  • An operation management device having means is disclosed.
  • Patent Document 2 discloses a travel prediction system that simulates a travel position when it is assumed that a virtual vehicle has started traveling at the same timing as the host vehicle on a route that the traveling vehicle has not selected.
  • Patent Document 2 only simulates a travel position when a virtual vehicle travels on another travel path that is different from the actual travel path. It cannot be run with mixing.
  • the present invention has been made in view of the above circumstances, and a control control device capable of performing operation verification when the number of transport vehicles is increased while reflecting the actual operation status of the transport vehicles and a travel simulation method for the transport vehicles.
  • the purpose is to provide.
  • the present invention is an air traffic control device that controls the travel of a transport vehicle that autonomously travels along a predetermined travel path in a mine, and is an actual map that defines an actual travel path.
  • a map data storage unit that stores data; an input unit that receives a setting operation for setting a travel parameter of a virtual vehicle that virtually travels on the travel path; a travel parameter that defines the behavior of the virtual vehicle; and the actual map data
  • the virtual vehicle simulation unit for simulating the traveling state when it is assumed that the virtual vehicle has traveled on the travel path, and autonomously traveling on the travel path by communicating with the actual vehicle in the transport vehicle
  • a travel permission section setting unit that sets a travel permission section composed of a partial section of the travel path that permits travel of each vehicle for each of the real vehicle and the virtual vehicle, and the communication unit includes the communication unit,
  • the travel permission section that sets a travel permission section composed of a partial section of the travel path that permits travel of each vehicle for each of the real vehicle and the virtual vehicle, and the communication unit includes the communication unit, The
  • the present invention is a traveling simulation method for a transport vehicle that autonomously travels along a predetermined traveling path in a mine premises, and generates virtual map data that defines a virtual traveling path that does not exist.
  • Receiving a setting operation for setting a travel parameter of a first virtual vehicle that is a non-existent vehicle traveling on the virtual travel path, a travel parameter defining the behavior of the first virtual vehicle, and the virtual A step of executing a simulation process for causing the first virtual vehicle to travel on the virtual travel path using map data, and the virtual map data are used when the actual vehicle in the transport vehicle actually travels autonomously. Storing as actual map data; and a second temporary map for virtually traveling along the traveling path based on the actual map data.
  • a step of simulating the driving state of the vehicle a step of acquiring positional information of the actual vehicle from the actual vehicle traveling on the actual traveling route, the positional information of the actual vehicle, the actual map data, and the second Based on the simulation result of the running state of the virtual vehicle, a travel permission section consisting of a partial section of the travel path permitting the travel of each vehicle is set for each of the real vehicle and the second virtual vehicle. And a step.
  • the response state from a server is shown
  • an autonomous traveling vehicle that transports earth and sand or ore loaded by a loader such as an excavator or a wheel loader in a mine and autonomously travels without a driver boarding, and traffic control of the autonomous traveling vehicle
  • a loader such as an excavator or a wheel loader in a mine
  • the control server is provided with a simulation function when the system components, for example, the number of operating autonomous traveling vehicles and map data are changed There is.
  • FIG. 1 is a diagram illustrating a schematic configuration of an autonomous traveling system.
  • the autonomous traveling system 1 shown in FIG. 1 is a mine for transporting loads such as earth and sand and ore loaded from excavators 10-1 and 10-2 that perform excavation and loading work in a quarry such as a mine.
  • the autonomous traveling vehicles (actual vehicles) 20-1 and 20-2 and a control server 31 installed in the vicinity of the quarry or in a remote control center 30 are connected to each other via a wireless communication line 40. Is done. Since a dump truck is used as the autonomous traveling vehicle, the autonomous traveling vehicle is hereinafter referred to as a dump. Further, in order to distinguish from a virtual transport vehicle described later, an actual dump is referred to as a real vehicle, and a virtual transport vehicle that does not exist is referred to as a virtual vehicle.
  • the control server 31 is a control device that controls the traveling of the dump truck, and has a traveling simulation function using a virtual vehicle.
  • Each of the dump trucks 20-1 and 20-2 is located between the excavator 10-1 or 10-2 and the excavators 10-1 and 10-2 along the conveyance path 60 set in advance in the mine. To return and transport the load. Since the dumps 20-1 and 20-2 and the excavators 10-1 and 10-2 have the same configuration, the dumps 20-1 and 20-2 and the excavators 10-1 and 10-2 are not distinguished from each other. Are described as dump 20 and excavator 10.
  • radio base stations 41-1, 41-2, 41-3 are installed. Then, radio communication radio waves are transmitted and received through these radio base stations 41-1, 41-2, and 41-3.
  • the excavator 10 and each dump 20 are position calculation devices (not shown in FIG. 1) for receiving positioning radio waves from the navigation satellites 50-1, 50-2, 50-3 and acquiring the position of the host vehicle.
  • position calculation devices for example, a GPS (Global Positioning System) device is provided.
  • the dump truck 20 includes a frame 21 that forms a main body, a front wheel 22 and a rear wheel 23, and a loading platform 24 that can rotate in a vertical direction around a hinge pin (not shown) provided at a rear portion of the frame 21. And a pair of left and right hoist cylinders (not shown) for rotating the loading platform 24 in the vertical direction. Further, the dump 20 is provided with an antenna 25 for connecting to the wireless communication line 40 in a place with a good view, for example, in front of the upper surface of the dump 20.
  • the dump 20 is equipped with a travel control device 200 for autonomous travel according to instructions from the control server 31.
  • the control server 31 is connected to an antenna 32 for connecting to the wireless communication line 40.
  • the control server 31 communicates with the dump 20 via the antenna 32 and the radio base stations 41-1, 41-2, 41-3.
  • FIG. 2 is a hardware configuration diagram of the control server and the dump 20, where (a) shows the control server and (b) shows the dump.
  • FIG. 3 is a view showing the appearance of the dump truck 20.
  • the control server 31 includes a CPU 311, a RAM (Random Access Memory) 312, a ROM (Read Only Memory) 313, an HDD (Hard Disk Drive) 314, an I / F 315, and a bus 318.
  • a CPU 311, a RAM 312, a ROM 313, an HDD 314, and an I / F 315 are connected via a bus 318.
  • the control server 31 further includes a display device 316 and an input device 317, which are connected to the I / F 315.
  • the display device 316 is a user interface for allowing the user to check the dumping situation in the mine and to specify the additional position of the virtual vehicle when executing the simulation function.
  • the display device 316 is an LCD (Liquid Crystal Display). Consists of.
  • the input device 317 is a user interface for a user to input information to the control server 31, and is configured using, for example, a mouse, a keyboard, or a touch panel (not shown) stacked on an LCD.
  • a server side communication device 390 for connecting to the wireless communication line 40 is connected to the I / F 315 of the control server 31.
  • the dump truck 20 has a travel control device 200 that performs control processing for autonomous travel as shown in FIG. 2B, and a travel drive for driving the dump truck 20 according to a control instruction from the travel control device 200.
  • a device 210 In order to connect to the wireless communication line 40, a device 210, a position calculation device 220 for calculating the position of the host vehicle of the dump truck 20, an in-vehicle sensor 230 such as a millimeter wave sensor for recognizing the surrounding environment of the dump truck 20, and the like.
  • the dump side communication device 240 is provided.
  • the traveling drive device 210 includes a braking device 211 that applies braking to the dump 20, a steering motor 212 for changing the steering angle of the dump 20, and a traveling motor 213 for causing the dump 20 to travel.
  • the position calculation device 220 calculates the own vehicle position based on the input from the GPS antenna 221 (see FIG. 3) provided in the dump truck 20.
  • the position calculation device 220 is not limited to GPS, and may be based on an inertial measurement device (IMU: Internal Measurement Unit) or a system that specifies a position using radio waves from a base station installed on the ground.
  • the dump 20 includes an antenna for the system, a gyro sensor, and a sensor for detecting the rotational speed of the wheel instead of the antenna 221 for GPS.
  • the vehicle-mounted sensor 230 is for recognizing and estimating the speed of the dump truck 20 and the surrounding environment.
  • a stereo camera or a millimeter wave radar sensor 232 may be used.
  • the detection result of the in-vehicle sensor 230 is output to the traveling control device 200, and is used for monitoring the traveling position and accelerating / decelerating so as not to leave the traveling path in a normal state, and used for a braking operation necessary for emergency avoidance behavior in an emergency.
  • the travel control device 200 includes a CPU 201, a RAM 202, a ROM 203, an HDD 204, an I / F 205, and a bus 208.
  • a CPU 201, a RAM 202, a ROM 203, an HDD 204, and an I / F 205 are connected via a bus 208.
  • a travel drive device 210, a position calculation device 220, an in-vehicle sensor 230, and a dump side communication device 240 are connected to the I / F 205.
  • control server 31 and the travel control device 200 it is read out by an autonomous travel control program and a traveling vehicle travel simulation program (software) stored in the recording device of the control server 31 and the travel control device 200.
  • the software and hardware When executed by the CPUs 201 and 311, the software and hardware cooperate to realize the functions of the control server 31 and the travel control device 200.
  • FIG. 4 is a functional block diagram showing the main functions of the control server.
  • FIG. 5 is a functional block diagram showing the main functions of the dump 20.
  • the control server 31 performs control for performing actual wireless communication with the actual dump 20 (hereinafter, the dump 20 will be referred to as “real vehicle 20”) and virtual communication with the virtual vehicle.
  • a virtual vehicle simulation unit 330 that simulates the behavior of a virtual vehicle that travels in the same mine as the real vehicle 20 based on an instruction from the control control unit 320, a display control unit 340 that performs display control processing for the display device 316, and the real vehicle 20 travels.
  • the virtual communication means data input / output with the server-side communication control unit 310.
  • the transportation path is a road connecting the starting point and the ending point of the actual vehicle 20 such as a loading / unloading field or a parking lot (not shown), and the traveling direction of the actual vehicle 20 formed on the road.
  • the lane according to the road corresponds to the road.
  • the server-side communication control unit 310 is connected to the server-side communication device 390 and performs control for performing actual wireless communication with the actual vehicle 20, and also performs a virtual vehicle simulation unit 330 (more specifically, a virtual machine described later). Data input / output processing (virtual communication) is performed between the vehicle communication unit 331) and the data necessary for the virtual vehicle travel simulation.
  • the control control unit 320 includes a vehicle allocation management unit 321, a travel permission section setting unit 322, and a map data generation unit 323.
  • the vehicle allocation management unit 321 sets the destination of the real vehicle 20 and the virtual vehicle, and determines a travel route from the current position to the destination by referring to the map data stored in the master map data DB 314a.
  • the vehicle allocation management unit 321 As a processing example of the vehicle allocation management unit 321, for example, when the real vehicle 20 or the virtual vehicle is in a parking lot, it is set for the purpose of the entrance of the loading place including the loading position.
  • the vehicle allocation management unit 321 sets a travel route from the parking lot to the entrance on the loading.
  • the vehicle allocation management unit 321 may dynamically generate the travel path as the loading position moves.
  • the vehicle allocation management unit 321 sets one of the earthmoving sites 62 and 63 as a destination according to the contents of the loaded object, and travels to that point. Generate a path.
  • the travel permission section setting unit 322 refers to the map data stored in the master map data DB 314a with respect to the real vehicle 20 or the virtual vehicle, and travels the partial section on the travel path determined above as the travel of the real vehicle 20 or the virtual vehicle. Is set as a travel-permitted section in which the travel permission section is permitted, and section information indicating the position of the travel-permitted section is generated.
  • the travel permission section setting unit 322 updates the section information stored in the section information DB 314b by overwriting the newly generated section information.
  • the section information includes the node ID of the front boundary point that is the frontmost node of the travel permitted section and the node ID of the rear boundary point that is the last node.
  • section request message information that requests setting of a new travel-permitted section from the real vehicle 20 or the virtual vehicle
  • section response message information indicating the travel permission section
  • the map data generation unit 323 generates, updates, and stores actual map data that defines the travel path based on the position coordinates collected by actually running the position where the actual travel path is installed.
  • the map information that defines the actual travel route is referred to as real map data
  • the map information that defines the non-existent travel route is referred to as virtual map data.
  • the map data generation unit 323 receives a setting operation for adding a virtual travel route that does not exist to the actual travel route from the input device 317
  • the map data generation unit 323 defines both the actual travel route and the virtual travel route. Is generated.
  • the map data generation unit 323 performs processing of storing real map data and virtual map data in the master map information DB 314b and a virtual map data DB 335 described later.
  • the virtual vehicle simulation unit 330 When the virtual vehicle simulation unit 330 receives a setting operation of a virtual vehicle that virtually travels on the travel path from the input device 317, the virtual vehicle simulation unit 330 defines travel parameters and map data that define the behavior of the virtual vehicle (both real map data and virtual map data). Is used to perform a simulation when the virtual vehicle travels virtually on the travel path, and the travel state such as the virtual position, speed, and acceleration of the virtual vehicle on the travel path is calculated. At this time, the virtual vehicle simulation unit 330 performs a simulation based on the travel permission section set for the virtual vehicle. For example, when the travel permission section is not set even though the front end of the travel permission section is approaching, a deceleration / stop braking command and a corresponding deceleration / stop operation are simulated.
  • the virtual vehicle simulation unit 330 includes a virtual vehicle communication unit 331 having a function for performing virtual communication with the server-side communication control unit 310, an instruction (running permission section) from the control control unit 320 via virtual communication, and a virtual vehicle. Based on the virtual position, a virtual travel control unit 332 that controls the travel of the virtual vehicle, and a travel simulation that performs a travel simulation of the virtual vehicle using travel parameters that define the behavior of the virtual vehicle based on instructions from the virtual travel control unit 332 333, the sensor simulation part 334 which simulates a virtual position and speed based on the behavior of a virtual vehicle, and virtual map data DB335 which stores the information of the travel path where a virtual vehicle drive
  • the virtual vehicle communication unit 331 outputs a virtual position of the virtual vehicle and a section request message to the server side communication control unit 310, and acquires section response message information or a non-permission response message from the server side communication control unit 310.
  • the virtual travel control unit 332 acquires the current position (virtual position) of the host vehicle from the sensor simulation unit 334, refers to the map data in the virtual map data DB 335, and performs control for causing the virtual vehicle to travel according to the travel permitted section. This is performed for the travel simulation unit 333.
  • the travel simulation unit 333 is configured based on performance (travel parameters) such as vehicle weight, acceleration, deceleration, and steering speed, which are vehicle body information of the virtual vehicle set in advance, and a control command from the virtual travel control unit 332. Calculate vehicle behavior (acceleration, deceleration, stop) and position.
  • performance such as vehicle weight, acceleration, deceleration, and steering speed, which are vehicle body information of the virtual vehicle set in advance, and a control command from the virtual travel control unit 332.
  • vehicle behavior acceleration, deceleration, stop
  • position position.
  • the sensor simulation unit 334 may correct the position of the virtual vehicle on the map data based on the calculation result of the travel simulation unit 333 by simulating an actual sensing error and adding a random error.
  • the GPS satellite trajectory may be calculated, the number and angle of GPS satellites that can be captured at that time at the position of the virtual vehicle are acquired, and a correction that adds an error according to the GPS satellite capture status may be performed.
  • GPS and IMU are mounted on the transport vehicle and the output values of each other are interpolated. Even if the position calculation accuracy of the transport vehicle is to be improved, the position of the virtual vehicle can be brought closer to the position calculated by the real vehicle, and the accuracy of the simulation result can be improved.
  • the sensor simulation unit 334 generates virtual sensing data by simulating the sensing state by a sensor such as a laser-radar sensor, a millimeter wave radar, a stereo camera or the like based on the position of the virtual vehicle and the surrounding environment data. Then, the calculation result may be passed to the virtual travel control unit 332.
  • a sensor such as a laser-radar sensor, a millimeter wave radar, a stereo camera or the like based on the position of the virtual vehicle and the surrounding environment data. Then, the calculation result may be passed to the virtual travel control unit 332.
  • the virtual map data DB 335 stores virtual map data.
  • the virtual map data for example, there is map data of a travel route scheduled to be generated in a plan for advancing mine excavation.
  • the map data may also include environmental data such as surrounding terrain according to the coordinate position for use in sensor simulation.
  • the virtual map data DB 335 stores virtual map data, and the virtual map data is simulated using the actual map 20 while operating the real vehicle 20, the master map data DB 314a is also virtual. Stores map data.
  • the display control unit 340 acquires real map data, virtual map data, the dump 20 and each position of the virtual vehicle, and information on the travel permitted section set for each vehicle, and displays the travel route on the map image.
  • An image showing the dump 20 and the virtual vehicle, and an image showing the set travel permitted section are displayed in a superimposed manner.
  • the display mode of the actual travel path and the virtual travel path, the dump 20 and the virtual vehicle may be changed so as to be distinguishable. Thereby, the positions of the transport vehicle and the virtual vehicle on the travel path can be visually confirmed, and the operation verification when the user adds the virtual vehicle can be easily performed.
  • the display control unit 340 is shown connected to the server-side communication control unit 310 and the I / F 315 for convenience of explanation, but the display control unit 340 includes the control control unit 320, the virtual vehicle simulation unit 330, and these You may comprise so that the data used as a display target may be acquired from the component contained in.
  • the server-side communication control unit 310, the control control unit 320 (the vehicle allocation management unit 321, the travel permission section setting unit 322), and the virtual vehicle simulation unit 330 (excluding the virtual map data DB 335) provided in the control server 31 realize these functions. 2 is executed by the CPU 311 (hardware) shown in FIG.
  • the master map data DB 314a, the section information DB 314b, and the virtual map data DB 335 are configured by a storage device that can store information in a fixed manner, for example, an HDD.
  • the virtual vehicle simulation unit 330 may be composed of several software sets, and there may be a plurality of the above-mentioned sets depending on the number of virtual vehicles that are operating. Alternatively, a plurality of virtual vehicles may be operated on one software. Alternatively, the virtual vehicle simulation unit 330 is configured by a computer that is placed in the control center 30 (see FIG. 1) independently of the control server 31, and is connected to the control server 31 via an Ethernet (registered trademark) cable or wireless communication. May be. Map data stored in the master map data DB 314a and the virtual map data DB 335 is configured as data stored on the HDD 314 or the microprocessor.
  • the traveling control device 200 mounted on the actual vehicle 20 includes a dump side communication control unit 250, a request information processing unit 260, an autonomous traveling control unit 270, and a dump map data DB 204a as shown in FIG.
  • the dump side communication control unit 250 controls wireless communication performed with the control server 31.
  • the dump side communication control unit 250 transmits a section request message and receives a section response message or a non-permission response message.
  • the request information processing unit 260 Based on the map data stored in the dump map data DB 204a and the current position calculated by the position calculation device 220 (see FIG. 2), the request information processing unit 260 has reached the point where the actual vehicle 20 transmits the request message. When the request point is reached, a request message is generated and the request message is transmitted to the control server 31 via the dump-side communication control unit 250.
  • the autonomous travel control unit 270 acquires the current position of the host vehicle from the position calculation device 220, refers to the map data in the dump map data DB 204a, and causes the host vehicle to travel according to the travel permission section included in the section response message. Control is performed on the traveling drive device 210 (see FIG. 2). In addition, the autonomous traveling control unit 270 determines the presence or absence of a front obstacle based on the detection result of the in-vehicle sensor 230, determines whether or not there is an interference with the obstacle and a collision avoidance operation, and if necessary, the braking operation is performed. Control for. Further, the autonomous traveling control unit 270 performs drive control on the braking device 211 in accordance with an instruction from the control server 31, and performs a deceleration operation, a normal stop operation, or an emergency stop operation.
  • the dump side communication control unit 250, the request information processing unit 260, and the autonomous traveling control unit 270 are configured by executing software that realizes these functions by the CPU 201 (hardware) shown in FIG.
  • the map data stored in the dump map data 204a is configured as data stored on the HDD 204 or the microprocessor.
  • FIG. 6 is a diagram illustrating a configuration example of an open pit mine site where an actual vehicle actually travels.
  • FIG. 6 is a diagram illustrating a configuration example of an open pit mine site where an actual vehicle actually travels.
  • FIG. 7 is a diagram illustrating a communication operation between the real vehicle and the virtual vehicle and the control server at the start of autonomous driving, where (a) illustrates a state in which a destination request message is transmitted from the real vehicle, b) shows the response state from the control server, and (c) shows the request and response state of the travel permission section.
  • FIG. 8 is a diagram showing details of setting of the travel permitted section, where (a) shows a state in which a request message for a destination is transmitted from an actual vehicle, (b) shows a response message from the control server, (C) shows the request
  • FIG. 6 indicates an excavation site by a mining machine such as the excavator 10 and a loading field 61 in which the mining machine loads the dump truck 20.
  • a loading position corresponding to LP in FIG. 6
  • the topsoil and ore dug by the excavator 10 are loaded into the actual vehicle 20 at the loading place 61.
  • Reference numeral 62 denotes an earth release site that unfolds the topsoil, and the topsoil and the like carried from the loading place 61 are unearthed at this place and are developed in layers or radially.
  • Reference numeral 63 denotes an earthmoving site in which a crusher for crushing ore is installed, and the crushed ore is transported to a freight car unloading site or a processing facility by a belt conveyor or the like.
  • QP in FIG. 6 is an entrance to the loading place 61 and a standby position where the dump 20 stops and waits until the excavator 10 permits the dump to enter the loading position (CALL).
  • CALL loading position
  • EXIT in FIG. 6 is an exit from which the dump 20 exits from the loading place 61.
  • the real vehicles 20-1 and 20-2 and the virtual vehicle 70 are loaded with topsoil and ore at the loading place 61, travel on the conveyance path 60, and convey them to the earthing places 62 and 63.
  • a travel path 64 is set in the transport path 60, and the vehicle 20 and the virtual vehicle 70 travel along the travel path 64.
  • the travel path 64 is given as a coordinate value set on the map.
  • the actual vehicles 20-1 and 20-2 control the acceleration / deceleration and steering while comparing the self-position determined by the GPS or other position calculation device with the coordinate value of the travel path 64, thereby moving along the travel path 64. Travel autonomously.
  • the virtual vehicle 70 performs the travel control by comparing the self-position identified by the sensor simulation unit 334 with the coordinate value of the travel path 64 by the virtual travel control unit 332, and the travel simulation unit 333 performs the virtual vehicle 70. Calculate travel.
  • a node 65 indicating a boundary between sections of the travel path and a link 66 connecting the adjacent nodes 65 are provided.
  • Information on the actual traveling path 64, the node 65, and the link 66 is stored as the same map data in the master map data DB 314a, the virtual map data DB 335, and the dump map data DB 204a.
  • the virtual map data DB 335 of the virtual vehicle simulation unit 330 includes a virtual travel route
  • the virtual map data is more travel route information than the actual map data stored in the master map data DB 314a and the dump map data DB 204a. May be included.
  • the control server 31 assigns / cancels the travel permission for each travel section including two adjacent nodes 65 and one link 66 by the control control unit 320, and uses the information as section information for the real vehicle 20 and the virtual vehicle 70. Notify Thereby, traveling is controlled so as to avoid a collision between the real vehicle and the virtual vehicle.
  • the travel path 64 is provided with a speed limit for each section, and the actual vehicle 20 and the virtual vehicle 70 travel at an appropriate speed or virtual while referring to the speed limit information in the dump map data DB 204a and the virtual map data DB 335, respectively. Run.
  • the actual vehicle 20 (hereinafter, the same applies to the virtual vehicle 70) has been loaded with topsoil and ore at the loading place 61, or has been released from the earthing places 62 and 63, the actual vehicle 20 is shown in FIG. 7 (a), a message requesting the destination (destination request message) is transmitted to the control server 31.
  • the request information processing unit 260 included in the travel control device 200 of the actual vehicle 20 determines the current self-position and the state of the vehicle (stopped) via the terminal-side communication control unit 250.
  • the virtual travel control unit 332 determines the own vehicle situation and transmits the situation via the virtual vehicle communication unit 331.
  • the destination request message is received by the server-side communication control unit 310 on the control server 31 and transmitted to the control control unit 320.
  • the dispatch management unit 321 in the control control unit 320 refers to the section information in the section information DB 314b and takes into account the status of other real vehicles 20 and virtual vehicles 70, and the destination of the dump truck that has requested the destination.
  • the server side communication control unit 310 is instructed to transmit a destination response message indicating the destination 80 and the route 81 to the destination to the dump truck.
  • the server-side communication control unit 310 transmits a destination response message to the real vehicle 20 via the wireless communication line 40 (see FIG. 7B).
  • the request information processing unit 260 on the actual vehicle 20 transmits a message (section request message) for requesting setting of the travel permitted section to the control server 31.
  • the server-side communication control unit 310 transmits a section request message to the control control unit 320.
  • the travel permission section setting unit 322 of the control control unit 320 sets the travel permission section 82 based on the process described below, and transmits a message (section response message) indicating the set travel permission section to the actual vehicle 20 ( (C) of FIG.
  • the section response message includes information (node ID) that uniquely identifies the foremost node of the travel permitted section, node ID at the end, and information (link ID) that uniquely identifies the link included in the travel permitted section. It is.
  • the real vehicle 20 can start traveling only after obtaining the travel permission section.
  • the section information stored in the section information DB 314b is updated and managed as needed.
  • the travel permission section setting unit 322 sets the travel permission section with reference to the section information and the map data stored in the master map data DB 314a.
  • the travel permitted section setting unit 322 performs the same control so that the travel is not permitted even if there is a request from the vehicle for a section that is already permitted for another vehicle. Do not allow multiple vehicles to enter the section.
  • the travel permission section received from the control server 31 is recorded in the master map data DB 314a (virtual map data DB 335 in the case of the virtual vehicle 70) on the vehicle, and autonomous traveling or virtual traveling is referred to this. This will determine how far you can travel.
  • the setting status of the travel-permitted section is specific information (link) that uniquely indicates the link 65 included in the travel-permitted section, including the foremost node ID, the last node ID included in the section response message, and the link ID located between them. ID).
  • the control server 31 records the foremost node ID, the last node ID, and the link ID located between them in the section information of the section information DB 314b, but the travel permission section setting unit 322 of the control control unit 320 is primarily used.
  • Manage by recording For each vehicle side, the autonomous traveling control unit 270 in the case of the real vehicle 20 and the virtual traveling control unit 332 in the case of the virtual vehicle 70 are temporarily positioned at the frontmost node ID, the last node ID, and between them.
  • the link ID to be recorded may be recorded and not recorded in the master map data 314a or the virtual map data DB 335.
  • actual vehicles 20-1 and 20-2 are traveling vehicles, and reference numerals 81-1 and 81-2 are travel permitted sections permitted for the respective vehicles. It is assumed that both the actual vehicles 20-1 and 20-2 are traveling in the direction indicated by the arrow A.
  • Reference numeral 83 denotes a travel permission remaining distance that indicates a distance along the travel path from the current position of the actual vehicle 20-1 to the foremost end (terminal) of the travel permission section 81-1.
  • Reference numeral 84 denotes a travel permission request start distance indicating a distance from the foremost end (termination) to a point where the actual vehicle 20-1 starts transmitting the section request message.
  • the travel permission request start distance 84 is longer than the distance at which the actual vehicle can be stopped.
  • the travel permission request start distance 84 is obtained by adding a predetermined offset distance to the stoppable distance.
  • the distance L at which the actual vehicle can be stopped is, for example, m, including the vehicle load, v, the vehicle current speed, f, the vehicle braking force, f, Then, it calculates
  • the offset coefficient c is a value of 1 or more, and is set in consideration of, for example, the time required for wireless communication or the degree of occurrence of a wireless communication failure.
  • the speed of the vehicle may be a value obtained by measuring the current speed of the vehicle from the rotational speed of the wheel, etc., and a speed limit (maximum allowable speed) defined by the map data for the current travel position of the vehicle. May be used.
  • the actual vehicle 20-1 when the remaining travel permission distance 83 of the actual vehicle 20-1 is equal to or less than the travel permission request start distance 84, the actual vehicle 20-1 requests a section request to the control server 31. Send a message.
  • This section request message includes the current position information of the actual vehicle 20-1.
  • the control server 31 When the control server 31 receives the section request message from the real vehicle 20-1, the control server 31 specifies the travel section in which the real vehicle 20-1 exists using the sent current position information. Then, along the traveling direction of the actual vehicle 20-1, a section that is longer than the shortest distance (travel permission grant length) given as a predetermined travel permission section from the end of the section where the actual vehicle 20-1 exists is set. Grant permission to travel. However, when there is a section where permission is given to another vehicle (real vehicle or virtual vehicle), the travel permission is given up to that point.
  • the section where the actual vehicle 20-1 exists is 85, and the sections where the travel permission grant length is 90 or more from the end are 86, 87, 88, 89.
  • the travel permission is already given to the actual vehicle 20-2 in the sections 88 and 89, the travel permission of 86 and 87 is given.
  • the section 87 is given as a new travel permission section.
  • the section for which travel permission has been granted is released when the distance from the vehicle position to the end of the section is equal to or greater than the travel permission cancellation distance after the vehicle passes through the section.
  • the section 88 in which the travel permission has been given to the actual vehicle 20-1 is in a stage where the distance 91 between the vehicle 20-2 and the end of the section is equal to or greater than the travel permission release distance 92. The travel permission is released, and the travel permission assignment to the subsequent actual vehicle 20-1 becomes possible.
  • FIG. 9 is a flowchart showing an outline of an operation procedure of the autonomous traveling system including the control server according to the present embodiment.
  • map data generation processing is performed by the map data generation unit 323 (S901). Details of the map data generation process will be described later.
  • step S903 If the simulation is not performed with mixed running of virtual vehicles (S903 / No), the process returns to step S902, and the control control process for only the actual vehicle is continued without using the simulation function of the control server 31.
  • the user uses the GUI (graphical interface: corresponding to the display device 316 and the input device 317) of the control server 31 while the dump 20 is actually running.
  • the virtual vehicle is added to the operation status of the real vehicle (S904).
  • the virtual vehicle simulation unit 330 performs a travel simulation and outputs the result to the control control unit 320.
  • the control control unit 320 performs a control control process by causing the vehicle (actual vehicle) that is actually traveling and the virtual vehicle acquired from the virtual vehicle simulation unit 330 to run together (S905). Details of the control control process in which the real vehicle and the virtual vehicle are mixedly run will be described later.
  • the user When the user wants to delete the virtual vehicle (S906 / Yes), the user specifies the deleted virtual vehicle and performs the deletion process (S907). For example, when it is desired to delete a virtual vehicle, it is desirable to perform simulation by adding a plurality of virtual vehicles, in addition to the case of ending simulation processing using virtual vehicles and returning to control control processing of only real vehicles. When the result cannot be obtained, the simulation may be performed again after reducing the number of virtual vehicles. Thereafter, the process returns to step S902.
  • step S906 If the virtual vehicle is not deleted (S906 / No), the process returns to step S905, and the control control process is continued even if the actual vehicle and the virtual vehicle are mixed.
  • FIG. 10 is a flowchart showing the flow of map data generation processing.
  • FIG. 11 is a diagram showing an example of map data, where (a) shows link information and (b) shows node information.
  • the map data generation process described below is a process of generating a virtual map using the map data generation unit 323 and storing it as real map data in the master map data DB 314a through a travel simulation using a virtual vehicle.
  • a maneuvering vehicle is added on a newly added road with a GPS-equipped vehicle, and sensor data for generating map data is collected based on the result.
  • the vehicle equipped with GPS may be, for example, a vehicle dedicated to data collection (navigation vehicle) for generating a map, or the autonomous traveling dump truck is set in the map measurement mode, and the position information is obtained using the GPS mounted on the dump. You may perform manned running while collecting In addition to GPS, the surrounding terrain shape may be measured using a sensor such as a laser radar.
  • the map data generation unit 323 generates map data using the collected sensor data (S1001). This process may be, for example, a process in which clustering is performed from a time-series coordinate point sequence, nodes are generated at appropriate intervals according to the shape of the conveyance path, and a travel path is generated.
  • the map data generation unit 323 stores the generated map data in the virtual map data DB 335. This map data corresponds to virtual map data.
  • the map data is represented by links indicating the nodes on the road and their connections.
  • the map data includes a link ID 1101 for identifying the link, a node ID 1102 at the coordinate where the link starts, a node ID 1103 at the coordinate where the link ends, and another link connected to the link start point.
  • FIG. 11B there is a table of coordinate values 1107 corresponding to the node ID 1106 and attributes 1108 thereof.
  • One of the node IDs is set in the attribute 1108 as a loading point or a release point.
  • the virtual travel control unit 332 refers to the virtual map stored in the virtual map data DB 335 and sends a virtual vehicle (to the first virtual vehicle) along the virtual map to the travel simulation unit 333.
  • a simulation process for traveling (corresponding) is executed, and it is confirmed that the model of the dump truck can appropriately follow the generated travel route data (S1002). This is necessary, for example, to confirm that there are no problems such as the generated road curve is too tight and the vehicle is unable to turn, or the control is not successful due to inappropriate node spacing. is there.
  • one virtual vehicle may be used for the control server 31, or a plurality of units may be controlled simultaneously.
  • the map data creation unit 323 stores the verified virtual map as real map data in the master map data DB 314a.
  • the control control unit 320 refers to the actual map data stored in the master map data DB 314a, travels one actual vehicle of the autonomous traveling dump truck, and confirms whether the map data and the actual conveyance path match ( S1003).
  • map data for example, when acquiring data by GPS, there may be an error in the data due to the satellite arrangement at that time and the shielding by the surrounding terrain. In addition, an error may be caused by processing for generating a travel route by software.
  • map data generation software it is desirable to use map data generation software that generates a correct travel path so that such a situation does not occur. However, it is difficult to guarantee reliability completely, and operation confirmation is necessary.
  • traveling with a single real vehicle even if the data on the travel path deviates from the correct position on the transport path, it is detected that the position of the travel path is not correct by, for example, a road shoulder detection function using a laser radar. Can do.
  • the correctness of the actual map data with respect to the travel path can be confirmed with one real vehicle (S1004 / Yes)
  • the same number of virtual vehicles (corresponding to the second virtual vehicle) to be operated are converted into the actual map data.
  • a travel simulation is performed by virtually traveling along the travel path based on the travel path (S1005). At this stage, for example, it is verified whether there are any points that may cause a collision when operating with a plurality of actual vehicles, such as a junction or a narrow road.
  • step S1006 / Yes If the simulation results for a plurality of vehicles are good (the vehicle can travel) (S1006 / Yes), the map data generation process is terminated. If the result of the simulation results for a plurality of vehicles is poor (the vehicle is in trouble) (S1006 / No), the process returns to step S1001 to generate map data again.
  • the virtual map data when the virtual map data is generated, the virtual map data can be adopted as the actual map data when the simulation result using the virtual vehicle is good. This makes it possible to verify the suitability as actual map data for driving an actual vehicle, and to check the operation of the vehicle at the time of generating map data, so that it is possible to respond safely to changes in the terrain of the mine.
  • FIG. 12 is a flowchart showing the flow of the control control process for only the actual vehicle.
  • FIG. 12 shows a flow of processing performed by the travel control device 200 and the control server 31 of the real vehicle 20, but the control control processing for the real vehicle and the control control processing for the virtual vehicle are the same processing.
  • the control of the virtual vehicle can also be performed by replacing the travel control device 200 and its components with the virtual vehicle simulation unit 330 and its components.
  • description will be made along the order of steps in FIG.
  • the request information processing unit 260 of the travel control device 200 sends a destination request message (current position) to the control server 31 via the wireless communication line 40. Information is included) (S1202). If the destination of the actual vehicle 20 is set (S1201 / Yes), the process proceeds to step S1204.
  • the dispatch management unit 321 of the control server 31 sets the destination with reference to the current position information of the actual vehicle 20 and the actual map data of the master map data DB 314a, and sends a destination response message indicating the result to the actual vehicle 20. Transmit (S1203). If the destination of the actual vehicle 20 is set (S1201 / Yes), the process proceeds to step S1204.
  • the real vehicle 20 After transmitting the section request message, the real vehicle 20 waits for reception of a section response message from the control server 31 while continuing to travel according to the currently permitted travel section.
  • the real vehicle 20 periodically transmits the current position to the control server 31 while traveling.
  • the autonomous travel control unit 270 compares the current position from the position calculation device 220 with the dump map data DB 204a and the currently granted travel permission section, and when the travel permission remaining distance is equal to or less than the stoppable distance (S1207 / Yes), a braking instruction is given to the braking device 211 of the travel drive device 210 so as to stop within the travel permitted section, and the actual vehicle 20 starts decelerating (S1208).
  • the travel permission section setting unit 322 sets the travel permission section based on the current position of the actual vehicle 20 and the map information stored in the master map data DB 314a, and shows the contents thereof.
  • a section response message is transmitted to the actual vehicle 20 (S1209).
  • the travel permission section setting unit 322 uses the received current position of the vehicle and the section information in the section information DB 314b to determine a section that is longer than the travel permission grant length from the end of the section where the vehicle exists in the traveling direction of the vehicle. Unless the permission is given to another vehicle, or when there is a section where permission is given to another vehicle, the travel permission section is set up to that point. Further, the travel permission section setting unit 322 adds information indicating which section the travel permission section has been set to the section information stored in the section information DB 31b.
  • the real vehicle 20 When the real vehicle 20 receives the section response message (S1210 / Yes), the real vehicle 20 starts to travel according to the new travel permission section indicated in the section response message (S1211). When the real vehicle 20 does not receive the section response message, the process returns to step S1205 (S1210 / No).
  • the case where the section response message is not received includes, for example, a case where the section request message does not reach the control server 31 due to a communication error, and the section response message does not reach the actual vehicle 20.
  • the travel permission section setting unit 322 cancels the setting of the travel permission section when the distance from the current position of the actual vehicle 20 to the end of the section is equal to or greater than the travel permission cancellation distance (see (c) of FIG. 8, S1212 / Yes). (S1213).
  • the travel permitted section setting unit 322 deletes information indicating the travel permitted section that has been released from the section information. Thereafter, the process returns to step S1201.
  • the travel permission section setting unit 322 does not cancel until the travel permission release distance is exceeded.
  • the dump truck travels (S1212).
  • FIG. 13 is a diagram for explaining the relationship among the control control device, the autonomous traveling dump truck, and the virtual vehicle when system operation verification is performed using a real vehicle and a virtual vehicle.
  • FIG. 14 is a diagram illustrating an example of section information for storing information on a travel permitted section set for a real vehicle and a virtual vehicle.
  • FIG. 14A shows a virtual vehicle (ID: V01) at a standby position.
  • FIG. 15 is a flowchart showing a flow of the control control process in which a real vehicle and a virtual vehicle are mixedly run.
  • the autonomous traveling system 1 is configured such that each of the five real vehicles 20-1 to 20-5 is actually wirelessly connected to the control server 31 as shown in FIG.
  • Each of -1 to 70-3 is connected by virtual communication (data input / output between the virtual vehicle simulation unit 330 and the control control unit 320 via the server-side communication control unit 310).
  • the entities of the virtual vehicles 70-1 to 70-3 are data on the virtual vehicle simulation unit 330, and operate on the control server 31 as described above.
  • the vehicle ID is assigned to each of the real vehicle and the virtual vehicle so that there is no duplication, and the control server 31 can determine whether the vehicle to be communicated is a real vehicle or a virtual vehicle based on the vehicle ID. it can.
  • FIG. 14 (a) shows an example of section information for storing information on the travel permitted section set for the real vehicle and the virtual vehicle.
  • R01 to R05 are vehicle IDs 1401 that uniquely identify real vehicles
  • V01 is a vehicle ID 1401 that uniquely identifies virtual vehicles.
  • As information indicating the travel permitted section a node (front boundary point) located at the foremost end of the travel permitted section and a node (rear boundary point) located at the rearmost end are stored.
  • the operating state of each vehicle is described for convenience of explanation, but the information indicating the operating state is attribute information of the node shown in FIG. 11B with the node ID as a key record. It becomes unnecessary by associating with. The same applies to (b), FIG. 22, and (a) and (b) of FIG.
  • the control server 31 the actual vehicle, and the virtual vehicle have exactly the same format, including the vehicle ID, the ID of the node or link representing the travel-permitted section, and the location information of the actual vehicle and the virtual vehicle (where on the map exists) Can communicate with each other.
  • the travel permission section is set so that the real vehicle and the virtual vehicle do not collide with each other by performing a control control process shown in FIG. 15 described later.
  • the operation after introduction can be verified in advance using a virtual vehicle before introducing a new real vehicle.
  • the travel permission section setting unit 322 of the control server 31 has received a travel permission request from the real vehicle 20, that is, the request information processing unit 260 (see FIG. 5) (S1501 / Yes), or the virtual vehicle 70, that is, the virtual travel control unit. It is determined whether or not there is a travel permission request from 332 (S1501 / No and S1502 / Yes). If there is no travel permission request from either (S1502 / No), the request is continued without waiting.
  • the travel permission section setting unit 322 executes the following processing when there is a travel permission request from any of the vehicles (S1501 / Yes, S1502 / Yes).
  • the priorities of the real vehicle and the virtual vehicle may be reversed, and the presence / absence of a travel permission request from either may be determined without particular distinction.
  • vehicle is used as a concept including a real vehicle and a virtual vehicle.
  • the travel permission section setting unit 322 uses the received current position of the vehicle and the information in the section information DB 314b, as in step S1208 described above, to determine the vehicle travel direction. For sections that are longer than the travel permission grant length from the end of the existing section, unless there is permission for other vehicles, or if there is a section for which permission is given to other vehicles Processing to set as a permitted section is executed (S1503).
  • the travel permission section setting unit 322 creates a section response message indicating the travel permission section and transmits or outputs it to the vehicle (S1505).
  • the travel permission section setting unit 322 sets the section as a travel permission section for the same vehicle, and stores it in the section information (S1506). If there is a section that intersects with a section that grants travel permission, the travel permission section setting unit 322 sets the section as a travel permission section for the same vehicle on the master map data DB 314a (S1507).
  • These processes are processes for preventing other vehicles from entering the junction or intersection and interfering with the vehicle that is the target of setting the travel-permitted section. On the other hand, since it is only necessary to notify the travel permission section along the traveling direction of the vehicle, the travel permission section set in this step is not included in the section response message, and the process of the control server 31 is completed.
  • step S1212 when the distance from the current position of the vehicle to the end of the travel permission section that has already passed is equal to or greater than the travel permission release distance, the travel permission section setting unit 322 cancels the travel permission of the section that has passed. Is updated (S1508).
  • FIG. 14 shows a state in which each vehicle has moved forward and the travel permission section has been reset.
  • node_1 to node_2 are set as travel permission sections for the actual vehicle (R01), but after the actual vehicle (R01) passes node_1, node_2 is released from node_1.
  • node_1 to node_2 are set as travel permission sections for the actual vehicle (R02).
  • the real vehicle 20 and the control server 31 repeat the above processing.
  • a simulation of the driving state including the behavior and position when driving on the road according to the driving permission section set for the virtual vehicle is performed, and the result (particularly the position of the virtual vehicle) is determined as the driving permission. Returned to the section setting section.
  • the travel-permitted section setting unit 322 sets the travel-permitted section with the same processing for both vehicles without particularly distinguishing whether the requesting vehicle is an autonomous traveling dump truck or a virtual vehicle. To do. Thereby, the autonomous traveling dump truck that actually travels and the virtual vehicle in the simulation are controlled and controlled so as to prevent collision with each other.
  • FIG. 16 is a diagram illustrating an example of a virtual vehicle setting input screen.
  • a map screen 1602 including the loading place 61 and the earth release place 62 in the mine and the conveyance path 60 connecting them is displayed.
  • the travel permission section setting unit 322 also performs control for displaying the screen 1601 on the display device 316 (see FIG. 2).
  • a traveling path and nodes for representing the section are set as coordinate data on the transport path.
  • the travel permission section setting unit 322 generates and displays a map screen 1602 by superimposing and displaying the travel permission sections stored in the section information DB 314b and the positions of the real vehicle 20 and the virtual vehicle 70 on the map data of the master map data DB 314a. To do. Further, the transport vehicle 20 and the virtual vehicle 70 are displayed in a superimposed manner on the map screen while changing the display mode.
  • a tool box 1603 for displaying a virtual vehicle icon is displayed. The user drags the virtual vehicle icon on the transport path 60 to the position where the travel permission section is not set with the mouse cursor 1604.
  • a node ID input field 1605 may be provided on the screen 1601.
  • the virtual travel control unit 332 displays the X coordinate 1606 and Y coordinate 1607 of the node ID with reference to the map data, and displays a virtual vehicle icon at that position. Also good.
  • the virtual vehicle simulation unit 330 including the virtual travel control unit 332 and the travel simulation unit 333 starts processing.
  • the travel permission section is set for the transport vehicle and the virtual vehicle based on the position of the actual vehicle that is actually traveling and the virtual position of the virtual vehicle, the virtual vehicle is added while the actual vehicle is traveling. It is possible to verify whether or not it is possible to set the travel permission section at the time. Moreover, since the state which operated the real vehicle can be maintained in this verification, the fall of the productivity of a mine accompanying the operation stop of a real vehicle can be suppressed.
  • the second embodiment is an embodiment for performing verification for adding a new travel route to existing map data.
  • the second embodiment will be described with reference to FIGS. 17 to 19.
  • FIG. 17 is a screen display example for adding a virtual travel path.
  • FIG. 18 is a flowchart showing an overview of the processing of the second embodiment.
  • FIG. 19 is a flowchart showing details of the virtual travel route addition process.
  • FIG. 17 shows a screen display example displayed in the virtual road addition process.
  • the screen 1702 in FIG. 17 is displayed on the display device 316 of the control server 31 when a virtual travel path is added to the actual travel path when a real vehicle and a virtual vehicle are mixed running in a mine including a planned transport path. It is a screen to be.
  • the actual travel path and the virtual travel path are displayed with different display modes.
  • the screen 1702 is provided with a virtual loading place 68 in addition to the configuration of the loading place 61, the earthing place 62, and the transport path 60 described in FIG. 16.
  • the dumping ground 62 is a common dumping ground for transporting from the loading places 61 and 68.
  • a virtual transport path 67 is branched from the transport path 60 so that the loading place 68 can be accessed.
  • Five autonomous traveling dump trucks 20-1 to 20-5 reciprocate between the original loading field 61 and the earthing field 62, and the three virtual vehicles 70-1 to 70-3 are virtually loaded.
  • a round trip is made between the ground 68 and the earthing ground 62.
  • the autonomous traveling dump trucks 20-1 to 20-5 and virtual vehicles 70-1 to 70-3 are each instructed from the control server 31.
  • the vehicle travels according to the travel permitted sections 81-1 to 81-8.
  • a map data generation process is performed (S901), and when a virtual travel route is not added (S1801 / No), the processes of steps S902 to S907 are performed as in the first embodiment.
  • the virtual travel path addition process is a process for setting the shapes of the transport path, loading place, and earth release place that do not actually exist in a state where the travel path has already been set in the mine.
  • the map data generation unit 323 uses reference data such as an aerial photograph of a mine used when setting a virtual map from a storage device externally attached to the control server 31, for example. And existing map data (which may be stored in either the master map data DB 314a or the virtual map data DB 335) is read (S1901).
  • the reference data is not limited to photographs, but may be CAD data having information on the mine topography of the development plan.
  • the map information creation unit 323 displays a map image based on these data on the screen of the display device 316. In the map image, map data stored in the master map data DB 314a or the like may be superimposed and displayed on topographic information using aerial photographs or the like.
  • the user plots the node coordinates of the virtual traveling road to be added to the existing traveling road on the map image using the input device 317 (S1902).
  • the plotted node coordinates are stored in the map information creation unit 323.
  • the user sets the connection relationship between the nodes plotted using the input device 317 (S1903). For example, it may be set by clicking one node and then clicking a node to be connected to it, or may be set by selecting two nodes and executing processing. At this time, when the conveyance path is branched from a node included in the existing map data, a connection relationship with the existing map data may be set.
  • the user sets the parameter of the plotted node using the input device 317 (S1904).
  • the plotted nodes are given attributes (corresponding to reference numeral 1108 in FIG. 11) for giving instructions to the vehicle, such as loading points and release points.
  • the map data generation unit 323 stores the generated map data in the virtual map data DB 335 and the master map data DB 314a (S1905).
  • non-existing (virtual) nodes and links are defined as data that can be distinguished from existing nodes and links. For example, like a vehicle ID, a character that distinguishes both is added to an existing node ID, a link ID, a virtual node ID, and a link ID, and a real vehicle actually exists when setting a travel permission section in a simulation run The travel permission section is set using only the node ID, and the virtual vehicle sets the travel permission section using both the actual node ID and the virtual node ID.
  • the map data stored above is only virtual travel route information, and the travel route data in the actually developed transport route etc. is newly determined by the map generation processing procedure determined by sensors such as GPS and laser radar. Need to be generated.
  • the travel permission section setting unit 322 includes the vehicle ID, the node ID, and the link ID of the section information. Based on this, the virtual vehicle refers to the virtual map data to set a travel permitted section on the virtual travel path, and for the real vehicle, refers to the real map data and sets the travel permitted section on the actual travel path.
  • the dump map data DB 204a stores only actual map data, and the autonomous traveling control unit 270 performs traveling control while comparing the position data of the position calculation device 220 and the actual map data, and the two do not match. Since the vehicle stops, it is possible to avoid a real vehicle from getting lost on the virtual travel path.
  • the real vehicle travels according to the travel permission section set on the actual travel path
  • the virtual vehicle travels according to the travel permission section set on the virtual travel path.
  • a system configuration in which a virtual map data is generated in advance assuming a traveling path on a non-existing conveyance path, and the actual vehicle and the virtual vehicle travel based on the control control based on the virtual map data.
  • the third embodiment is an embodiment in which a traveling model of a virtual vehicle is corrected based on actual traveling data of an autonomous traveling dump truck or an input operation from a user.
  • FIG. 20 is a functional block diagram of the control server 31 according to the third embodiment.
  • FIG. 21 is a screen display example displayed in the third embodiment.
  • the control server 31 uses the travel data of the transport vehicle received from the traveling real vehicle to change the behavior of the virtual vehicle to the real vehicle.
  • a travel parameter correction unit 350 that corrects the travel parameters so as to coincide with the behavior of.
  • the travel parameter is a parameter that affects the behavior of the virtual vehicle. For example, the vehicle weight, acceleration, gradient, road friction coefficient ⁇ , and the like are corrected.
  • the friction coefficient ⁇ is set using the rotational speed and torque of the wheel at that point.
  • the actual vehicle 20 includes a travel data storage unit (not shown) that temporarily records speed, acceleration, inclination, load sensor data, and the like corresponding to the vehicle coordinates detected by the in-vehicle sensor 230 during travel.
  • the vehicle 20 transmits the output from the in-vehicle sensor 230 via the wireless communication line 40 while traveling.
  • the traveling parameter correction unit 350 receives the sensor value, identifies a point where the virtual vehicle 70 travels differently from the autonomous traveling dump truck 20 based on the value, and determines the gradient or acceleration of the vehicle from the point.
  • the travel parameters of the virtual vehicle are calculated so that the virtual vehicle 70 behaves more like an actual vehicle.
  • the travel parameter of the travel simulation unit 333 is corrected to the calculated value. As a result, the behavior of the virtual vehicle can be made closer to the behavior of the running real vehicle, and the reliability of the simulation result can be further increased.
  • FIG. 21 shows an example of a travel parameter input screen.
  • a screen 2101 in FIG. 21 shows a parameter input screen for defining vehicle specifications.
  • the vehicle specifications as examples of parameters that affect the behavior of the virtual vehicle, the vehicle body weight, the maximum loading capacity, the wheel base, and the minimum turning radius are illustrated.
  • the travel parameters are not limited thereto. For example, there may be acceleration, deceleration (braking amount), steering speed, and the like.
  • the travel simulation unit 333 updates the travel parameter used in the travel simulation unit 333 to an input value.
  • the travel simulation unit 333 performs a travel simulation of the virtual vehicle using the input value.
  • parameters derived from the state of the traveling road for example, the gradient of the road surface and the friction coefficient may be corrected as needed.
  • the travel parameters that define the friction coefficient of the road surface for example, the wheel rotation speed and torque are different for each node and link on the travel road, so that the travel parameters can be set by specifying the node ID and link ID. Also good.
  • the user can set or modify the travel parameters of the virtual vehicle, and a travel simulation of desired performance and structure can be performed.
  • a travel simulation of desired performance and structure can be performed when running parameters indicating the same performance and structure as the actual vehicle are set.
  • a running simulation can be performed when a vehicle of the same vehicle type as the actual vehicle is added.
  • a travel simulation can be performed when a vehicle of a vehicle type different from the actual vehicle is added.
  • the virtual vehicle is processed so as to end instantaneously when the virtual vehicle performs a specific operation, for example, a standby operation, a traveling operation, and a stop operation at the loading position at the loading site.
  • a specific operation for example, a standby operation, a traveling operation, and a stop operation at the loading position at the loading site.
  • This is an embodiment that performs (skip processing).
  • FIG. 22 is an example of the section information in which the travel permission sections set in the loading place for the virtual vehicle are described in time series.
  • FIG. 23 is a diagram illustrating an example of section information when a virtual vehicle is skipped.
  • FIG. 23A illustrates a state where only skip processing is performed
  • FIG. 23B illustrates time lag adjustment processing performed during skip processing. Indicates the state.
  • the travel permission section setting unit 322 assumes that, for example, phases 1, 2, and 3 have ended instantaneously, skips from phase 1 to phase 4, and sets the travel permission section of phase 1 Further, a travel permission section of phase 4 may be set (see FIG. 23A).
  • the control server 31 includes a timer, and the travel permission section setting unit 322 is configured to perform the skip process after measuring the time during which the virtual vehicle does not jump over the immediately preceding vehicle (particularly the actual vehicle) during the skip process.
  • FIG. 23B shows section information when the virtual vehicle (V01) is skipped after the real vehicle (R04) immediately before the virtual vehicle (V01) leaves the exit of the loading area. .
  • the travel permission section setting unit 322 may execute the skip process after confirming that the current position received from the immediately preceding actual vehicle (R04) has exited the exit, instead of the timing process.
  • the time required for the virtual vehicle to perform the above operation is made shorter than the operation time of the actual vehicle, so that the time during which the loader cannot be operated is further reduced, and the production of the mine accompanying the simulation is performed. The decrease in efficiency can be suppressed.
  • a virtual vehicle is added on the travel path.
  • the virtual vehicle starts from a predetermined starting point, for example, a parking lot. It may be configured.
  • the example relating to the loading operation is illustrated as the skip operation example of the fourth embodiment, the operation related to the earthing operation may be skipped.
  • a warning may be displayed when a situation where the travel permission section cannot be set occurs.
  • the above situation may be limited to the virtual vehicle and the immediately following vehicle (including the real vehicle and the virtual vehicle). Thereby, it becomes easy to grasp the situation in which the travel permission section cannot be set due to the addition of the virtual vehicle, and a display screen suitable for the operation verification of the autonomous travel system can be provided.

Abstract

自律走行する運搬車両を実際の稼働状況を反映させつつ、自律走行システムの構成要素に変化があった際の動作検証を事前に行う。走行路を仮想的に走行する仮想車両の設定操作を受け付ける入力部(317)と、仮想車両の挙動を規定する走行パラメータ及び実地図データを用いて、仮想車両が走行路を仮想的に走行した際のシミュレーションを行い、走行路上の仮想車両の走行状態を算出する仮想車両シミュレーション部(330)と、実車両の位置情報、実地図データ、及び仮想車両の走行状態に基づいて、実車両及び仮想車両の其々に対し、各車両の走行を許可する走行路の部分区間からなる走行許可区間を設定する走行許可区間設定部(322)と、を備える。

Description

管制制御装置及び運搬車両の走行シミュレーション方法
 本発明は、管制制御装置及び運搬車両の走行シミュレーション方法に係り、特に鉱山で自律走行する運搬車両の走行シミュレーション技術に関する。
 露天掘り鉱山等において、オペレータが搭乗することなく自律走行する運搬車両(以下「無人ダンプ」という)を管制制御装置に無線通信回線を介して通信接続した自律走行システムが知られている。管制制御装置は、無人ダンプが他の車両と干渉しないように、予め生成された地図データ及び無人ダンプの位置を基に管制制御を行う。この自律走行システムに新規に無人ダンプを追加したい場合、実際に新規車両を投入してシステムを稼働する前に、稼働台数が増えても安全・効率的な走行が可能であるかを確認したいという要望がある。この要望に応えるために、実在しない車両(以下「仮想車両」という)を用いた走行シミュレーションを行い、その結果を検証する手法が考えられる。
 車両のシミュレーション装置の一例として、特許文献1には、移動体の各通過場所に関連付けられた運行状況を時間経過に応じて変移することにより疑似的な移動体(疑似バス)を運行させる疑似運行手段を備えた運行管理装置が開示されている。
 また、特許文献2には、走行車両が選択しなかった経路を仮想車両が自車と同一タイミングで走行開始したと仮定したときの走行位置をシミュレートする走行予測システムが開示されている。
特開2006-244124号公報 特開2007-170927号公報
 鉱山で稼働する無人ダンプの台数を増やした状態のシミュレーションを、実際の無人ダンプの稼働状況からは独立させて仮想車両だけを用いて行うことも考えられる。
 しかし、仮想車両だけを用いてシミュレーションを行うと、仮想車両の挙動と実際に走行する実車両の挙動とが一致しないことがある。従って、上記特許文献1のように疑似的な移動体のみを用いたシミュレーション技術を自律走行システムのシミュレーションに適用しても、シミュレーション結果の信頼性が十分得られない。
 また、特許文献2は、実在する走行路とは異なる他の走行路を仮想車両に走行させたときの走行位置をシミュレートするにすぎず、実在する走行路に実在する車両と仮想車両とを混ぜて走行させることはできない。
 本発明は上記実情に鑑みてなされたものであり、運搬車両の実際の稼働状況を反映させつつ、運搬車両の稼働台数を増やした際の動作検証が行える管制制御装置及び運搬車両の走行シミュレーション方法を提供することを目的とする。
 上記課題を解決するため、本発明は、鉱山の構内を予め定められた走行路に沿って自律走行する運搬車両の走行制御を行う管制制御装置であって、実在する走行路を規定した実地図データを記憶する地図データ記憶部と、前記走行路を仮想的に走行する仮想車両の走行パラメータを設定する設定操作を受け付ける入力部と、前記仮想車両の挙動を規定する走行パラメータ及び前記実地図データを用いて、前記仮想車両が前記走行路を走行したと仮定した際の走行状態のシミュレーションを行う仮想車両シミュレーション部と、前記運搬車両における実車両と通信を行うことにより、前記走行路を自律走行中の前記実車両の位置情報を受信する通信部と、前記実車両の位置情報、前記実地図データ、及び前記仮想車両の走行状態に基づいて、前記実車両及び前記仮想車両の其々に対し、各車両の走行を許可する前記走行路の部分区間からなる走行許可区間を設定する走行許可区間設定部と、を備え、前記通信部は、前記実車両に対し、当該実車両に対して設定された走行許可区間を送信し、前記仮想車両シミュレーション部は、前記仮想車両に対して設定された前記走行許可区間に従って前記走行路を走行した際のシミュレーションを行い、前記仮想車両の走行状態を更新する、ことを特徴とする。
 また、本発明は鉱山の構内を予め定められた走行路に沿って自律走行する運搬車両の走行シミュレーション方法であって、実在しない走行路である仮想の走行路を規定する仮想地図データを生成するステップと、前記仮想の走行路を走行する実在しない車両である第一の仮想車両の走行パラメータを設定する設定操作を受け付けるステップと、前記第一の仮想車両の挙動を規定する走行パラメータ及び前記仮想地図データを用いて、前記第一の仮想車両に前記仮想の走行路を走行させるシミュレーション処理を実行するステップと、前記仮想地図データを、前記運搬車両における実車両が実際に自律走行する際に用いる実地図データとして格納するステップと、前記実地図データに基づく走行路に沿って仮想的に走行させるための第二の仮想車両の設定入力を受け付けるステップと、前記第二の仮想車両の挙動を規定する走行パラメータ及び前記実地図データを用いて、前記第二の仮想車両が前記実在の走行路を走行したと仮定した際の走行状態のシミュレーションを行うステップと、前記実在の走行路を走行する前記実車両から当該実車両の位置情報を取得するステップと、前記実車両の位置情報、前記実地図データ、及び前記第二の仮想車両の走行状態のシミュレーション結果に基づいて、前記実車両及び前記第二の仮想車両の其々に対し、各車両の走行を許可する前記走行路の部分区間からなる走行許可区間を設定するステップと、を含むことを特徴とする。
 本発明によれば、運搬車両を実際の稼働状況を反映させつつ、自律走行システムの構成要素に変化があった際の動作検証が行える管制制御装置及び運搬車両の走行シミュレーション方法を提供することができる。上記した以外の課題、構成及び効果は、以下の実施形態の説明により明らかにされる。
自律走行システムの概略構成を示す図である。 管制サーバ及びダンプのハードウェア構成図であって、(a)は管制サーバ、(b)はダンプを示す。 ダンプの外観を示す図である。 管制サーバの主な機能を示す機能ブロック図である。 ダンプの主な機能を示す機能ブロック図である。 実車両が実際に走行する露天掘り鉱山現場の構成例を示す図である。 自律走行開始時における実車両及び仮想車両と管制サーバとの間の通信動作を示す図であって、(a)は実車両から目的地の要求メッセージを送信する状態を示し、(b)は管制サーバからの応答状態を示し、(c)は走行許可区間の要求及び応答状態を示す。 走行許可区間の設定の詳細を示す図であって、(a)は実車両から目的地の要求メッセージを送信する状態を示し、(b)は管制サーバからの応答メッセージを示し、(c)は走行許可区間の要求及び応答状態を示す。 管制サーバを含む自律走行システムの動作手順の概略を示すフローチャートである。 地図データ生成処理の流れを示すフローチャートである。 地図データの一例を示す図であって、(a)はリンク情報を示し、(b)はノード情報を示す。 実車両だけの管制制御処理の流れを示すフローチャートである。 実車両及び仮想車両を用いてシステム動作検証を行う際の、管制制御装置と自律走行ダンプトラックと仮想車両の関係を説明するための図である。 実車両及び仮想車両に対して設定された走行許可区間の情報を格納する区間情報の例を示す図であって、(a)は、仮想車両が待機位置で待機中の状態における区間情報例を示し、(b)は、(a)から仮想車両が1動作(1フェーズ)遷移した状態における区間情報を示す。 実車両及び仮想車両を混走させて管制制御処理の流れを示すフローチャートである。 仮想車両の設定入力画面の一例を示す図である。 仮想走行路を追加するための画面表示例である。 第二実施形態の処理の概要を示すフローチャートである。 仮想走行路追加処理の詳細を示すフローチャートである。 第三実施形態に係る管制サーバの機能ブロック図である。 第三実施形態で表示される画面表示例である。 仮想車両に対して積込場において設定される走行許可区間を時系列に沿って記載した区間情報の例である。 仮想車両をスキップ処理した際の区間情報の例を示す図であって、(a)はスキップ処理のみを行った状態を示し、(b)はスキップ処理時にタイムラグ調整処理を行った状態を示す。
 以下の実施の形態においては、要素の数等(個数、数値、量、範囲等を含む)に言及する場合、特に明示した場合および原理的に明らかに特定の数に限定される場合等を除き、その特定の数に限定されるものではなく、特定の数以上でも以下でもよい。なお、以下の実施の形態において、その構成要素(処理ステップ等も含む)は、特に明示した場合および原理的に明らかに必須であると考えられる場合等を除き、必ずしも必須ではない。
 以下、本発明の実施の形態を図面に基づいて詳細に説明する。なお、実施の形態を説明するための全図において、同一の機能を有する部材には同一または関連する符号を付し、その繰り返しの説明は省略する。
 <第一実施形態>
 第一実施形態は、鉱山においてショベルやホイールローダ等の積込機が積み込んだ土砂や鉱石を搬送し、運転手が搭乗することなく自律走行する自律走行運搬車両と、自律走行運搬車両の交通管制を行う管制サーバと、を無線通信回線で接続した自律走行システムにおいて、システムの構成要素、例えば自律走行運搬車両の稼働台数や地図データ、を変更した際のシミュレーション機能を管制サーバに備える点に特徴がある。
 まず、図1に基づいて、本発明の第一実施形態に係る管制サーバを含む自律走行システムの概略構成について説明する。図1は、自律走行システムの概略構成を示す図である。
 図1に示す自律走行システム1は、鉱山などの採石場で、掘削及び積込作業を行うショベル10-1、10-2から積み込まれた土砂や鉱石等の積荷を搬送するための鉱山用の自律走行運搬車両(実車両)20-1、20-2と、採石場の近傍若しくは遠隔の管制センタ30に設置された管制サーバ31とを、無線通信回線40を介して互いに通信接続して構成される。自律走行運搬車両としてダンプトラックを用いるので、以下では自律走行運搬車両をダンプと称する。また、後述する仮想的な運搬車両と区別するために、実在するダンプは実車両、実在しない仮想的な運搬車両を仮想車両という。管制サーバ31は、ダンプの走行制御を行う管制制御装置であり、仮想車両を用いた走行シミュレーション機能を有する。
 各ダンプ20-1、20-2は、鉱山内で予め設定された搬送路60に沿ってショベル10-1又は10-2、及びショベル10-1、10-2は図示しない放土場の間を往復し、積荷を搬送する。ダンプ20-1、20-2、及びショベル10-1、10-2はそれぞれ同じ構成であるので、各ダンプ20-1、20-2、また各ショベル10-1、10-2を区別しない場合は、ダンプ20、ショベル10と記載する。
 鉱山内には、複数の無線基地局41-1、41-2、41-3が設置される。そしてこれらの無線基地局41-1、41-2、41-3を経由して、無線通信の電波が送受信される。
 ショベル10及び各ダンプ20は、航法衛星50-1、50-2、50-3から測位電波を受信して自車両の位置を取得するための位置算出装置(図1では図示を省略する)、例えばGPS(Global Positioning System)装置を備える。
 ダンプ20は、本体を形成するフレーム21と、前輪22及び後輪23と、フレーム21の後方部分に設けられたヒンジピン(図示せず)を回動中心として上下方向に回動可能な荷台24と、この荷台24を上下方向に回動させる左右一対のホイストシリンダ(図示せず)と、を含む。また、ダンプ20は、見通しの良い場所、例えば、ダンプ20の上面前方に、無線通信回線40に接続するためのアンテナ25が設置される。
 更にダンプ20は、管制サーバ31からの指示に従って自律走行をするため走行制御装置200を搭載する。
 管制サーバ31は、無線通信回線40に接続するためのアンテナ32に接続される。そして、管制サーバ31は、アンテナ32、無線基地局41-1、41-2、41-3を経由してダンプ20と通信する。
 次に図2及び図3を参照して、図1の管制サーバ31及びダンプ20のハードウェア構成について説明する。図2は、管制サーバ及びダンプ20のハードウェア構成図であって、(a)は管制サーバ、(b)はダンプを示す。図3は、ダンプ20の外観を示す図である。
 図2の(a)に示すように、管制サーバ31は、CPU311、RAM(Random Access Memory)312、ROM(Read Only Memory)313、HDD(Hard Disk Drive)314、I/F315、バス318を含む。そして、CPU311、RAM312、ROM313、HDD314、及びI/F315がバス318を介して接続されて構成される。
 更に、管制サーバ31は、表示装置316、及び入力装置317を備え、これらがI/F315に接続される。表示装置316は、ユーザが鉱山内のダンプの走行状況を確認したり、シミュレーション機能を実行する際に仮想車両の追加位置を指定したりするためのユーザインターフェースであり、例えばLCD(Liquid Crystal Display)により構成される。また入力装置317は、ユーザが管制サーバ31に情報を入力するためのユーザインターフェースであり、例えばマウス、キーボードやLCDに積層されたタッチパネル(図示を省略)を用いて構成される。
 更に管制サーバ31のI/F315には、無線通信回線40に接続するためのサーバ側通信装置390が接続される。
 一方、ダンプ20は、図2の(b)に示すように自律走行のための制御処理を行う走行制御装置200と、走行制御装置200からの制御指示に従ってダンプ20を走行駆動するための走行駆動装置210と、ダンプ20の自車両の位置を算出するための位置算出装置220と、ダンプ20の周辺環境を認識するためのミリ波センサ等の車載センサ230と、無線通信回線40に接続するためのダンプ側通信装置240と、を備える。
 走行駆動装置210は、ダンプ20に対して制動をかける制動装置211、ダンプ20の操舵角を変更するための操舵モータ212、及びダンプ20を走行させるための走行モータ213を含む。
 位置算出装置220は、ダンプ20に備えられたGPSアンテナ221(図3参照)からの入力を基に自車両位置を算出する。位置算出装置220はGPSに限定されず、慣性計測装置(IMU:Inertial Measurement Unit)や、地上に設置された基地局からの電波を用いて位置を特定するシステムによるものであってもよい。その場合、ダンプ20は、GPS用のアンテナ221に代わり、そのシステム用のアンテナやジャイロセンサや車輪の回転数を検知するセンサを備える。
 車載センサ230は、ダンプ20の速度や周辺の環境を認識・推定するためのものであり、例えば、路肩検出手段としてのレーザーレーダセンサ231L、231R(図3参照)があるが、これに限らずステレオカメラやミリ波レーダセンサ232でもよい。
 車載センサ230の検知結果は走行制御装置200に出力され、通常時は走行路から離脱しないように走行位置の監視や加減速に用いられ、緊急時には緊急回避行動に必要な制動動作に用いられる。
 走行制御装置200は、CPU201、RAM202、ROM203、HDD204、I/F205、及びバス208を含む。そして、CPU201、RAM202、ROM203、HDD204、及びI/F205がバス208を介して接続されて構成される。更に、走行駆動装置210、位置算出装置220、車載センサ230、及びダンプ側通信装置240が、I/F205に接続される。
 このような管制サーバ31及び走行制御装置200のハードウェア構成において、管制サーバ31及び走行制御装置200の記録装置に格納された自律走行制御プログラムや運搬車両の走行シミュレーションプログラム(ソフトウェア)に読み出され、CPU201、311によって実行されることにより、ソフトウェアとハードウェアとが協働して、管制サーバ31及び走行制御装置200の機能を実現する。なお、ソフトウェアとハードウェアとの組み合わせに限らず、自律走行制御プログラムや運搬車両の走行シミュレーションプログラムの機能を実現する集積回路(ハードウェアのみ)を用いて構成してもよい。
 次に図4及び図5を参照して、管制サーバ31及びダンプ20の機能構成について説明する。図4は、管制サーバの主な機能を示す機能ブロック図である。図5は、ダンプ20の主な機能を示す機能ブロック図である。
 図4に示すように、管制サーバ31は、実際のダンプ20(以後、ダンプ20を「実車両20」と記載する)との実際の無線通信及び仮想車両との仮想通信を行うための制御を行うサーバ側通信制御部310、実車両20及び仮想車両の目的地とそこへ至る走行路を決定し、また相互に干渉しないように交通管制を行う管制制御部320、実車両20と独立して管制制御部320の指示に基づき実車両20と同じ鉱山内を走行する仮想車両の挙動をシミュレーションする仮想車両シミュレーション部330、表示装置316に対する表示制御処理を行う表示制御部340、実車両20が走行する搬送路の地図データを格納するマスタ地図データデータベース(以下データベースを「DB」と記載する)314a、及び実車両20及び仮想車両の其々に対して設定された走行許可区間を格納する区間情報DB314bを備える。上記仮想通信とは、サーバ側通信制御部310との間でデータの出入力を意味する。また、搬送路とは、積込場や放土場、また不図示の駐機場など、実車両20の出発点、終点を結ぶ道路であり、この道路上に形成された実車両20の進行方向に従った車線が走行路に相当する。
 サーバ側通信制御部310は、サーバ側通信装置390に接続されて実車両20との間で実際の無線通信を行うための制御を行うと共に、仮想車両シミュレーション部330(より具体的は後述する仮想車両通信部331)との間で仮想車両の走行シミュレーションに必要なデータの出入力処理(仮想通信)を行う。
 管制制御部320は、配車管理部321、走行許可区間設定部322、及び地図データ生成部323を含む。
 配車管理部321は、実車両20及び仮想車両の目的地を設定し、マスタ地図データDB314aに格納された地図データを参照して現在位置から目的地に至る走行路を決定する。
 配車管理部321の処理例として、例えば実車両20又は仮想車両が駐機場にいる場合には、積込位置を含む積込場の入口を目的として設定する。そして配車管理部321は駐機場から積込上の入口に至るまでの走行路を設定する。この走行路の設定に際し、配車管理部321は、積込位置の移動に伴って動的に走行路を生成してもよい。更に、配車管理部321は、実車両20又は仮想車両が積込位置にいる場合には、積載物の内容によって放土場62、63のいずれかを目的地として設定し、それに至るまでの走行路を生成する。
 走行許可区間設定部322は、実車両20又は仮想車両に対し、マスタ地図データDB314aに格納された地図データを参照し、上記で決定された走行路上の部分区間を実車両20又は仮想車両の走行を許可する走行許可区間として設定し、当該走行許可区間の位置を示す区間情報を生成する。走行許可区間設定部322は、区間情報DB314bに格納された区間情報に対し、新たに生成した区間情報を上書きして更新する。区間情報には、走行許可区間の最前端のノードである前方境界点のノードID、及び最後端のノードである後方境界点のノードIDが含まれる。走行許可区間設定部322は、実車両20又は仮想車両から新たな走行許可区間の設定を要求する情報(以下「区間要求メッセージ」という)を受信すると、これに応じて走行許可区間の設定処理を行う。走行許可区間設定部322は、新たな走行許可区間を設定した際にはその走行許可区間を示す情報(以下「区間応答メッセージ」という)を生成し、出来なかった場合には走行不許可を示す不許可応答メッセージを生成する。
 地図データ生成部323は、実在の走行路を設置する位置を実走して収集した位置座標を基に走行路を規定する実地図データを生成、更新、及び格納する。本実施形態では、実在する走行路を規定する地図情報を実地図データといい、実在しない走行路(仮想の走行路)を規定する地図情報を仮想地図データと称する。地図データ生成部323は、入力装置317から実在する走行路に対して実在しない仮想の走行路を追加する設定操作を受け付けると、実在の走行路及び仮想の走行路の双方を規定する仮想地図データの生成を行う。地図データ生成部323は、実地図データ及び仮想地図データを、マスタ地図情報DB314b及び後述する仮想地図データDB335に格納する処理を行う。
 仮想車両シミュレーション部330は、入力装置317から走行路を仮想的に走行する仮想車両の設定操作を受け付けると、仮想車両の挙動を規定する走行パラメータ及び地図データ(実地図データ及び仮想地図データの双方を含む)を用いて、仮想車両が走行路を仮想的に走行した際のシミュレーションを行い、走行路上の仮想車両の仮想位置や速度、加速度等の走行状態を算出する。このとき、仮想車両シミュレーション部330は、仮想車両に対して設定された走行許可区間に基づいてシミュレーションを行う。例えば、走行許可区間の最前端に近づきつつあるにも関わらず、走行許可区間が設定されない場合には減速、停止の制動指令と、それに従った減速、停止動作をシミュレートする。仮想車両シミュレーション部330は、サーバ側通信制御部310と仮想通信を行うための機能を備えた仮想車両通信部331、仮想通信を介した管制制御部320からの指示(走行許可区間)や仮想車両の仮想位置を基に仮想車両の走行を制御する仮想走行制御部332、仮想走行制御部332の指示に基づき、仮想車両の挙動を規定する走行パラメータを用いて仮想車両の走行シミュレーションを行う走行シミュレーション部333、仮想車両の挙動を基に仮想位置や速度をシミュレーションするセンサシミュレーション部334、及び仮想車両が走行する走行路の情報を格納する仮想地図データDB335を含む。
 仮想車両通信部331は、サーバ側通信制御部310に対して仮想車両の仮想位置や区間要求メッセージを出力するとともに、サーバ側通信制御部310から区間応答メッセージ情報又は不許可応答メッセージを取得する。
 仮想走行制御部332は、センサシミュレーション部334から自車両の現在位置(仮想位置)を取得し、仮想地図データDB335の地図データを参照して、走行許可区間に従って仮想車両を走行させるための制御を走行シミュレーション部333に対して行う。
 走行シミュレーション部333は、あらかじめ設定した仮想車両の車体情報である、車両の重量、加速度、減速度、操舵速度等の性能(走行パラメータ)と、仮想走行制御部332からの制御指令に基づき、仮想車両の挙動(加速、減速、停車)や位置を計算する。走行シミュレーション部333が仮想走行制御部332からの加減速の指示に従って仮想車両の挙動を演算すると、結果的に仮想車両が走行許可区間に従って走行した状態をシミュレーションすることができる。これにより、仮想車両を投入した際に走行許可区間が設定できるかを検証することができる。
 センサシミュレーション部334は、走行シミュレーション部333の計算結果に基づく地図データ上の仮想車両の位置に対して、実際のセンシング誤差を模擬して確率的に誤差を加える補正を行うものであってもよく、あるいはGPS衛星の軌道を計算し、仮想車両の位置においてその時刻に捕捉できるGPS衛星の数や角度を取得し、GPS衛星捕捉状況に応じた誤差を加える補正を行うものであってもよい。これにより、例えば、崖や山影などの影響により、走行路上の各点において測位電波の捕捉状況にばらつきが生じることに鑑みて、運搬車両にGPS及びIMUを搭載し、相互の出力値を補間して運搬車両の位置算出精度の向上を図る場合であっても、仮想車両の位置を実車両で算出される位置により近づけて、シミュレーション結果の精度を向上させることができる。
 またこれに加え、センサシミュレーション部334は、仮想車両の位置と周囲の環境データに基づき、レーザ-レーダセンサやミリ波レーダ、ステレオカメラ等のセンサによるセンシング状況をシミュレーションして、仮想センシングデータを生成し、仮想走行制御部332に計算結果を渡してもよい。
 仮想地図データDB335は、仮想地図データを格納する。仮想地図データの例として、例えば、鉱山の掘削を進めていく計画上で生成予定にある走行路の地図データがある。また地図データは、センサのシミュレーションで使用するための座標位置に応じた周囲の地形などの環境データを含んでもよい。なお、仮想地図データDB335が仮想地図データを格納し、実在する地図データを用いて実車両20を稼働しながら、仮想地図データを仮想車両の走行シミュレーションを行う場合には、マスタ地図データDB314aも仮想地図データを格納する。
 表示制御部340は、実地図データ、仮想地図データ、ダンプ20及び仮想車両の其々の位置、及び各車両に対して設定された走行許可区間の情報を取得し、走行路を示す地図画像上にダンプ20及び仮想車両を示す画像、及び設定された走行許可区間を示す画像を重畳表示する。このとき実際の走行路及び仮想走行路、また、ダンプ20及び仮想車両は、弁別可能に表示態様を変えてもよい。これにより、走行路上の運搬車両及び仮想車両の位置を視認することができ、ユーザが仮想車両を追加した際の動作検証を容易に行える。
 図4では説明の便宜上、表示制御部340は、サーバ側通信制御部310及びI/F315に接続して図示したが、表示制御部340は、管制制御部320や仮想車両シミュレーション部330、またこれらに含まれる構成要素から表示対象となるデータを取得するように構成してもよい。
 管制サーバ31が備えるサーバ側通信制御部310、管制制御部320(配車管理部321、走行許可区間設定部322)、仮想車両シミュレーション部330(仮想地図データDB335を除く)は、これらの機能を実現するソフトウェアが図2に示すCPU311(ハードウェア)により実行されることにより構成される。また、マスタ地図データDB314a、区間情報DB314b、及び仮想地図データDB335は、情報を固定的に格納可能な記憶装置、例えばHDDにより構成される。
 また仮想車両シミュレーション部330は、いくつかのソフトウェアのセットで構成されてもよく、稼働する仮想車両の台数に応じて前述のセットが複数あってもよい。または、一つのソフトウェア上で複数の仮想車両が稼働するものでもよい。あるいは、仮想車両シミュレーション部330は、管制サーバ31と独立して管制センタ30(図1参照)に置かれるコンピュータにより構成し、管制サーバ31とイーサネット(登録商標)ケーブル、あるいは無線通信によって通信接続してもよい。マスタ地図データDB314a、仮想地図データDB335に格納される地図データは、HDD314やマイクロプロセッサ上に格納されたデータとして構成される。
 実車両20に搭載される走行制御装置200は、図5に示すようにダンプ側通信制御部250、要求情報処理部260、自律走行制御部270、及びダンプ地図データDB204aを備える。
 ダンプ側通信制御部250は、管制サーバ31との間で行う無線通信の制御を行う。ダンプ側通信制御部250は区間要求メッセージの送信及び区間応答メッセージ又は不許可応答メッセージの受信を行う。
 要求情報処理部260は、ダンプ地図データDB204aに格納された地図データ及び位置算出装置220(図2参照)が算出した現在位置を基に、実車両20が要求メッセージを送信する地点に到達したかを判断し、要求地点に到達すると要求メッセージを生成してダンプ側通信制御部250を介して管制サーバ31に対して要求メッセージを送信する。
 自律走行制御部270は、位置算出装置220から自車両の現在位置を取得し、ダンプ地図データDB204aの地図データを参照して、区間応答メッセージに含まれる走行許可区間に従って自車両を走行させるための制御を走行駆動装置210(図2参照)に対して行う。また、自律走行制御部270は、車載センサ230の検知結果に基づいて前方障害物の有無を判定し、障害物との干渉、衝突の回避動作の有無も判定し、必要があれば制動動作のための制御を行う。更に自律走行制御部270は、管制サーバ31からの指示に従って、制動装置211に対する駆動制御を行い、減速動作、通常停止動作、又は緊急停止動作を行う。
 ダンプ側通信制御部250、要求情報処理部260、及び自律走行制御部270は、これらの機能を実現するソフトウェアが図3に示すCPU201(ハードウェア)により実行されることにより構成される。ダンプ地図データ204aに格納される地図データは、HDD204やマイクロプロセッサ上に格納されたデータとして構成される。
 次に、図6乃至図8を参照して、実車両及び仮想車両が実際の走行及び仮想走行をする際の管制サーバとの間の処理について説明する。本実施形態では、実車両を実際に走行させながら仮想車両の走行シミュレーションも合わせて行うので、以下の説明では、2台の実車両20-1、20-2と1台の仮想車両70とを走行させた状態を例に挙げて説明する。図6は、実車両が実際に走行する露天掘り鉱山現場の構成例を示す図である。図7は、自律走行開始時における実車両及び仮想車両と管制サーバとの間の通信動作を示す図であって、(a)は実車両から目的地の要求メッセージを送信する状態を示し、(b)は管制サーバからの応答状態を示し、(c)は走行許可区間の要求及び応答状態を示す。図8は、走行許可区間の設定の詳細を示す図であって、(a)は実車両から目的地の要求メッセージを送信する状態を示し、(b)は管制サーバからの応答メッセージを示し、(c)は走行許可区間の要求及び応答状態を示す。
 図6に示す符号61は、ショベル10などの鉱山機械による掘削現場及び鉱山機械がダンプ20に積み込む積込場61を示す。積込場61のうち、ショベル10の周辺にダンプ20が停車し、積込作業が行われる位置を積込位置(図6のLPに相当する)と称する。ショベル10が掘った表土や鉱石は、積込場61で実車両20に積み込まれる。符号62は、表土を展開する放土場であり、積込場61から運び込まれた表土などは、この場所で放土され、層状あるいは放射状に展開される。符号63は鉱石を破砕処理するクラッシャなどが設置された放土場であり、破砕された鉱石はベルトコンベアなどにより貨車による積み出し場あるいは処理設備などに搬送される。
 また、図6のQPは、積込場61への入口であり、かつショベル10からダンプに対して積込位置への進入許可(CALL)がされるまで、ダンプ20が停車して待つ待機位置を示す。図6のEXITは、積込場61からダンプ20が退出する出口である。
 実車両20-1、20-2や仮想車両70は、積込場61で表土や鉱石を積込み、搬送路60を走行してそれらを放土場62や63に搬送する。搬送路60には、走行路64が設定されており、車両20および仮想車両70は、走行路64に沿って走行する。走行路64は、地図上で設定された座標値として与えられる。実車両20-1、20-2は、GPSや他の位置算出装置により特定した自己位置と走行路64の座標値を比較しながら加減速やステアリングを制御することにより、走行路64に沿って自律走行する。
 また、仮想車両70も同様に、仮想走行制御部332がセンサシミュレーション部334により特定した自己位置と走行路64の座標値を比較して走行制御を行い、走行シミュレーション部333が仮想的な車両の走行を計算する。
 また、走行路64上には走行路の区間の境界を示すノード65と、隣接するノード65を接続するリンク66が設けられている。実在する走行路64とノード65、リンク66の情報は、マスタ地図データDB314a、仮想地図データDB335、及びダンプ地図データDB204aに同一の地図データとして格納されている。ただし、仮想車両シミュレーション部330の仮想地図データDB335が仮想の走行路を含む場合は、仮想地図データは、マスタ地図データDB314a及びダンプ地図データDB204aに格納される実地図データよりも多い走行路の情報を含んでもよい。
 管制サーバ31は、管制制御部320によって、隣接する2つのノード65及び1つのリンク66を含む走行区間毎に走行許可の付与・解除を行い、その情報を区間情報として実車両20と仮想車両70に通知する。これにより、実車両および仮想車両同士の衝突を避けるように走行を制御する。また走行路64は区間ごとに制限速度が設けられており、実車両20および仮想車両70はそれぞれダンプ地図データDB204a及び仮想地図データDB335の制限速度情報を参照しながら、適切な速度で走行又は仮想走行する。
 実車両20(以下、仮想車両70についても同様)は、積込場61で表土や鉱石を積み込み完了した状態、あるいは放土場62や63において放土し終わった状態において、実車両20は図7の(a)に示すように管制サーバ31に対して目的地を要求するメッセージ(目的地要求メッセージ)を送信する。これは、実車両20の場合、実車両20の走行制御装置200に含まれる要求情報処理部260が現在の自己位置や車両の状況(停車中)を判断して端末側通信制御部250を介して発信するものである。仮想車両70の場合も同様に、仮想走行制御部332が自車状況を判断して仮想車両通信部331を介して発信する。
 この目的地要求メッセージは、管制サーバ31上のサーバ側通信制御部310により受け取られ、管制制御部320に伝えられる。管制制御部320内の配車管理部321は、区間情報DB314bの区間情報を参照し、他の実車両20及び仮想車両70の状況などを考慮して、目的地を要求してきたダンプトラックの目的地とそこへ至る経路を決定し、目的地80とそこへ至る経路81を示す目的地応答メッセージをダンプトラックへ伝達するようにサーバ側通信制御部310に指示する。サーバ側通信制御部310は、無線通信回線40を介して実車両20に対し目的地応答メッセージを発信する(図7の(b)参照)。
 すると、実車両20上の要求情報処理部260が、走行許可区間の設定要求をするメッセージ(区間要求メッセージ)を管制サーバ31に送信する。サーバ側通信制御部310は、区間要求メッセージを管制制御部320に伝える。管制制御部320の走行許可区間設定部322は、以下に説明する処理に基づいて走行許可区間82を設定し、設定した走行許可区間を示すメッセージ(区間応答メッセージ)を実車両20に送信する(図7の(c))。区間応答メッセージは、走行許可区間の最前端のノードを固有に識別する情報(ノードID)、最後端のノードID、及び走行許可区間に含まれるリンクを固有に識別する情報(リンクID)が含まれる。実車両20は、走行許可区間を得て初めて走行を開始することができる。
 走行路64のどの区間が、どの車両(実車両及び仮想車両の双方を含む)に対して走行許可を与えられているかは、走行許可区間設定部322が走行許可区間の付与及び削除をする度に区間情報DB314bに格納された区間情報を随時更新して管理する。そして走行許可区間設定部322は車両からの走行許可要求があると、区間情報及びマスタ地図データDB314aに格納された地図データを参照して走行許可区間の設定を行う。
 走行許可区間の設定に際し、走行許可区間設定部322は、既に他の車両に対して許可されている区間については、車両からの要求があっても走行許可しないように制御を行うことで、同一の区間内に車両が複数台進入しないようにする。
 一方、車両側では、管制サーバ31から受信した走行許可区間を車両上のマスタ地図データDB314a(仮想車両70の場合は、仮想地図データDB335)に記録し、これを参照しながら自律走行又は仮想走行することで、どこまで走行することができるかを判断する。
 走行許可区間の設定状況は、区間応答メッセージに含まれる最前端ノードID、最後端ノードID、及びそれらの間に位置するリンクIDを走行許可区間に含まれるリンク65を固有に示す固有情報(リンクID)を用いて管理する。管制サーバ31は区間情報DB314bの区間情報に上記最前端ノードID、最後端ノードID、及びそれらの間に位置するリンクID記録するが、管制制御部320の走行許可区間設定部322が一次的に記録することで管理する。また、各車両側については実車両20の場合は自律走行制御部270、仮想車両70の場合は仮想走行制御部332が一次的に最前端ノードID、最後端ノードID、及びそれらの間に位置するリンクIDを記録して、マスタ地図データ314aや仮想地図データDB335には記録しないように構成してもよい。
 新しい走行許可区間が設定されると同時に、既に通過し終えた走行許可区間は解放される。
 次に、走行許可区間の設定の詳細について図8を参照して説明する。図8の(a)において、実車両20-1、20-2は走行中の車両であり、符号81-1、81-2はそれぞれの車両に許可されている走行許可区間である。実車両20-1、20-2は、いずれも矢印Aに示す方向に走行しているものとする。符号83は、実車両20-1の現在位置から走行許可区間81-1の最前端(終端)までの走行路に沿った距離を示す走行許可残存距離である。符号84は、最前端(終端)から実車両20―1が区間要求メッセージの送信を開始する点までの距離を示す走行許可要求開始距離である。
 走行許可要求開始距離84は、実車両が停止可能な距離よりも長い距離であり、例えば停止可能距離に所定のオフセット距離を加えたものである。実車両の停止可能な距離Lは、例えば、車両の積荷を含めた質量をm、車両の現在の速度をv、車両の制動力をf、安全率に対応して規定されるオフセット係数cとすると、下式(1)により求められる。
Figure JPOXMLDOC01-appb-M000001
 オフセット係数cは1以上の値であって、例えば無線通信にかかる時間や無線通信の障害の発生度合いなどを考慮して設定する。車両の速度は、車両の現在速度を車輪の回転数などから測定したものであってもよく、また、車両の現在の走行位置に対して地図データで規定されている制限速度(最大許容速度)を用いてもよい。
 図8の(a)に示すように、実車両20-1の走行許可残存距離83が走行許可要求開始距離84以下となったとき、実車両20-1は、管制サーバ31に対して区間要求メッセージを送信する。この区間要求メッセージには、実車両20-1の現在位置情報も含まれる。
 管制サーバ31は、実車両20-1から区間要求メッセージを受け取ると、送られてきた現在位置情報を用いて実車両20-1が存在する走行区間を特定する。そして、実車両20-1の進行方向に沿って、実車両20-1の存在する区間の終端から予め定められた走行許可区間として与えられる最短距離(走行許可付与長さ)以上となる区間に対して走行許可を与える。但し、他の車両(実車両又は仮想車両)に許可が与えられている区間がある場合には、その手前までについて走行許可を与える。
 図8の(b)に示す例では、実車両20-1が存在する区間は85であり、その終端から走行許可付与長さ90以上の区間は、86、87、88、89となる。但し、区間88、89は既に実車両20-2に走行許可が与えられているので、86、87の走行許可が与えられる。なお、区間86は既に走行許可が与えられているので、この場合、結果として区間87が新たな走行許可区間として与えられることになる。
 走行許可を与えられた区間は、車両がその区間を通過した後に、車両の位置から区間の終端までの距離が走行許可解除距離以上となったときに解除される。図8の(c)の例では、実車両20-1に走行許可が与えられていた区間88は、車両20-2と区間終端までの距離91が走行許可解除距離92以上となった段階で走行許可が解除され、後続の実車両20-1への走行許可割り当てが可能となる。
 次に、本実施形態に係る自律走行システムの動作手順の概略を、図9を参照して説明する。図9は、本実施形態に係る管制サーバを含む自律走行システムの動作手順の概略を示すフローチャートである。
 まず、地図データ生成部323による地図データ生成処理を行う(S901)。地図データ生成処理の詳細については後述する。
 次いで実車両20を必要な台数分稼動させる(S902)。本ステップでは、管制サーバ31により実車両だけの管制制御処理(詳細は後述する)が継続的に行われる。
 仮想車両を混走させてシミュレーションをしない場合(S903/No)、ステップS902へ戻り、管制サーバ31のシミュレーション機能を用いることなく実車両のみを対象とした管制制御処理を続行する。
 仮想車両を混走させてシミュレーションをする場合(S903/Yes)、ダンプ20を実走させた状態で、ユーザは管制サーバ31のGUI(グラフィカルインターフェース:表示装置316及び入力装置317に相当する)を用いて仮想車両を実車両の運行状況に追加する(S904)。
 仮想車両シミュレーション部330により走行シミュレーションを行い、その結果を管制制御部320に出力する。管制制御部320は、実際に走行中の車両(実車両)と仮想車両シミュレーション部330から取得した仮想車両とを混走させて管制制御処理を行う(S905)。ここでの実車両及び仮想車両を混走させた管制制御処理の詳細については後述する。
 ユーザは、仮想車両を削除したい場合(S906/Yes)、削除した仮想車両を指定して削除処理を行う(S907)。仮想車両を削除したい場合とは、例えば、仮想車両を用いたシミュレーション処理を終了して、実車両のみの管制制御処理に戻したい場合の他、複数の仮想車両を加えてシミュレーションを行ったが望ましい結果が得られない場合に、仮想車両の台数を減らして再度シミュレーションを行う場合などがある。その後、ステップS902へ戻る。
 仮想車両を削除しない場合(S906/No)、ステップS905へ戻り、実車両と仮想車両を混走さえて管制制御処理を続行する。
 (地図データ生成処理)
 図10及び図11を参照して、地図データ生成処理について説明する。図10は、地図データ生成処理の流れを示すフローチャートである。図11を参照して地図データの構成例について説明する。図11は、地図データの一例を示す図であって、(a)はリンク情報を示し、(b)はノード情報を示す。以下で説明する地図データ生成処理は、地図データ生成部323を用いて仮想地図を生成し、仮想車両を用いた走行シミュレーション経てマスタ地図データDB314aに実地図データとして格納する処理である。
 まず、地図データを生成するに当たり、GPSを搭載した車両で新たに追加する走行路を有人走行し、その結果に基づき、地図データを生成するためのセンサデータを収集する。GPSを搭載した車両は、例えば地図を生成するためのデータ収集専用の車両(航測車)でもよいし、自律走行ダンプトラックを地図計測モードに設定し、ダンプに搭載されたGPSを用いて位置情報を収集しながら有人走行を行ってもよい。またGPS以外にも、レーザレーダなどのセンサを用いて周囲の地形形状を計測するようにしてもよい。
 次いで地図データ生成部323は、収集したセンサデータを用いて地図データを生成する(S1001)。この処理は例えば、時系列の座標点列からクラスタリングを行い、搬送路の形状に応じて適切な間隔でノードを生成し、走行路を生成するような処理であってもよい。地図データ生成部323は、生成した地図データを仮想地図データDB335に格納する。この地図データは仮想地図データに相当する。
 地図データは、走行路上のノードとそのつながりを示すリンクで表されている。図11の(a)に示すように、地図データにはリンクを識別するためのリンクID1101とそのリンクが始まる座標にあるノードID1102、リンクの終わる座標にあるノードID1103、リンク始点に接続される別のリンクID1104(複数存在する場合もある。)、及びリンク終点に接続される別のリンクID1105(複数存在する場合もある。)を規定するテーブルがある。更に図11の(b)に示すように、ノードID1106に対応する座標値1107、その属性1108のテーブルが存在する。このノードIDのうち、いずれかを積載地点もしくは放土地点として属性1108に設定されている。
 仮想地図データが生成されると、仮想走行制御部332は仮想地図データDB335に格納された仮想地図を参照し、走行シミュレーション部333に対して仮想地図に沿って仮想車両(第一の仮想車両に相当する)を走行させるシミュレーション処理を実行させ、ダンプトラックのモデルが、生成した走行路データに適切に追従できることを確認する(S1002)。これは、例えば生成した走行路のカーブがきつ過ぎて車両が旋回し切れなかったり、ノードの間隔が不適切なために管制制御がうまくいかなかったりといった不具合がないことを確認するために必要である。この確認の際のシステム構成としては、管制サーバ31に対し仮想車両1台でもよいし、複数台を同時に管制する形でもよい。また、鉱山内の地図更新に関係のないエリアについては、既存の搬送路や既存の実車が稼働し続けるような構成としてもよい。仮想車両のシミュレーションが正常に行えると、地図データ作成部323は、検証した仮想地図をマスタ地図データDB314aに実地図データとして格納する。
 管制制御部320はマスタ地図データDB314aに格納された実地図データを参照しながら、自律走行ダンプトラックの実車両1台を走行させ、地図データと実際の搬送路が一致しているかを確認する(S1003)。地図データを生成する際、例えばGPSによるデータ取得では、その時の衛星配置や周囲の地形による遮蔽により、データに誤差が乗る場合がある。またソフトウェアで走行路を生成する処理によっても、誤差が乗ってしまう場合がある。もちろんそのようなことのないように、正しい走行路を生成するような地図データ生成ソフトウェアとすることが望ましいが、信頼性を完全に保証することは難しく、動作確認は必要である。実車両1台で走行する際には、万が一走行路のデータが搬送路上の正しい位置から外れていたとしても、例えばレーザレーダによる路肩検出機能によって、走行路の位置が正しくないことを検出することができる。
 走行路の位置が正しくないことが判明した場合(S1004/No)、もう一度GPSデータ等の収集、地図データ生成を行う(S1001)。
 実車両1台で走行路に対する実地図データの正しさを確認できたら(S1004/Yes)、稼働させたい必要な台数と同数の仮想車両(第二の仮想車両に相当する)を実地図データに基づく走行路に沿って仮想的に走行させて走行シミュレーションを行う(S1005)。この段階において、例えば合流地点や狭路など、実車両複数台での稼働では衝突の懸念がある地点が残っていないかを検証する。
 複数台のシミュレーション結果が良好(実車両の走行が可能)であれば(S1006/Yes)、地図データ生成処理を終了する。複数台のシミュレーション結果の結果が不良(実車両の走行に支障がある)であれば(S1006/No)、ステップS1001へ戻り、再度地図データの生成を行う。
 本実施形態によれば、仮想地図データを生成すると仮想車両を用いたシミュレーション結果が良好な場合に、仮想地図データを実地図データとして採用することができる。これにより、実車両を走行させるための実地図データとしての適性を検証することでき、地図データ生成時の車両の動作確認を行うことで、鉱山の地形変化に対して安全に対応することができる
 更に、実地図データを用いて運搬車両を稼働させた後に、新規の運搬車両を追加したいという要望が生じることがあるが、その場合も実際に運搬車両を稼働させた状態に、仮想車両を追加して走行許可区間の設定の可否を検証できる。またこの検証に際して、運搬車両を稼働させた状態を維持できるので、運搬車両の稼働停止に伴う鉱山の生産性の低下を抑制することができる。
 また本実施形態では、実車両の管制制御を行う管制サーバにシミュレーション機能を実装することにより、外部にシミュレーション機能を備えたソフトウェアを用意することなく、仮想車両を利用して素早く動作確認を行うことができる。
 (実車両だけの管制制御処理)
 次に図12を参照して実車両だけの管制制御処理について説明する。図12は、実車両だけの管制制御処理の流れを示すフローチャートである。なお、図12では、実車両20の走行制御装置200及び管制サーバ31で実施される処理の流れを示すが、実車両に対する管制制御処理と仮想車両に対する管制制御処理とは同様の処理であるため、走行制御装置200及びその構成要素を仮想車両シミュレーション部330及びその構成要素に読みかえることで、仮想車両の管制制御も行える。以下、図12の各ステップ順に沿って説明する。
 まず、実車両20の目的地が設定されていない場合(S1201/No)、走行制御装置200の要求情報処理部260は、無線通信回線40を介して管制サーバ31に目的地要求メッセージ(現在位置情報を含む)を送信する(S1202)。実車両20の目的地が設定されている場合(S1201/Yes)は、ステップS1204へ進む。
 管制サーバ31の配車管理部321が実車両20の現在位置情報とマスタ地図データDB314aの実地図データを参照して目的地を設定し、その結果を示す目的地応答メッセージを実車両20に対して送信する(S1203)。実車両20の目的地が設定されている場合は(S1201/Yes)、ステップS1204へ進む。
 区間要求メッセージの送信が必要な場合、例えば実車両20は走行許可区間が設定されていない場合、または現在の走行許可区間から走行許可残存距離が走行許可要求開始距離以下である場合(図8の(a)参照、S1204/Yes)は、要求情報処理部260から区間要求メッセージを送信する(S1205)。
 区間要求メッセージの送信が不必要な場合、即ち、既に走行許可区間が設定されており、走行許可残存距離が走行許可要求開始距離より長い場合(S1204/No)や、区間要求メッセージを受信した場合、自律走行をする(S1206)。
 実車両20は区間要求メッセージを送信後、現在付与されている走行許可区間に従って走行を続けながら、管制サーバ31からの区間応答メッセージの受信を待機する。実車両20は走行中に定期的に現在位置を管制サーバ31に送信する。自律走行制御部270は、位置算出装置220からの現在位置とダンプ地図データDB204a、及び現在付与されている走行許可区間とを比較し、走行許可残存距離が停止可能距離以下である場合(S1207/Yes)、走行許可区間内で停止するように走行駆動装置210の制動装置211に対して制動指示を行い、実車両20が減速を開始する(S1208)。
 管制サーバ31は区間要求メッセージを受信すると、走行許可区間設定部322が実車両20の現在位置及びマスタ地図データDB314aに格納された地図情報に基づいて、走行許可区間を設定し、その内容を示す区間応答メッセージを実車両20に対して送信する(S1209)。走行許可区間設定部322は、受信した車両の現在位置と区間情報DB314bの区間情報を用いて、車両の進行方向に対して車両の存在する区間の終端から走行許可付与長さ以上となる区間について、他の車両に許可が与えられていない限り、あるいは他の車両に許可が与えられている区間がある場合はその手前までについて走行許可区間として設定する。更に走行許可区間設定部322は、どの区間に走行許可区間を設定したかを示す情報を区間情報DB31bに格納されている区間情報に追加する。
 実車両20は、区間応答メッセージを受信すると(S1210/Yes)、区間応答メッセージに示される新たな走行許可区間に従って走行を開始する(S1211)。実車両20が、区間応答メッセージを受信しない場合、ステップS1205へ戻る(S1210/No)。区間応答メッセージを受信しない場合とは、例えば通信エラーにより区間要求メッセージが管制サーバ31に届いていない、また区間応答メッセージが実車両20に届いていない場合がある。
 走行許可区間設定部322は、実車両20の現在位置から区間の終端までの距離が走行許可解除距離以上となると(図8の(c)参照、S1212/Yes)、走行許可区間の設定を解除する(S1213)。走行許可区間設定部322は、区間情報から解除した走行許可区間を示す情報を削除する。その後ステップS1201へ戻る。また、走行許可区間設定部322は、実車両20の現在位置から区間の終端までの距離が走行許可解除距離未満の場合(S1212/No)、走行許可解除距離以上となるまで解除せずに、ダンプが走行する(S1212)。
 (実車両及び仮想車両を混走させた管制制御処理)
 次に図13乃至図15を参照して、実車両及び仮想車両を混走させた管制制御処理について説明する。図13は、実車両及び仮想車両を用いてシステム動作検証を行う際の、管制制御装置と自律走行ダンプトラックと仮想車両の関係を説明するための図である。図14は、実車両及び仮想車両に対して設定された走行許可区間の情報を格納する区間情報の例を示す図であって、(a)は、仮想車両(ID:V01)が待機位置で待機中の状態における区間情報例を示し、(b)は、(a)から仮想車両(ID:V01)が1動作(1フェーズ)遷移した状態における区間情報を示す。図15は、実車両及び仮想車両を混走させて管制制御処理の流れを示すフローチャートである。
 図13では、現在5台の実車両20-1、20-2、20-3、20-4、20-5が稼働している鉱山において、新たに3台の自律走行ダンプトラックの導入を検討している場合を想定する。新規車両を導入する理由としては、例えば搬送路の長さ・制限速度から見てダンプトラックの数が少なく、積込場においてショベルが1台のダンプトラックに積み込みをしてから、次のダンプトラックが到着するまでの時間が長いために、ショベルがダンプトラックを待つ時間が発生し、生産効率が低い、といったことが挙げられる。このような場合、新規にダンプトラックを追加することで搬送路に対するダンプトラックの密度を上げ、ショベルの待ち時間を減らして生産効率を上げることができる。
 しかしながら、実際に新規車両を導入した場合に、全ての車両が効率よく動作できることは簡単には保証できない。それは、実環境における天候・気温・路面状況などといった様々な外乱要素があり、車両の走行速度に影響を与えることや、各車両が走行許可区間に基づき自車の前方車両に衝突しないように走行しており、あまりに搬送路に対する車両密度が高すぎる場合、減速と加速を繰り返すような走行をしてしまうといった理由からである。また一方で、ダンプトラックは非常に高価であり、このような懸念がある限り安易に新規車両の導入を決断することは難しい。
 この解決策として、新規車両を導入した場合に上記のような問題が起こらないかを、本発明で提案する仮想車両を用いて検証することができる。ここでは、新規に導入する計画の3台の自律走行ダンプトラックの動作を、仮想車両70-1、70-2,70-3でシミュレーションする。
 このシミュレーションに際して、自律走行システム1は、図13に示すように管制サーバ31に対して5台の実車両20-1~20-5のそれぞれが実際に無線通信接続され、3台の仮想車両70-1~70-3のそれぞれが仮想通信接続(サーバ側通信制御部310を介して仮想車両シミュレーション部330及び管制制御部320の間のデータの出入力)される。仮想車両70-1~70-3の実体は、仮想車両シミュレーション部330上のデータであり、前述の通り、管制サーバ31上で動作する。実車両及び仮想車両にはそれぞれ重複の無いように車両IDが割り当てられており、管制サーバ31は車両IDによって通信を行う対象の車両が実車両であるか仮想車両であるかを判別することができる。
 図14の(a)に実車両及び仮想車両に対して設定された走行許可区間の情報を格納する区間情報の一例を示す。図14の(a)のR01~R05は実車両を固有に識別する車両ID1401であり、V01は仮想車両を固有に識別する車両ID1401である。図14では走行許可区間を示す情報として、走行許可区間の最前端に位置するノード(前方境界点)、及び最後端に位置するノード(後方境界点)を格納する。また図14の(a)では説明の便宜のため各車両の稼働状態を記載しているが、稼働状態を示す情報はノードIDをキーレコードにして図11の(b)に示すノードの属性情報と関連付けることにより不要となる。以下図14の(b)、図22、図23の(a)、(b)についても同様である。
 管制サーバ31と実車両、および仮想車両は全く同じフォーマットで、車両IDを始めとし、走行許可区間を表すノードやリンクのIDや実車両、仮想車両の其々の位置情報(地図上のどこに存在するか)等の情報を通信し合うことができる。このような構成において、後述する図15に示す管制制御処理を実施することにより、実車両と仮想車両とが互いに衝突することのないように走行許可区間を設定する。その結果、新規の実車両を導入する前に仮想車両を用いてあらかじめ導入後の動作を検証することができる。
 次に図15の各ステップ順に沿って実車両と仮想車両とを混在させた管制制御処理について説明する。
 管制サーバ31の走行許可区間設定部322は、実車両20、即ち要求情報処理部260(図5参照)からから走行許可要求があったか(S1501/Yes)、又は仮想車両70、即ち仮想走行制御部332から走行許可要求があったかどうかを判定する(S1501/No、かつS1502/Yes)。どちらからも走行許可要求がない場合(S1502/No)は、処理をせず要求を待ち続ける。
 走行許可区間設定部322は、いずれかの車両から走行許可要求があった場合(S1501/Yes、S1502/Yes)、以下の処理を実行する。実車両と仮想車両の優先順位は逆でもよく、また特に区別せずにいずれかからの走行許可要求の有無を判定してもよい。以下、実車両と仮想車両を含む概念として、車両という言葉を用いる。走行許可区間設定部322は、車両から走行許可要求があったら、既述のステップS1208と同様、受信した車両の現在位置と区間情報DB314bの情報を用いて、車両の進行方向に対して車両の存在する区間の終端から走行許可付与長さ以上となる区間について、他の車両に許可が与えられていない限り、あるいは他の車両に許可が与えられている区間がある場合はその手前までについて走行許可区間として設定する処理を実行する(S1503)。
 この処理において、車両が現在存在する走行区間のすぐ隣の区間が他の車両に許可されているなどして、走行許可区間設定部322は走行許可区間を設定できない場合(S1504/No)、走行許可区間が設定できなかったことを示す不許可応答メッセージを生成・車両に送信又は出力してS1501へ戻る。
 走行許可区間設定部322は、走行許可区間を設定できた場合は(S1504/Yes)、その走行許可区間を示す区間応答メッセージを作成し、車両に送信または出力する(S1505)。
 また、走行許可を与える区間に合流する区間がある場合、走行許可区間設定部322は、その区間を同一の車両に対する走行許可区間として設定し、区間情報に格納する(S1506)。また、走行許可を与える区間と交差する区間がある場合、走行許可区間設定部322は、その区間を同一の車両に対する走行許可区間としてマスタ地図データDB314a上に設定する(S1507)。これらの処理は、合流点又は交差点に他の車両が進入し、走行許可区間の設定対象となった車両と干渉することを防ぐための処理であり、走行許可区間の設定対象となった車両に対しては、車両の進行方向に沿った走行許可区間だけを通知すればよいので、本ステップで設定した走行許可区間は区間応答メッセージに含まず、管制サーバ31の処理に完結する。
 走行許可区間設定部322は、ステップS1212と同様、車両の現在位置から既に通過した走行許可区間の終端までの距離が走行許可解除距離以上になると、通過した区間の走行許可を解除して区間情報を更新する(S1508)。
 図14の(b)は、各車両が前進して、走行許可区間が再設定された状態を示す。例えば、図14の(a)では実車両(R01)に対してnode_1からnode_2までが走行許可区間として設定されているが、実車両(R01)がnode_1を通過後、node_1からnode_2が開放される。そして図14の(b)では実車両(R02)に対してnode_1からnode_2が走行許可区間として設定される。
 実車両20及び管制サーバ31は以上の処理を繰り返す。この繰返処理の過程において、仮想車両に設定された走行許可区間に従って走行路を走行した際の挙動や位置を含む走行状態のシミュレーションが行われ、その結果(特に仮想車両の位置)が走行許可区間設定部に返される。
 走行許可区間設定部322は、要求を行った車両が自律走行ダンプトラックであるか、仮想車両であるかを特に区別せずに、即ち両車両に対して同一の処理で走行許可区間の設定をする。またこれにより、現実に走行する自律走行ダンプトラックと、シミュレーション上の仮想車両についても、互いに衝突を防止するように管制制御される。
 次に、図16を参照して単一の搬送路の鉱山にて実車両と仮想車両が混走する場合について、管制サーバ31のユーザインターフェース12の表示装置に表示される画面を説明する。図16は仮想車両の設定入力画面の一例を示す図である。図16の画面1601には、鉱山内の積込場61、放土場62と、それらを結ぶ搬送路60とを含む地図画面1602が表示される。走行許可区間設定部322は、表示装置316(図2参照)に画面1601を表するための制御も行う。本図では明示しないが、搬送路上には、座標データとして走行路と、その区間を表すためのノードが設定されている。走行許可区間設定部322は、マスタ地図データDB314aの地図データに実車両20及び仮想車両70の位置及び区間情報DB314bに格納された走行許可区間を重畳表示することにより、地図画面1602を生成・表示する。また、運搬車20と仮想車両70とは表示態様を変えて地図画面に重畳表示される。
 図16では、鉱山エリア内において、実車両20-1~20-5の5台と、仮想車両70-1~70-3の3台とが、それぞれ管制サーバ31から指示された走行許可区間81-1~81-8に従って混走している。
 仮想車両を追加する際の処理について説明する。画面1601には、仮想車両アイコンを表示するツールボックス1603を表示する。ユーザがマウスカーソル1604により仮想車両アイコンを搬送路60上において、走行許可区間が未設定の位置にドラッグする。
 また、画面1601に、ノードIDの入力欄1605を設けてもよい。ユーザが入力欄1605にノードIDを入力すると、そのノードIDのX座標1606、Y座標1607を仮想走行制御部332が地図データを参照して表示し、その位置に仮想車両のアイコンを表示してもよい。
 仮想車両アイコンが地図画像に重畳表示された状態で、実行ボタン1608が操作されると、仮想走行制御部332及び走行シミュレーション部333を含む仮想車両シミュレーション部330が処理を開始する。
 上記の例では、実車両5台に対して仮想車両3台を加える構成としたが、実車両・仮想車両のそれぞれの台数は、管制サーバ31の計算処理性能、あるいは通信手段の性能を越えない限り、任意に設定可能である。
 本実施形態によれば、実際に走行中の実車両の位置及び仮想車両の仮想位置を基に、運搬車両及び仮想車両に走行許可区間を設定するので、実車両を走行させながら仮想車両を追加した際の走行許可区間の設定可否の検証を行うことができる。またこの検証に際して、実車両を稼働させた状態を維持できるので、実車両の稼働停止に伴う鉱山の生産性の低下を抑制することができる。
 <第二実施形態>
 第二実施形態は、既存の地図データに、新たな走行路を追加するための検証を行う実施形態である。以下、図17乃至図19を参照して第二実施形態について説明する。図17は、仮想走行路を追加するための画面表示例である。図18は、第二実施形態の処理の概要を示すフローチャートである。図19は、仮想走行路追加処理の詳細を示すフローチャートである。
 鉱山は、掘削が進むにつれて鉱石のある掘削場所が変化し、ショベルが掘削・積込みを実施する積込み場の位置も変化する。一般的に露天掘り鉱山においては、すり鉢状に掘削を進め、次第に深い位置での掘削を行うようになる。この掘削位置を変更する際、合わせてそこに至るまでの搬送路も生成しなければならない。自律走行ダンプトラックは、地図データを基にして自律走行を行うため、新しく生成した搬送路に対しては、合わせて地図データを生成する必要がある。また、生成した地図データは、そのデータに基づいて走行することで実際の搬送路を正しい位置で走行できるかどうかについてもあらかじめ確認し、システムの正常動作を確認する必要がある。そこで、本実施形態ではダンプを稼働させている状態を維持しつつ、新たな走行路を追加した場合の走行シミュレーションを行う。
 図17に仮想走行路追加処理で表示される画面表示例を示す。図17の画面1702は、計画中の搬送路を含む鉱山にて実車両と仮想車両が混走する場合において、実際の走行路に仮想走行路を追加した際に管制サーバ31の表示装置316に表示される画面である。実際の走行路と仮想走行路とは表示態様を変えて表示される。画面1702は、図16で説明した積込場61、放土場62、搬送路60の構成に加え、新たに仮想の積込場68を設けている。放土場62は積込場61、68からの運搬の共通の放土場とする。また、搬送路60から分岐して仮想の搬送路67を設け、積込場68にアクセスできるようにしている。5台の自律走行ダンプトラック20-1~20-5は、もともとある積込場61と放土場62の間を往復し、3台の仮想車両70-1~70-3は仮想の積込場68と放土場62の間を往復する。
 この仮想地図データ(積込場68及び搬送路67)を含む鉱山エリア内において、自律走行ダンプトラック20-1~20-5、仮想車両70-1~70-3は、それぞれ管制サーバ31から指示された走行許可区間81―1~81-8に従って走行する。
 次に図18を参照して第二実施形態に係る処理の概要について説明する。なお図18の各処理において第一実施形態(図9の各ステップ)と同処理については同じステップ番号を付け、重複説明を省略する。
 図18に示すように、地図データ生成処理を行い(S901)、仮想の走行路を追加しない場合は(S1801/No)、第一実施形態と同様、ステップS902~S907の処理を行う。
 生成された地図データに対して仮想の走行路を追加する場合(S1801/Yes)、仮想走行路追加処理を行う(S1802)。ここでいう仮想走行路追加処理とは、鉱山内に既に走行路が設定されている状態で、実際には存在しない搬送路や積込場、放土場の形状を設定する処理である。
 仮想走行路追加処理では、図19に示すように、まず、地図データ生成部323が、例えば管制サーバ31に外付けされた記憶装置から仮想地図設定の際に用いる鉱山の航空写真などの参考データと、既存の地図データ(マスタ地図データDB314aからでも仮想地図データDB335のどちらに格納されたものでもよい)を読み込む(S1901)。参考データは、写真に限らず開発計画の鉱山地形の情報を持つCADデータなどでもよい。地図情報作成部323は、表示装置316の画面にこれらデータに基づく地図画像を表示する。地図画像には、航空写真等を用いた地形情報に、マスタ地図データDB314a等に格納された地図データを重畳表示してもよい。
 ユーザは入力装置317を用いて地図画像上に既存の走行路に対して追加する仮想走行路のノード座標をプロットする(S1902)。プロットされたノード座標は地図情報作成部323が格納する。
 ユーザは入力装置317を用いてプロットしたノード間の接続関係を設定する(S1903)。例えば、1つのノードをクリックした後でそれに接続したいノードをクリックすることで設定してもよいし、2つのノードを選択して実行処理をすることで設定してもよい。またこの時、既存の地図データが含むノードから搬送路を分岐する場合は、既存の地図データとの接続関係を設定してもよい。
 ユーザは入力装置317を用いてプロットしたノードのパラメータを設定する(S1904)。これにより、プロットしたノードに積込み地点や放土地点などの、車両に指示を与えるための属性(図11の符号1108に相当)を持たせる。
 最後に、地図データ生成部323は、生成された地図データを仮想地図データDB335及びマスタ地図データDB314aに格納する(S1905)。このとき、実在しない(仮想の)ノード及びリンクは、実在するノード及びリンクとは弁別可能なデータとして定義する。例えば、車両IDと同様、実在するノードID、リンクIDと仮想のノードID、リンクIDに両者を区別可能な文字を加えておき、シミュレーション走行において走行許可区間を設定する際、実車両は実在するノードIDだけを用いて走行許可区間を設定し、仮想車両は実在するノードID及び仮想ノードIDの両者を用いて走行許可区間を設定する。
 上記で格納された地図データはあくまで仮想の走行路の情報であり、実際に開発した搬送路等における走行路のデータは改めてGPSやレーザレーダ等のセンサによって、定められた地図生成の処理手順で生成する必要がある。
 仮想走行路追加処理S1802を行ってから仮想車両と実車両とを混送させる管制制御処理では(図18のステップS905)、走行許可区間設定部322が区間情報の車両IDとノードID、リンクIDを基に仮想車両は仮想地図データを参照して仮想走行路に走行許可区間を設定し、実車両に対しては実地図データを参照し、実在する走行路上に走行許可区間を設定する。
 なお、ダンプ地図データDB204aは、実地図データのみを記憶しており、自律走行制御部270は位置算出装置220の位置データと実地図データとを比較しながら走行制御し、両者が一致しない場合は停車するので、仮想走行路上に実車両が迷い込むことは回避できる。
 本実施形態によれば、実車両は実際の走行路に設定された走行許可区間に従って走行し、仮想車両は仮想の走行路に設定された走行許可区間に従って走行するので、実車両が仮想の走行路に間違って侵入することがない。そして、既存の搬送路に加え、実在しない搬送路等における走行路を事前に想定して仮想の地図データを生成し、それに基づいて実車両と仮想車両が管制制御に基づき走行するようなシステム構成とすることにより、開発計画中である搬送路を実際に開発し、新規車両を導入した場合の管制制御、および既存の実車両の動作を事前に確認することが可能となる。
 <第三実施形態>
 第三実施形態は、自律走行ダンプトラックの実際の走行データ、又はユーザからの入力操作に基づき仮想車両の走行モデルを修正する実施形態である。以下図20及び図21を参照して第三実施形態について説明する。図20は、第三実施形態に係る管制サーバ31の機能ブロック図である。図21は、第三実施形態で表示される画面表示例である。
 図20に示すように、管制サーバ31は、第一実施形態の管制サーバ31の構成に加え、走行中の実車両から受信した当該運搬車両の走行データを用いて、仮想車両の挙動が実車両の挙動と一致するように、走行パラメータを修正する走行パラメータ修正部350を更に備える。走行パラメータとは、仮想車両の挙動に影響を与えるパラメータであって、例えば、車両の重量、加速度、勾配、路面の摩擦係数μ等を修正する。摩擦係数μの設定は、その点における車輪の回転数とトルクとを用いて設定する。
 実車両20は、走行中に車載センサ230により検出した車両の座標に応じた速度や加速度、傾き、荷重センサのデータなどを一時的に記録する走行データ格納部(不図示)を備える。車両20は、走行中に車載センサ230からの出力を、無線通信回線40を介して送信する。
 走行パラメータ修正部350は、センサの値を受信し、その値を基に仮想車両70が自律走行ダンプトラック20と異なる走行の仕方をする地点を特定し、その地点における勾配や車両の加速度から、仮想車両70がより実際の車両に近い挙動になるよう、仮想車両の走行パラメータを算出する。そして、走行シミュレーション部333の走行パラメータを算出値に修正する。これにより、仮想車両の挙動を走行中の実車両の挙動により近づけることができ、シミュレーション結果の信頼性をより高くすることができる。
 また、走行モデルの他の修正例として、入力装置317からユーザが走行パラメータを入力できるように構成してもよい。図21に、走行パラメータの入力画面例を示す。図21の画面2101は、車両スペックを規定するパラメータの入力画面を示す。車両スペックのうち、仮想車両の挙動に影響を与えるパラメータ例として、車体重量、最大積載量、ホイールベース、最小回転半径を例示したが、走行パラメータはこれに限定されない。例えば、加速度、減速度(制動量)、操舵速度などがあってもよい。走行シミュレーション部333は、画面2101から走行パラメータが入力され、実行ボタン2102が操作されると、走行シミュレーション部333で用いる走行パラメータを入力値に更新する。そして、走行シミュレーション部333は入力値を用いて仮想車両の走行シミュレーションを行う。その際も、実車両20から受信したセンサ値に基づいて、走行路の状態に由来するパラメータ、例えば路面の勾配や摩擦係数を随時修正してもよい。
 また、路面の摩擦係数を規定する走行パラメータ、例えば車輪回転数やトルクは、走行路のノード、リンクごとに異なるので、ノードIDやリンクIDを指定して走行パラメータを設定できるように構成してもよい。
 図21の例では、仮想車両の走行パラメータをユーザが設定したり、修正したりすることができ、所望する性能、構造の走行シミュレーションが行える。例えば、実車両と同じ性能、構造を示す走行パラメータを設定すると、実車両と同じ車種の車両を追加した際の走行シミュレーションが行える。また、実車両とは異なる走行パラメータを設定すると、実車両とは異なる車種の車両を追加した際の走行シミュレーションが行える。
 <第四実施形態>
 本実施形態は、仮想車両シミュレーション時において仮想車両が特定の動作、例えば積込場において待機動作、走行動作、及び積込位置での停車動作をしているときを瞬時に終わらせたように処理を行う(スキップ処理を行う)実施形態である。以下、図22及び図23を参照して第四実施形態について説明する。図22は、仮想車両に対して積込場において設定される走行許可区間を時系列に沿って記載した区間情報の例である。図23は、仮想車両をスキップ処理した際の区間情報の例を示す図であって、(a)はスキップ処理のみを行った状態を示し、(b)はスキップ処理時にタイムラグ調整処理を行った状態を示す。
 走行許可区間設定部322はスキップ処理をしない場合では、実車両と同スペックの仮想車両に対して、図22に示すように、「フェーズ1:待機位置で待機中」、「フェーズ2;待機位置での待機から積込位置に向かって走行中」、「フェーズ3:積込作業中(停車中)」、「フェーズ4:積込位置から出口に向かって出発中」、「フェーズ5:出口から放土場に向かって走行」するための走行許可区間を実車両に対する動作と同様のタイミングで設定する。
 しかし、仮想車両に対し、図22に示す各走行許可区間を実車両と同じ時間を空けて設定すると、例えば積込作業中は実際にはショベルが稼働できずに鉱山の生産性が低下する。
 そこで、走行許可区間設定部322は仮想車両に対しては、例えばフェーズ1,2,3は瞬時に終了したものとし、フェーズ1からフェーズ4にスキップさせ、フェーズ1の走行許可区間を設定した後、フェーズ4の走行許可区間を設定してもよい(図23の(a)参照)。
 但し、図23の(a)に示すように、仮想車両の前に位置する車両との関係上、フェーズ4にスキップした場合、直前車両の位置を飛び越えてしまう場合がある(図23の(a)の車両ID:V01、R04参照)。この場合、実車両と仮想車両との前後関係が変わり、走行シミュレーションの正確性に支障をきたすことがある。
 そこで、管制サーバ31にタイマーを備え、走行許可区間設定部322は、スキップ処理に際して仮想車両が直前車両(特に実車両)を飛び越さない時間を計測してから、スキップ処理を行うように構成してもよい。図23の(b)は、仮想車両(V01)の直前の実車両(R04)が積込場の出口から退出してから、仮想車両(V01)のスキップ処理を行った際の区間情報を示す。この区間情報では、仮想車両(V01)と直前の実車両(R04)との前後関係が維持される。走行許可区間設定部322は、計時処理に代わり、直前の実車両(R04)から受信する現在位置が出口を退出したことを確認して、スキップ処理を実行してもよい。
 仮想車両が積込場において待機動作、走行動作、及び積込位置での停車動作をしているときは、実車両は積込場への走行が許可されない。そのため、仮想車両が積込場に長時間存在することは、実車両の妨げとなり、生産効率の低下を招く。ここで、本実施形態によれば、仮想車両が上記の動作に要する時間を実車両の動作時間よりも短くすることで、積込機が稼働できない時間をより短縮し、シミュレーションに伴う鉱山の生産効率の低下を抑止することができる。
 上記各実施形態は、本発明の実施態様の一例を示すにすぎず、本発明を限定するものではない。実施形態には上記に記載したもの他、本発明の要旨を変更しない範囲で様々な変形例があり、それらも本発明に含まれるものである。
 例えば、図16の仮想車両を追加するGUIでは走行路上に仮想車両を追加したが、仮想車両を追加する操作を行うと、予め決められた出発点、例えば駐機場から仮想車両が出発するように構成してもよい。
 また第四実施形態のスキップ動作例として積込動作に関するものを例示したが、放土動作に関連する動作をスキップしてもよい。
 更に、図16、図17の表示画面において、走行許可区間が設定できない状況が生じると警告表示を行うようにしてもよい。この場合も、仮想車両及び直後の後続車両(実車両、及び仮想車両を含む)に対して上記状況が生じた場合に限定してもよい。これにより、仮想車両を追加したことに起因する走行許可区間設定不可な状況が把握しやすくなり、自律走行システムの動作検証に好適な表示画面を提供できる。
1:自律走行システム
20、20-1、20-2:自律走行ダンプ(実車両)
31:管制サーバ(管制制御装置)
70、70-1、70-2:仮想車両

Claims (9)

  1.  鉱山の構内を予め定められた走行路に沿って自律走行する運搬車両の走行制御を行う管制制御装置であって、
     実在する走行路を規定した実地図データを記憶する地図データ記憶部と、
     前記走行路を仮想的に走行する仮想車両の走行パラメータを設定する設定操作を受け付ける入力部と、
     前記仮想車両の挙動を規定する走行パラメータ及び前記実地図データを用いて、前記仮想車両が前記走行路を走行したと仮定した際の走行状態のシミュレーションを行う仮想車両シミュレーション部と、
     前記運搬車両における実車両と通信を行うことにより、前記走行路を自律走行中の前記実車両の位置情報を受信する通信部と、
     前記実車両の位置情報、前記実地図データ、及び前記仮想車両の走行状態に基づいて、前記実車両及び前記仮想車両の其々に対し、各車両の走行を許可する前記走行路の部分区間からなる走行許可区間を設定する走行許可区間設定部と、を備え、
     前記通信部は、前記実車両に対し、当該実車両に対して設定された走行許可区間を送信し、前記仮想車両シミュレーション部は、前記仮想車両に対して設定された前記走行許可区間に従って前記走行路を走行した際のシミュレーションを行い、前記仮想車両の走行状態を更新する、
     ことを特徴とする管制制御装置。
  2.  走行路を規定する地図データを生成する地図データ生成部を更に備え、
     前記入力部は、前記実在する走行路に接続する、実在しない仮想の走行路を追加する設定操作を更に受け付け、
     前記地図データ生成部は、前記実在する走行路及び前記仮想の走行路を規定する仮想地図データを生成し、
     前記地図データ記憶部は、前記仮想地図データを記憶し、
     前記走行許可区間設定部は、前記仮想地図データに基づいて、前記運搬車両に対する走行許可区間は、前記実在する走行路に設定し、前記仮想車両に対する走行許可区間は、前記実在する走行路及び前記仮想の走行路の少なくとも一方に設定する、
     ことを特徴とする請求項1に記載の管制制御装置。
  3.  前記通信部が走行中の前記実車両から受信した当該実車両の走行データを用いて、前記仮想車両の挙動が前記実車両の挙動と一致するように、前記走行パラメータを修正する走行パラメータ修正部を更に備える、
     ことを特徴とする請求項1に記載の管制制御装置。
  4.  前記実在する走行路は、前記実車両に対して積荷の積込が行われる積込位置を含む積込場に連結された走行路であって、
     前記仮想車両シミュレーション部は、前記シミュレーションにおいて、前記仮想車両が前記積込場の入口で待機する待機動作、前記入口から前記積込位置へ向かう走行動作、及び前記積込位置における停車動作、のうち少なくとも一つの動作は、前記実車両が実際に同じ動作を行ったときに要する時間よりも短い時間で終わらせる、
     ことを特徴とする請求項1に記載の管制制御装置。
  5.  前記仮想車両シミュレーション部は、
     前記走行パラメータに基づいて前記仮想車両の加減速を含む挙動及び位置を計算する走行シミュレーション部と、
     前記走行シミュレーション部の計算結果に基づいて、前記仮想車両の位置を算出するセンサシミュレーション部と、
     前記仮想車両に対して設定された走行許可区間及び前記仮想車両の位置に基づいて、前記仮想車両を走行させるための加減速の制御指令を前記走行シミュレーション部に対して行う仮想走行制御部と、を含む、
     ことを特徴とする請求項1に記載の管制制御装置。
  6.  前記センサシミュレーション部は、前記走行シミュレーション部が算出した前記仮想車両の位置に対して、前記実車両に搭載された位置算出装置が実際に算出した値に基づく誤差、及び位置測位衛星からの測位電波の捕捉状況に応じた誤差、の少なくとも一つを用いて補正する、
     ことを特徴とする請求項5に記載の管制制御装置。
  7.  前記実在する走行路を示す地図画像上に、当該地図画像に含まれる走行路において前記実車両及び前記仮想車両の其々の走行位置に対応する点に、前記実車両及び前記仮想車両の其々を示す画像の表示態様を変えて重畳表示する表示部を更に備える、
     ことを特徴とする請求項1に記載の管制制御装置。
  8.  前記入力部は、前記走行パラメータとして、前記仮想車両の重量、最大積載量、ホイールベース、最小回転半径、速度、加速度、車輪回転数、及びトルクの少なくとも一つの設定操作を更に受け付け、
     前記仮想シミュレーション部は、前記設定された走行パラメータを用いて前記仮想車両の走行シミュレーションを行う、
     ことを特徴とする請求項1に記載の管制制御装置。
  9.  鉱山の構内を予め定められた走行路に沿って自律走行する運搬車両の走行シミュレーション方法であって、
     実在しない走行路である仮想の走行路を規定する仮想地図データを生成するステップと、
     前記仮想の走行路を走行する実在しない車両である第一の仮想車両の走行パラメータを設定する設定操作を受け付けるステップと、
     前記第一の仮想車両の挙動を規定する走行パラメータ及び前記仮想地図データを用いて、前記第一の仮想車両に前記仮想の走行路を走行させるシミュレーション処理を実行するステップと、
     前記仮想地図データを、前記運搬車両における実車両が実際に自律走行する際に用いる実地図データとして格納するステップと、
     前記実地図データに基づく走行路に沿って仮想的に走行させるための第二の仮想車両の設定入力を受け付けるステップと、
     前記第二の仮想車両の挙動を規定する走行パラメータ及び前記実地図データを用いて、前記第二の仮想車両が前記実在の走行路を走行したと仮定した際の走行状態のシミュレーションを行うステップと、
     前記実在の走行路を走行する前記実車両から当該実車両の位置情報を取得するステップと、
     前記実車両の位置情報、前記実地図データ、及び前記第二の仮想車両の走行状態のシミュレーション結果に基づいて、前記実車両及び前記第二の仮想車両の其々に対し、各車両の走行を許可する前記走行路の部分区間からなる走行許可区間を設定するステップと、
     を含むことを特徴とする運搬車両の走行シミュレーション方法。
PCT/JP2015/073230 2014-08-20 2015-08-19 管制制御装置及び運搬車両の走行シミュレーション方法 WO2016027830A1 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2014167813A JP6426941B2 (ja) 2014-08-20 2014-08-20 管制制御装置及び運搬車両の走行シミュレーション方法
JP2014-167813 2014-08-20

Publications (1)

Publication Number Publication Date
WO2016027830A1 true WO2016027830A1 (ja) 2016-02-25

Family

ID=55350774

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2015/073230 WO2016027830A1 (ja) 2014-08-20 2015-08-19 管制制御装置及び運搬車両の走行シミュレーション方法

Country Status (2)

Country Link
JP (1) JP6426941B2 (ja)
WO (1) WO2016027830A1 (ja)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018025341A1 (ja) * 2016-08-03 2018-02-08 三菱電機株式会社 道路状態診断システム、診断用情報生成装置及び診断用情報生成方法
CN111123740A (zh) * 2019-12-19 2020-05-08 北京经纬恒润科技有限公司 硬件在环测试方法以及装置
CN111815771A (zh) * 2020-07-07 2020-10-23 中冶北方(大连)工程技术有限公司 一种网页端模拟露天矿生产方法
CN112141129A (zh) * 2019-06-28 2020-12-29 丰田自动车株式会社 自动驾驶车辆、运行管理中心以及车辆运行系统
US11280616B2 (en) 2019-07-11 2022-03-22 Caterpillar Inc. Operating status identification system for machine

Families Citing this family (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101897992B1 (ko) * 2017-03-28 2018-09-13 재단법인대구경북과학기술원 자율주행 자동차 설계를 위한 자율 주행 제어 개발 키트
KR101938064B1 (ko) * 2017-05-17 2019-01-11 현대오토에버 주식회사 자율주행 테스트 시스템
KR102375306B1 (ko) * 2018-01-24 2022-03-16 한화디펜스 주식회사 작업 차량에 대한 주행정보 디스플레이 장치 및 방법 그리고 주행속도 제어방법
JP7141883B2 (ja) * 2018-07-31 2022-09-26 株式会社小松製作所 作業機械の制御システム、作業機械、及び作業機械の制御方法
JP7129891B2 (ja) * 2018-11-21 2022-09-02 日立建機株式会社 作業車両、作業エリア管理システム
US11462114B2 (en) * 2019-03-22 2022-10-04 Volvo Truck Corporation Method for controlling vehicles in a mission along a route
CN110543173B (zh) * 2019-08-30 2022-02-11 上海商汤智能科技有限公司 车辆定位系统及方法、车辆控制方法及装置
JP6860640B2 (ja) * 2019-11-20 2021-04-21 ヤンマーパワーテクノロジー株式会社 経路生成システム
JP7478092B2 (ja) * 2020-12-28 2024-05-02 株式会社日立製作所 荷役車両システム
KR102568969B1 (ko) * 2021-03-31 2023-08-23 주식회사 한국디지털트윈연구소 디지털트윈 기술을 이용한 자율주행시험용 주행환경 시나리오 발생장치
KR102576733B1 (ko) * 2022-11-30 2023-09-08 주식회사 모라이 관제 플랫폼 연동 vils 기반 교통 환경 재현 방법 및 시스템

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006244124A (ja) * 2005-03-03 2006-09-14 Techno Craft Co Ltd 運行管理装置
JP2007164280A (ja) * 2005-12-09 2007-06-28 Komatsu Ltd 車両の走行制御装置
JP2007170927A (ja) * 2005-12-20 2007-07-05 Aisin Aw Co Ltd 走行予測システム
JP2012118694A (ja) * 2010-11-30 2012-06-21 Komatsu Ltd 無人車両の走行システムにおける走行制御方法および無人車両の走行システム

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006244124A (ja) * 2005-03-03 2006-09-14 Techno Craft Co Ltd 運行管理装置
JP2007164280A (ja) * 2005-12-09 2007-06-28 Komatsu Ltd 車両の走行制御装置
JP2007170927A (ja) * 2005-12-20 2007-07-05 Aisin Aw Co Ltd 走行予測システム
JP2012118694A (ja) * 2010-11-30 2012-06-21 Komatsu Ltd 無人車両の走行システムにおける走行制御方法および無人車両の走行システム

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018025341A1 (ja) * 2016-08-03 2018-02-08 三菱電機株式会社 道路状態診断システム、診断用情報生成装置及び診断用情報生成方法
JPWO2018025341A1 (ja) * 2016-08-03 2018-12-27 三菱電機株式会社 道路状態診断システム
CN112141129A (zh) * 2019-06-28 2020-12-29 丰田自动车株式会社 自动驾驶车辆、运行管理中心以及车辆运行系统
CN112141129B (zh) * 2019-06-28 2023-09-22 丰田自动车株式会社 自动驾驶车辆、运行管理中心以及车辆运行系统
US11280616B2 (en) 2019-07-11 2022-03-22 Caterpillar Inc. Operating status identification system for machine
CN111123740A (zh) * 2019-12-19 2020-05-08 北京经纬恒润科技有限公司 硬件在环测试方法以及装置
CN111123740B (zh) * 2019-12-19 2024-04-16 北京经纬恒润科技股份有限公司 硬件在环测试方法以及装置
CN111815771A (zh) * 2020-07-07 2020-10-23 中冶北方(大连)工程技术有限公司 一种网页端模拟露天矿生产方法

Also Published As

Publication number Publication date
JP2016045585A (ja) 2016-04-04
JP6426941B2 (ja) 2018-11-21

Similar Documents

Publication Publication Date Title
WO2016027830A1 (ja) 管制制御装置及び運搬車両の走行シミュレーション方法
JP6498542B2 (ja) 管制制御システム及び車載端末装置
CA2960470C (en) Map generation device
JP6247622B2 (ja) 管制制御装置
US10140871B2 (en) Wireless system and operation management server
CN106663369B (zh) 交通管制服务器以及交通管制系统
JP6025848B2 (ja) 車両の管制制御システム
US9483056B2 (en) Vehicle control system
JP2022509762A (ja) 自律マシンを使用したタスクの実行
JP2016071568A5 (ja)
JP6145024B2 (ja) ダンプトラックの運行管理システム
JP6352841B2 (ja) 車載端末装置及び交通管制システム
JP6339412B2 (ja) 交通管制サーバ
JP6487561B2 (ja) 鉱山機械のロギングシステム、車載端末装置、及び鉱山機械のロギング方法
JP7458883B2 (ja) 運搬車両の管理システム及び運搬車両の管理方法

Legal Events

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

Ref document number: 15833218

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

32PN Ep: public notification in the ep bulletin as address of the adressee cannot be established

Free format text: NOTING OF LOSS OF RIGHTS PURSUANT TO RULE 112(1) EPC (EPO FORM 1205A DATED 26.05.2017)

122 Ep: pct application non-entry in european phase

Ref document number: 15833218

Country of ref document: EP

Kind code of ref document: A1