JP6426941B2 - Control control device and driving simulation method of transport vehicle - Google Patents
Control control device and driving simulation method of transport vehicle Download PDFInfo
- Publication number
- JP6426941B2 JP6426941B2 JP2014167813A JP2014167813A JP6426941B2 JP 6426941 B2 JP6426941 B2 JP 6426941B2 JP 2014167813 A JP2014167813 A JP 2014167813A JP 2014167813 A JP2014167813 A JP 2014167813A JP 6426941 B2 JP6426941 B2 JP 6426941B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- traveling
- virtual
- travel
- map data
- Prior art date
- Legal status (The legal status 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 status listed.)
- Active
Links
- 238000004088 simulation Methods 0.000 title claims description 119
- 238000000034 method Methods 0.000 title claims description 53
- 238000012545 processing Methods 0.000 claims description 66
- 238000004891 communication Methods 0.000 claims description 58
- 238000004364 calculation method Methods 0.000 claims description 20
- 230000001133 acceleration Effects 0.000 claims description 17
- 238000012937 correction Methods 0.000 claims description 7
- 238000013500 data storage Methods 0.000 claims description 5
- 230000032258 transport Effects 0.000 description 73
- 230000008569 process Effects 0.000 description 39
- 230000004044 response Effects 0.000 description 31
- 230000006870 function Effects 0.000 description 21
- 238000010586 diagram Methods 0.000 description 17
- 238000012795 verification Methods 0.000 description 13
- 238000007726 management method Methods 0.000 description 10
- 230000010365 information processing Effects 0.000 description 8
- 238000003860 storage Methods 0.000 description 7
- 238000005259 measurement Methods 0.000 description 6
- 230000008859 change Effects 0.000 description 5
- 238000001514 detection method Methods 0.000 description 4
- 238000004519 manufacturing process Methods 0.000 description 4
- 238000005065 mining Methods 0.000 description 4
- KNMAVSAGTYIFJF-UHFFFAOYSA-N 1-[2-[(2-hydroxy-3-phenoxypropyl)amino]ethylamino]-3-phenoxypropan-2-ol;dihydrochloride Chemical compound Cl.Cl.C=1C=CC=CC=1OCC(O)CNCCNCC(O)COC1=CC=CC=C1 KNMAVSAGTYIFJF-UHFFFAOYSA-N 0.000 description 3
- 230000009471 action Effects 0.000 description 3
- 238000009412 basement excavation Methods 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 3
- 230000015572 biosynthetic process Effects 0.000 description 3
- 238000005553 drilling Methods 0.000 description 3
- 238000012876 topography Methods 0.000 description 3
- 238000013475 authorization Methods 0.000 description 2
- 238000012790 confirmation Methods 0.000 description 2
- 230000007423 decrease Effects 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000003252 repetitive effect Effects 0.000 description 2
- 230000007704 transition Effects 0.000 description 2
- 230000037396 body weight Effects 0.000 description 1
- 239000000470 constituent Substances 0.000 description 1
- 238000013480 data collection Methods 0.000 description 1
- 230000002950 deficient Effects 0.000 description 1
- 238000012217 deletion Methods 0.000 description 1
- 230000037430 deletion Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 238000005304 joining Methods 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 239000004570 mortar (masonry) Substances 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000013439 planning Methods 0.000 description 1
- 239000004576 sand Substances 0.000 description 1
- 239000013049 sediment Substances 0.000 description 1
- 238000004904 shortening Methods 0.000 description 1
- 239000002689 soil Substances 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 238000012384 transportation and delivery Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/09—Arrangements for giving variable traffic instructions
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Traffic Control Systems (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
Description
本発明は、管制制御装置及び運搬車両の走行シミュレーション方法に係り、特に鉱山で自律走行する運搬車両の走行シミュレーション技術に関する。 The present invention relates to a control control device and a method of simulating the travel of a transport vehicle, and more particularly to a technique of simulation of travel of a transport vehicle traveling autonomously in a mine.
露天掘り鉱山等において、オペレータが搭乗することなく自律走行する運搬車両（以下「無人ダンプ」という）を管制制御装置に無線通信回線を介して通信接続した自律走行システムが知られている。管制制御装置は、無人ダンプが他の車両と干渉しないように、予め生成された地図データ及び無人ダンプの位置を基に管制制御を行う。この自律走行システムに新規に無人ダンプを追加したい場合、実際に新規車両を投入してシステムを稼働する前に、稼働台数が増えても安全・効率的な走行が可能であるかを確認したいという要望がある。この要望に応えるために、実在しない車両（以下「仮想車両」という）を用いた走行シミュレーションを行い、その結果を検証する手法が考えられる。 In open pit mines and the like, there is known an autonomous traveling system in which a transport vehicle (hereinafter referred to as "unmanned dump") which travels autonomously without an operator boarding is communicably connected to a control control device via a wireless communication line. The control control device performs control control based on the pre-generated map data and the position of the unmanned dump so that the unmanned dump does not interfere with other vehicles. When you want to add an unmanned dump truck to this autonomous traveling system anew, before actually putting in a new vehicle and operating the system, you want to confirm whether safe and efficient traveling is possible even if the number of operating vehicles increases. There is a demand. In order to meet this demand, a method is conceivable in which running simulation is performed using a nonexistent vehicle (hereinafter referred to as "virtual vehicle") and the result is verified.
車両のシミュレーション装置の一例として、特許文献１には、移動体の各通過場所に関連付けられた運行状況を時間経過に応じて変移することにより疑似的な移動体（疑似バス）を運行させる疑似運行手段を備えた運行管理装置が開示されている。 As an example of a vehicle simulation apparatus, Patent Document 1 discloses a pseudo-operation for operating a pseudo mobile body (a pseudo bus) by changing an operation situation associated with each passing location of the mobile body according to the passage of time. An operation management device having a means is disclosed.
また、特許文献２には、走行車両が選択しなかった経路を仮想車両が自車と同一タイミングで走行開始したと仮定したときの走行位置をシミュレートする走行予測システムが開示されている。 Further, Patent Document 2 discloses a travel prediction system that simulates a travel position when it is assumed that a virtual vehicle starts traveling at the same timing as the host vehicle on a route not selected by the traveling vehicle.
鉱山で稼働する無人ダンプの台数を増やした状態のシミュレーションを、実際の無人ダンプの稼働状況からは独立させて仮想車両だけを用いて行うことも考えられる。 It is also conceivable to carry out a simulation in a state where the number of unmanned dumpings operating in the mine is increased, using only virtual vehicles by making them independent from the actual operating condition of the unmanned dumping.
しかし、仮想車両だけを用いてシミュレーションを行うと、仮想車両のシミュレーションした走行状態と実際に走行する実車両の走行状態とが一致しないことがある。従って、上記特許文献１のように疑似的な移動体のみを用いたシミュレーション技術を自律走行システムのシミュレーションに適用しても、シミュレーション結果の信頼性が十分得られない。 However, when simulation is performed using only the virtual vehicle, the simulated traveling state of the virtual vehicle may not match the traveling state of the actual vehicle actually traveling. Therefore, the reliability of the simulation result can not be obtained sufficiently even if the simulation technology using only a pseudo moving body as in Patent Document 1 is applied to the simulation of the autonomous traveling system.
また、特許文献２は、実在する走行路とは異なる他の走行路を仮想車両に走行させたときの走行位置をシミュレートするにすぎず、実在する走行路に実在する車両と仮想車両とを混ぜて走行させることはできない。 Further, Patent Document 2 only simulates the traveling position when the virtual vehicle travels on another traveling path different from the existing traveling path, and the vehicle and the virtual vehicle existing on the existing traveling path are simulated. It can not be mixed and run.
本発明は上記実情に鑑みてなされたものであり、運搬車両の実際の稼働状況を反映させつつ、運搬車両の稼働台数を増やした際の動作検証が行える管制制御装置及び運搬車両の走行シミュレーション方法を提供することを目的とする。 The present invention has been made in view of the above situation, and a control control device and a traveling simulation method of a transport vehicle capable of performing operation verification when increasing the number of transport vehicles while reflecting the actual operation status of the transport vehicle Intended to provide.
上記課題を解決するため、本発明は、鉱山の構内を予め定められた走行路に沿って自律走行する運搬車両の走行制御を行う管制制御装置であって、実在する走行路を規定した実地図データを記憶する地図データ記憶部と、前記走行路を仮想的に走行する仮想車両の設定操作を受け付ける入力部と、前記仮想車両の走行状態を規定する走行パラメータ及び前記実地図データを用いて、前記仮想車両が前記走行路を走行した際の走行状態のシミュレーションを行う仮想車両シミュレーション部と、前記運搬車両と無線通信を行うことにより、前記走行路を自律走行中の前記運搬車両の位置情報を受信する通信部と、前記運搬車両の位置情報、前記実地図データ、及び前記仮想車両のシミュレーションされた走行状態に基づいて、前記運搬車両及び前記仮想車両の其々に対し、各車両の走行を許可する前記走行路の部分区間からなる走行許可区間を設定する走行許可区間設定部と、を備え、前記通信部は、前記運搬車両に対し、当該運搬車両に対して設定された走行許可区間を示す走行許可区間情報を送信し、前記仮想車両シミュレーション部は、前記仮想車両に対して設定された前記走行許可区間に従って前記走行路を走行した際のシミュレーションを行い、その結果を前記走行許可区間設定部に返す、ことを特徴とする。 In order to solve the above-mentioned problems, the present invention is a control control device for performing travel control of a transport vehicle that autonomously travels along a predetermined travel path in a mine yard, and an actual map defining an existing travel path Using a map data storage unit for storing data, an input unit for receiving a setting operation of a virtual vehicle traveling on the traveling path virtually, traveling parameters for defining a traveling state of the virtual vehicle, and the actual map data A virtual vehicle simulation unit that simulates a traveling state when the virtual vehicle travels the traveling path, and wireless communication with the transportation vehicle, thereby performing position information of the transportation vehicle traveling autonomously on the traveling path The transport vehicle and the communication unit for receiving, based on the position information of the transport vehicle, the actual map data, and the simulated traveling state of the virtual vehicle And a traveling permission section setting unit for setting a traveling permission section consisting of a partial section of the traveling path for permitting traveling of each vehicle to each of the virtual vehicles, the communication unit for the transport vehicle The travel permission section information indicating the travel permission section set for the transport vehicle is transmitted, and the virtual vehicle simulation unit travels the traveling path according to the travel permission section set for the virtual vehicle. Simulation is performed, and the result is returned to the traveling permitted section setting unit.
これにより、実際に走行中の運搬車両の位置及び仮想車両の仮想位置を基に、運搬車両及び仮想車両に走行許可区間を設定するので、実際に運搬車両を走行させながら、仮想車両を追加した際における走行許可区間の設定可否の検証を行うことができる。よって、シミュレーション結果の信頼性が向上する。またこの検証に際して、運搬車両を稼働させた状態を維持できるので、運搬車両の稼働停止に伴う鉱山の生産性の低下を抑制することができる。 As a result, since the travel permission section is set for the transport vehicle and the virtual vehicle based on the position of the transport vehicle actually traveling and the virtual position of the virtual vehicle, the virtual vehicle is added while the transport vehicle is actually traveled. It is possible to verify whether or not the travel permission section can be set at the time of travel. Therefore, the reliability of the simulation result is improved. Moreover, since the state which made the conveyance vehicle operate can be maintained in this verification, the fall of the productivity of the mine accompanying the operation stop of a conveyance vehicle can be suppressed.
また、本発明は上記構成において、走行路を規定する地図データを生成する地図データ生成部を更に備え、前記入力部は、前記実在する走行路に接続する、実在しない仮想の走行路を追加する設定操作を更に受け付け、前記地図データ生成部は、前記実在する走行路及び前記仮想の走行路を規定する仮想地図データを生成し、前記地図データ記憶部は、前記仮想地図データを記憶し、前記走行許可区間設定部は、前記仮想地図データに基づいて、前記運搬車両に対する走行許可区間は、前記実在する走行路に設定し、前記仮想車両に対する走行許可区間は、前記実在する走行路及び前記仮想の走行路の少なくとも一方に設定する、ことを特徴とする。 Furthermore, the present invention further includes a map data generation unit that generates map data that defines a travel path in the above configuration, and the input unit adds a non-existent virtual travel path connected to the existing travel path. The setting operation is further received, the map data generation unit generates virtual map data defining the existing traveling path and the virtual traveling path, the map data storage unit stores the virtual map data, and The travel permission section setting unit sets the travel permission section for the transport vehicle to the existing travel path based on the virtual map data, and the travel permission section for the virtual vehicle includes the actual travel path and the virtual Setting at least one of the traveling paths of
これにより、運搬車両は実際の走行路に設定された走行許可区間に従って走行し、仮想車両は実在する走行路及び仮想の走行路の少なくとも一方に設定された走行許可区間に従って走行するので、運搬車両が仮想の走行路に間違って侵入することがない。従って、運搬車両を稼働させつつ、仮想の走行路を追加した際の動作検証を行うことができる。 Thus, the transport vehicle travels in accordance with the travel permission section set in the actual travel path, and the virtual vehicle travels in accordance with the travel permission section set in at least one of the existing travel path and the virtual travel path. There is no chance of accidentally entering a virtual track. Therefore, it is possible to perform operation verification when a virtual traveling path is added while operating the transport vehicle.
また、本発明は上記構成において、前記通信部が走行中の前記運搬車両から受信した当該運搬車両の走行データを用いて、同じ地点を走行する際に、前記仮想車両のシミュレーションした走行状態が前記運搬車両の走行状態と一致するように、前記走行パラメータを修正する走行パラメータ修正部を更に備える、ことを特徴とする。 Further, according to the present invention, in the above configuration, when traveling by the same point using the travel data of the transport vehicle received from the transport vehicle while the communication unit is traveling, the travel state simulated by the virtual vehicle is the above The travel parameter correction unit may further include a travel parameter correction unit that corrects the travel parameter so as to correspond to the travel state of the transport vehicle.
これにより、仮想車両のシミュレーションした走行状態を走行中の運搬車両の走行状態により近づけることができ、シミュレーション結果の信頼性をより高くすることができる。 As a result, the simulated traveling state of the virtual vehicle can be made closer to the traveling state of the transport vehicle during traveling, and the reliability of the simulation result can be further enhanced.
また、本発明は上記構成において、前記実在する走行路は、前記運搬車両に対して積荷の積込が行われる積込位置を含む積込場に連結された走行路であって、前記仮想車両シミュレーション部は、前記シミュレーションにおいて、前記仮想車両が前記積込場の入口で待機する待機動作、前記入口から前記積込位置へ向かう走行動作、及び前記積込位置における停車動作、のうち少なくとも一つの動作は、前記運搬車両が実際に同じ動作を行ったときに要する時間よりも短い時間で終わらせる、ことを特徴とする。 Further, according to the present invention, in the above-described configuration, the existing traveling path is a traveling path connected to a loading space including a loading position where loading of a load is performed to the transport vehicle, the virtual vehicle The simulation unit is, in the simulation, at least one of a standby operation in which the virtual vehicle stands by at the entrance of the loading space, a traveling operation from the entrance toward the loading position, and a stopping operation at the loading position. The operation is characterized in that the operation is completed in a time shorter than the time required when the transport vehicle actually performs the same operation.
仮想車両が、積込場において待機動作、走行動作、及び積込位置での停車動作をしているとき、運搬車両は積込場への走行が許可されない。そのため、仮想車両が積込場に長時間存在することは、実際に走行している運搬車両の妨げとなり、生産効率の低下を招く。そこで本発明では、仮想車両が上記の動作に要する時間を実際の運搬車両の動作時間よりも短くすることで、積込機が稼働できない時間をより短縮し、シミュレーションに伴う鉱山の生産効率の低下を抑止することができる。 When the virtual vehicle is in a standby operation, a traveling operation, and a stopping operation at the loading position at the loading site, the transport vehicle is not permitted to travel to the loading site. Therefore, the presence of a virtual vehicle in the loading place for a long time interferes with the actual transport vehicle, which leads to a decrease in production efficiency. Therefore, in the present invention, by shortening the time required for the above operation by the virtual vehicle to be shorter than the actual operation time of the transport vehicle, the time during which the loading machine can not operate can be further shortened, and the production efficiency of the mine is reduced due to the simulation. Can be deterred.
また、本発明は上記構成において、前記仮想車両シミュレーション部は、前記走行パラメータに基づいて前記仮想車両の加減速を含む走行状態及び位置を計算する走行シミュレーション部と、前記走行シミュレーション部の計算結果に基づいて、前記仮想車両の位置を算出するセンサシミュレーション部と、前記仮想車両に対して設定された走行許可区間及び前記仮想車両の位置に基づいて、前記仮想車両を走行させるための加減速の制御指令を前記走行シミュレーション部に対して行う仮想走行制御部と、を含むことを特徴とする。Further, according to the present invention, in the above configuration, the virtual vehicle simulation unit calculates a traveling state and a position including the acceleration and deceleration of the virtual vehicle based on the traveling parameter, and a calculation result of the traveling simulation unit. Based on a sensor simulation unit that calculates the position of the virtual vehicle, and control of acceleration / deceleration for causing the virtual vehicle to travel based on the traveling permitted section set for the virtual vehicle and the position of the virtual vehicle And a virtual traveling control unit for performing a command on the traveling simulation unit.
走行シミュレーション部は、仮想走行制御部からの加減速の指示に従って仮想車両のシミュレーションした走行状態を演算すると、結果的に仮想車両が走行許可区間に従って走行した状態をシミュレーションすることができる。これにより、仮想車両を投入した際に走行許可区間が設定できるかを検証することができる。 When the traveling simulation unit calculates the simulated traveling state of the virtual vehicle according to the acceleration / deceleration instruction from the virtual traveling control unit, it can simulate the traveling state of the virtual vehicle according to the traveling permitted section. Thus, it is possible to verify whether the travel permission section can be set when the virtual vehicle is inserted.
本発明は上記構成において、前記センサシミュレーション部は、前記走行シミュレーション部が算出した前記仮想車両の位置に対して、前記運搬車両に搭載された位置算出装置が実際に算出した値に基づく誤差、及び位置測位衛星からの測位電波の捕捉状況に応じた誤差、の少なくとも一つを用いて補正する、ことを特徴とする。 In the above configuration, the sensor simulation unit may generate an error based on a value actually calculated by the position calculation device mounted on the transport vehicle with respect to the position of the virtual vehicle calculated by the traveling simulation unit. It is characterized by correcting using at least one of an error according to a capturing situation of positioning radio waves from a positioning satellite.
鉱山では崖や山影などの影響により、走行路上の各点において測位電波の捕捉状況にばらつきが生じることがある。そのため、運搬車両に慣性計測装置（Ｉｎｅｒｔｉａｌ Ｍｅａｓｕｒｅｍｅｎｔ Ｕｎｉｔ、略称：ＩＭＵ）を搭載し、測位電波による位置算出処理と併用して相互に補間することで、運搬車両の位置算出精度の向上を図る場合がある。本発明では、実際の運搬車両からの位置情報や、測位電波の捕捉状況に応じて仮想車両の位置を補正することで、地形条件が厳しい鉱山内の走行路においても好適なシミュレーション技術を提供することができる。 In mines, the influence of cliffs and hill shadows may cause the capture status of positioning radio waves to vary at each point on the traveling road. Therefore, there is a case where the position calculation accuracy of the transport vehicle can be improved by interposing the inertial measurement device (Inertial Measurement Unit, abbreviated as IMU) on the transport vehicle and using the positioning radio processing together with the position calculation processing. is there. In the present invention, a simulation technique suitable for a traveling route in a mine where terrain conditions are severe is provided by correcting the position of the virtual vehicle according to the position information from the actual transport vehicle and the capturing condition of the positioning radio wave. be able to.
また、本発明は上記構成において、前記実在する走行路を示す地図画像に、当該地図画像に含まれる走行路において前記運搬車両及び前記仮想車両の其々の走行位置に対応する点に、前記運搬車両及び前記仮想車両の其々を示す画像の表示態様を変えて重畳表示する表示部を更に備える、ことを特徴とする。 Further, according to the present invention, in the above configuration, the map image indicating the existing traveling path corresponds to the traveling positions of the transport vehicle and the virtual vehicle on the traveling path included in the map image. The display device may further include a display unit configured to change and display an image display mode of the vehicle and the virtual vehicle.
これにより、走行路上の運搬車両及び仮想車両の位置を視認することができ、ユーザが仮想車両を追加した際の動作検証を容易に行える。 Thereby, the positions of the transport vehicle and the virtual vehicle on the traveling road can be visually recognized, and the operation verification when the user adds the virtual vehicle can be easily performed.
また、本発明は上記構成において、前記入力部は、前記走行パラメータとして、前記仮想車両の重量、最大積載量、ホイールベース、最小回転半径、速度、加速度、車輪回転数、及びトルクの少なくとも一つの設定操作を更に受け付け、前記仮想車両シミュレーション部は、前記設定された走行パラメータを用いて前記仮想車両の走行シミュレーションを行う、ことを特徴とする。 Further, in the above configuration according to the present invention, the input unit may include at least one of weight, maximum load, wheel base, minimum turning radius, speed, acceleration, wheel rotation number, and torque of the virtual vehicle as the travel parameters. The setting operation is further received, and the virtual vehicle simulation unit performs traveling simulation of the virtual vehicle using the set traveling parameter.
仮想車両の走行パラメータをユーザが設定することができ、所望する性能、構造の走行シミュレーションが行える。例えば、実車両と同じ性能、構造を示す走行パラメータを設定すると、実車両と同じ車種の車両を追加した際の動作検証が行える。また、実車両とは異なる走行パラメータを設定すると、実車両に、異なる車種の車両を追加した際の動作検証が行える。 The travel parameters of the virtual vehicle can be set by the user, and travel simulation of desired performance and structure can be performed. For example, if driving parameters indicating the same performance and structure as an actual vehicle are set, operation verification can be performed when a vehicle of the same vehicle type as the actual vehicle is added. In addition, if driving parameters different from the actual vehicle are set, operation verification can be performed when a vehicle of a different vehicle type is added to the actual vehicle.
また、本発明は鉱山の構内を予め定められた走行路に沿って自律走行する運搬車両の走行シミュレーション方法であって、実在しない走行路である仮想の走行路を規定する仮想地図データを生成するステップと、前記仮想の走行路を走行する実在しない車両である仮想車両の設定操作を受け付けるステップと、前記仮想車両の走行状態を規定する走行パラメータ及び前記仮想地図データを用いて、前記仮想車両に前記仮想の走行路を走行させるシミュレーション処理を実行するステップと、前記仮想地図データを、前記運搬車両が実際に自律走行する際に用いる実地図データとして格納するステップと、前記実地図データに基づく実在の走行路上を仮想的に走行する仮想車両の設定入力を受け付けるステップと、前記仮想車両の走行状態を規定する走行パラメータ及び前記実地図データを用いて、前記仮想車両が前記実在の走行路を仮想的に走行した際の走行状態のシミュレーションを行うステップと、前記実在の走行路を走行する前記運搬車両から当該運搬車両の位置情報を取得するステップと、前記運搬車両の位置情報、前記実地図データ、及び前記仮想車両のシミュレーションされた走行状態に基づいて、前記運搬車両及び前記仮想車両の其々に対し、各車両の走行を許可する前記走行路の部分区間からなる走行許可区間を設定するステップと、を含むことを特徴とする。 Further, the present invention is a method of simulating the traveling of a transport vehicle that autonomously travels along a predetermined traveling path of a mine, and generates virtual map data defining a virtual traveling path which is a non-existent traveling path. In the virtual vehicle, the steps of: receiving the setting operation of the virtual vehicle which is a non-existent vehicle traveling on the virtual traveling path; and using the virtual map data and the travel parameter defining the traveling state of the virtual vehicle The steps of performing simulation processing for traveling the virtual traveling path, storing the virtual map data as actual map data used when the transport vehicle actually travels autonomously, and existence based on the actual map data Accepting a setting input of a virtual vehicle virtually traveling on the travel path of the vehicle, and defining a traveling state of the virtual vehicle. Performing simulation of a traveling state when the virtual vehicle virtually travels the existing travel path using the traveling parameters and the actual map data, and from the transport vehicle traveling the actual travel path For each of the transport vehicle and the virtual vehicle, based on the step of acquiring the position information of the transport vehicle, the position information of the transport vehicle, the actual map data, and the simulated running state of the virtual vehicle And D. setting a travel permission section consisting of partial sections of the travel path for permitting travel of each vehicle.
本発明によれば、仮想地図データを生成すると仮想車両を用いたシミュレーション結果が良好な場合に、仮想地図データを実地図データとして採用することができる。これにより、実際に運搬車両を走行させるための実地図データとしての適性を検証することができる。 According to the present invention, when virtual map data is generated, virtual map data can be adopted as actual map data when simulation results using a virtual vehicle are good. In this way, it is possible to verify the suitability as actual map data for actually causing the transport vehicle to travel.
更に、実地図データを用いて運搬車両を稼働させた後に、新規の運搬車両を追加したいという要望が生じることがあるが、その場合も実際に運搬車両を稼働させた状態に、仮想車両を追加して走行許可区間の設定の可否を検証できる。またこの検証に際して、運搬車両を稼働させた状態を維持できるので、運搬車両の稼働停止に伴う鉱山の生産性の低下を抑制することができる。 Furthermore, after operating the transportation vehicle using real map data, there may be a demand to add a new transportation vehicle, but also in this case, the virtual vehicle is added with the transportation vehicle actually operated. Thus, it is possible to verify whether or not the travel permitted section can be set. Moreover, since the state which made the conveyance vehicle operate can be maintained in this verification, the fall of the productivity of the mine accompanying the operation stop of a conveyance vehicle can be suppressed.
本発明によれば、運搬車両を実際の稼働状況を反映させつつ、自律走行システムの構成要素に変化があった際の動作検証が行える管制制御装置及び運搬車両の走行シミュレーション方法を提供することができる。上記した以外の課題、構成及び効果は、以下の実施形態の説明により明らかにされる。 According to the present invention, it is possible to provide a control control device and a travel simulation method for a transport vehicle that can perform operation verification when there is a change in a component of the autonomous travel system while reflecting the actual operation status of the transport vehicle. it can. Problems, configurations, and effects other than those described above will be apparent from the description of the embodiments below.
以下、図面を参照して本発明の実施形態について説明する。以下の実施の形態においては、便宜上その必要があるときは、複数のセクションまたは実施の形態に分割して説明する。以下の実施の形態において、要素の数等（個数、数値、量、範囲等を含む）に言及する場合、特に明示した場合および原理的に明らかに特定の数に限定される場合等を除き、その特定の数に限定されるものではなく、特定の数以上でも以下でもよい。なお、以下の実施の形態において、その構成要素（処理ステップ等も含む）は、特に明示した場合および原理的に明らかに必須であると考えられる場合等を除き、必ずしも必須ではない。 Hereinafter, embodiments of the present invention will be described with reference to the drawings. In the following embodiment, when it is necessary for convenience, it is divided into a plurality of sections or embodiments. In the following embodiments, when referring to the number of elements, etc. (including the number, numerical value, amount, range, etc.), unless explicitly stated otherwise or in principle when clearly limited to a specific number, etc. It is not limited to the specific number, and may be more or less than the specific number. In the following embodiments, the constituent elements (including processing steps and the like) are not necessarily essential except when particularly clearly shown and when it is considered to be obviously essential in principle.
また、以下の実施の形態における各構成、機能、処理部等は、それらの一部又は全部を、例えば集積回路その他のハードウェアとして実現しても良い。また、後述する各構成、機能、処理部等は、コンピュータ上で実行されるプログラムとして実現しても良い。すなわち、ソフトウェアとして実現しても良い。各構成、機能、処理部等を実現するプログラム、テーブル、ファイル等の情報は、メモリやハードディスク、ＳＳＤ（Ｓｏｌｉｄ Ｓｔａｔｅ Ｄｒｉｖｅ）等の記憶装置、ＩＣカード、ＳＤカード、ＤＶＤ等の記憶媒体に格納することができる。 In addition, each configuration, function, processing unit, and the like in the following embodiments may realize part or all of them as, for example, an integrated circuit or other hardware. In addition, each configuration, function, processing unit, and the like described later may be realized as a program executed on a computer. That is, it may be realized as software. Information such as programs, tables, files, etc. for realizing each configuration, function, processing unit, etc. is stored in a storage device such as a memory, hard disk, storage device such as SSD (Solid State Drive), IC card, SD card, DVD, etc. be able to.
以下、本発明の実施の形態を図面に基づいて詳細に説明する。なお、実施の形態を説明するための全図において、同一の機能を有する部材には同一または関連する符号を付し、その繰り返しの説明は省略する。また、以下の実施の形態では、特に必要なとき以外は同一または同様な部分の説明を原則として繰り返さない。 Hereinafter, embodiments of the present invention will be described in detail based on the drawings. In all the drawings for describing the embodiments, members having the same function are denoted by the same or related reference numerals, and the repetitive description thereof will be omitted. Further, in the following embodiments, the description of the same or similar parts will not be repeated in principle unless particularly required.
＜第一実施形態＞
第一実施形態は、鉱山においてショベルやホイールローダ等の積込機が積み込んだ土砂や鉱石を搬送し、運転手が搭乗することなく自律走行する自律走行運搬車両と、自律走行運搬車両の交通管制を行う管制サーバと、を無線通信回線で接続した自律走行システムにおいて、システムの構成要素、例えば自律走行運搬車両の稼働台数や地図データ、を変更した際のシミュレーション機能を管制サーバに備える点に特徴がある。
First Embodiment
In the first embodiment, an autonomous traveling transport vehicle that transports sediment ore loaded by a loading machine such as a shovel or a wheel loader in a mine and autonomously travels without the driver getting on board, and traffic control of the autonomous traveling transport vehicle In an autonomous traveling system in which a control server for performing the control is connected via a wireless communication line, the control server is provided with a simulation function when changing system components such as the number of autonomous traveling vehicles and map data. There is.
まず、図１に基づいて、本発明の第一実施形態に係る管制サーバを含む自律走行システムの概略構成について説明する。図１は、自律走行システムの概略構成を示す図である。 First, a schematic configuration of an autonomous traveling system including a control server according to a first embodiment of the present invention will be described based on FIG. FIG. 1 is a diagram showing 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 or ore loaded from shovels 10-1 and 10-2 which perform digging and loading operations in a quarry such as a mine. The autonomous traveling vehicles (actual vehicles) 20-1 and 20-2 and the control server 31 installed near the quarry or in the remote control center 30 are mutually connected by communication via the wireless communication line 40. Be done. Since a dump truck is used as the autonomous traveling conveyance vehicle, the autonomous traveling conveyance vehicle is hereinafter referred to as a dump. Moreover, in order to distinguish with the virtual conveyance vehicle mentioned later, the real dumping is called a real vehicle, and the virtual conveyance vehicle which does not exist is called a virtual vehicle. The control server 31 is a control control device that performs travel control of a dump, and has a travel simulation function using a virtual vehicle.
各ダンプ２０−１、２０−２は、鉱山内で予め設定された搬送路６０に沿ってショベル１０−１又は１０−２、及び図示しない放土場の間を往復し、積荷を搬送する。 The dumpers 20-1 and 20-2 reciprocate between the shovels 10-1 or 10-2 and a discharge site (not shown) along a transport path 60 preset in the mine to transport loads.
鉱山内には、複数の無線基地局４１−１、４１−２、４１−３が設置される。そしてこれらの無線基地局４１−１、４１−２、４１−３を経由して、無線通信の電波が送受信される。 In the mine, a plurality of radio base stations 41-1, 41-2, and 41-3 are installed. Then, radio waves of radio communication are transmitted and received via the radio base stations 41-1, 41-2, and 41-3.
ショベル１０−１、１０−２及び各ダンプ２０−１、２０−２は、全地球航法衛星システム（ＧＮＳＳ：Ｇｌｏｂａｌ Ｎａｖｉｇａｔｉｏｎ Ｓａｔｅｌｌｉｔｅ Ｓｙｓｔｅｍ）の少なくとも３つの航法衛星５０−１、５０−２、５０−３から測位電波を受信して自車両の位置を取得するための位置算出装置（図１では図示を省略する）を備える。ＧＮＳＳとして、例えばＧＰＳ（Ｇｌｏｂａｌ Ｐｏｓｉｔｉｏｎｉｎｇ Ｓｙｓｔｅｍ）、ＧＬＯＮＡＳＳ、ＧＡＬＩＬＥＯを用いてもよい。ダンプ２０−１、２０−２の構成は同じであるので、以下ではダンプ２０−１、２０−２を区別することなく総称する場合はダンプ２０と記載する。またショベル１０−１、１０−２の構成も同じであるので、以下ではショベル１０−１、１０−２を区別することなく総称する場合はショベル１０と記載する。 The shovels 10-1 and 10-2 and the respective dumps 20-1 and 20-2 are at least three navigation satellites 50-1, 50-2 and 50-3 of the Global Navigation Satellite System (GNSS). And a position calculation device (not shown in FIG. 1) for acquiring the position of the vehicle by receiving positioning radio waves from the position signal. As a GNS S, for example, GPS (Global Positioning System), GLONASS , may be used GALILEO. Since the configurations of the dumps 20-1 and 20-2 are the same, hereinafter, when the dumps 20-1 and 20-2 are collectively referred to without distinction, they are described as the dump 20. Moreover, since the structure of shovels 10-1 and 10-2 is also the same, below, it is described as shovel 10, when naming generically, without distinguishing shovels 10-1 and 10-2.
ダンプ２０は、本体を形成するフレーム２１と、前輪２２及び後輪２３と、フレーム２１の後方部分に設けられたヒンジピン（図示せず）を回動中心として上下方向に回動可能な荷台２４と、この荷台２４を上下方向に回動させる左右一対のホイストシリンダ（図示せず）と、を含む。また、ダンプ２０は、見通しの良い場所、例えば、ダンプ２０の上面前方に、無線通信回線４０に接続するためのアンテナ２５が設置される。 The dumper 20 includes a frame 21 forming a main body, a front wheel 22 and a rear wheel 23, and a loading platform 24 pivotable up and down with a hinge pin (not shown) provided at a rear portion of the frame 21 as a pivot center. And a pair of left and right hoist cylinders (not shown) for rotating the loading platform 24 in the vertical direction. In addition, an antenna 25 for connecting to the wireless communication line 40 is installed at a location where the dump truck 20 has a good line of sight, for example, the upper surface of the dump truck 20.
更にダンプ２０は、管制サーバ３１からの指示に従って自律走行をするため走行制御装置２００を搭載する。 Furthermore, the dump truck 20 mounts the travel control device 200 in order to travel autonomously in accordance with an instruction from the control server 31.
管制サーバ３１は、無線通信回線４０に接続するためのアンテナ３２に接続される。そして、管制サーバ３１は、アンテナ３２、無線基地局４１−１、４１−２、４１−３を経由してダンプ２０と通信する。 The control server 31 is connected to an antenna 32 for connecting to the wireless communication line 40. Then, the control server 31 communicates with the dump 20 via the antenna 32 and the wireless base stations 41-1, 41-2, and 41-3.
次に図２及び図３を参照して、図１の管制サーバ３１及びダンプ２０のハードウェア構成について説明する。図２は、管制サーバ３１及びダンプ２０のハードウェア構成図であって、（ａ）は管制サーバ、（ｂ）はダンプを示す。図３は、ダンプ２０の外観を示す図である。 Next, hardware configurations of the control server 31 and the dump 20 of FIG. 1 will be described with reference to FIGS. 2 and 3. FIG. 2 is a hardware configuration diagram of the control server 31 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 20. As shown in FIG.
図２の（ａ）に示すように、管制サーバ３１は、ＣＰＵ３１１、ＲＡＭ（Ｒａｎｄｏｍ
Ａｃｃｅｓｓ Ｍｅｍｏｒｙ）３１２、ＲＯＭ（Ｒｅａｄ Ｏｎｌｙ Ｍｅｍｏｒｙ）３１３、ＨＤＤ（Ｈａｒｄ Ｄｉｓｋ Ｄｒｉｖｅ）３１４、Ｉ／Ｆ３１５、バス３１８を含む。そして、ＣＰＵ３１１、ＲＡＭ３１２、ＲＯＭ３１３、ＨＤＤ３１４、及びＩ／Ｆ３１５がバス３１８を介して接続されて構成される。
As illustrated in (a) of FIG. 2, the control server 31 includes a CPU 311 and a RAM (Random (Random).
An Access Memory (ROM) 312, a ROM (Read Only Memory) 313, an HDD (Hard Disk Drive) 314, an I / F 315, and a bus 318 are included. The CPU 311, the RAM 312, the ROM 313, the HDD 314, and the I / F 315 are connected via the bus 318.
更に、管制サーバ３１は、表示装置３１６、及び入力装置３１７を備え、これらがＩ／Ｆ３１５に接続される。 Furthermore, the control server 31 includes a display 316 and an input device 317, which are connected to the I / F 315.
ＣＰＵ３１１は演算部であり、管制サーバ３１全体の動作を制御する。 The CPU 311 is an arithmetic unit, and controls the overall operation of the control server 31.
ＲＡＭ３１２は、情報の高速な読み書きが可能な揮発性の記憶媒体であり、ＣＰＵ３１１が情報を処理する際の作業領域として用いられる。 The RAM 312 is a volatile storage medium capable of high-speed reading and writing of information, and is used as a work area when the CPU 311 processes information.
ＲＯＭ３１３は、読み出し専用の不揮発性記憶媒体であり、本実施形態の特徴をなすシミュレーション機能を含む自律走行制御プログラムが格納されている。 The ROM 313 is a read only non-volatile storage medium, and stores an autonomous traveling control program including a simulation function that characterizes the present embodiment.
ＨＤＤ３１４は、情報の読み書きが可能な不揮発性の記憶媒体であり、ＯＳ（Ｏｐｅｒａｔｉｎｇ Ｓｙｓｔｅｍ）や各種の制御プログラム、アプリケーション・プログラム等が格納されている。 The HDD 314 is a non-volatile storage medium capable of reading and writing information, and stores an operating system (OS), various control programs, application programs, and the like.
表示装置３１６は、ユーザが鉱山内のダンプの走行状況を確認したり、シミュレーション機能を実行する際に仮想車両の追加位置を指定したりするためのユーザインターフェースであり、例えばＬＣＤ（Ｌｉｑｕｉｄ Ｃｒｙｓｔａｌ Ｄｉｓｐｌａｙ）により構成される。 The display device 316 is a user interface for allowing the user to confirm the traveling condition of the dump in the mine, or to designate an additional position of the virtual vehicle when executing the simulation function, and, for example, LCD (Liquid Crystal Display) It consists of
入力装置３１７は、ユーザが管制サーバ３１に情報を入力するためのユーザインターフェースであり、例えばマウス、キーボードやＬＣＤに積層されたタッチパネル（図示を省略）を用いて構成される。 The input device 317 is a user interface for the 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 communication device 390 for connecting to the wireless communication line 40 is connected to the I / F 315 of the control server 31.
一方、ダンプ２０は、図２の（ｂ）に示すように自律走行のための制御処理を行う走行制御装置２００と、走行制御装置２００からの制御指示に従ってダンプ２０を走行駆動するための走行駆動装置２１０と、ダンプ２０の自車両の位置を算出するための位置算出装置２２０と、ダンプ２０の周辺環境を認識するためのミリ波センサ等の車載センサ２３０と、無線通信回線４０に接続するためのダンプ側通信装置２４０と、を備える。 On the other hand, as shown in (b) of FIG. 2, the dump 20 is a traveling control device 200 that performs control processing for autonomous traveling, and traveling drive for traveling the dump 20 according to control instructions from the traveling control device 200 A device 210, a position calculation device 220 for calculating the position of the vehicle of the dump 20, an on-vehicle sensor 230 such as a millimeter wave sensor for recognizing the environment around the dump 20, and a wireless communication line 40 And the dump side communication device 240.
走行駆動装置２１０は、ダンプ２０に対して制動をかける制動装置２１１、ダンプ２０の操舵角を変更するための操舵モータ２１２、及びダンプ２０を走行させるための走行モータ２１３を含む。 The travel drive device 210 includes a braking device 211 that brakes the dump 20, a steering motor 212 for changing a steering angle of the dump 20, and a travel motor 213 for traveling the dump 20.
位置算出装置２２０は自己位置を特定する手段であり、本実施形態では、航法衛星５０−１、５０−２、５０−３からの測位電波を受信して自車両の位置を算出するＧＰＳ装置を用いるので、ダンプ２０にはＧＰＳアンテナ２２１（図３参照）を備える。位置算出装置２２０はＧＰＳである必要はなく、例えば、慣性計測装置（ＩＭＵ：Ｉｎｅｒｔｉａｌ
Ｍｅａｓｕｒｅｍｅｎｔ Ｕｎｉｔ）や、地上に設置された基地局からの電波を用いて位置を特定するシステムによるものであってもよい。その場合、ダンプ２０は、ＧＰＳアンテナ２２１に代わり、そのシステム用のアンテナやジャイロセンサや車輪の回転数を検知するセンサを備える。
The position calculation device 220 is a means for specifying the self position, and in this embodiment, a GPS device that receives positioning radio waves from the navigation satellites 50-1, 50-2, 50-3 and calculates the position of the vehicle. As used, the dump 20 is provided with a GPS antenna 221 (see FIG. 3). The position calculation device 220 need not be GPS, and, for example, an inertial measurement device (IMU: Inertial
It may be a measurement unit) or a system for specifying the position using radio waves from a base station installed on the ground. In that case, the dump 20 is instead GP S antenna 221 comprises a sensor for detecting the rotational speed of the antenna or a gyro sensor or a wheel for that system.
車載センサ２３０は、ダンプ２０の速度や周辺の環境を認識・推定するためのものであり、例えば、路肩検出手段や前方障害物の検出を行う手段が相当する。路肩検出手段として、本実施形態ではレーザーレーダセンサ２３１Ｌ、２３１Ｒ（図３参照）を備えるが、これに限らずカメラを用いた画像処理により路肩を検出するものであってもよい。その場合、レーザーレーダセンサ２３１Ｌ、２３１Ｒは車体側方を見下ろすように設置されたカメラに代わる。また、前方障害物の検出手段として、本実施形態ではミリ波レーダセンサ２３２を備えており、この出力を用いてダンプ２０の走行方向前方の障害物を検出するが、ミリ波レーダセンサ２３２に代わり前方に向けられた複数のカメラを備えてもよい。この場合、複数のカメラの取り付け位置は図３に示す位置よりもさらに上方にあって前方を見下ろすように設置したものであってもよい。 The on-vehicle sensor 230 is for recognizing and estimating the speed of the dump 20 and the surrounding environment, and corresponds to, for example, a road-shoulder detecting means and a means for detecting a front obstacle. Although the laser radar sensors 231L and 231R (see FIG. 3) are provided as road shoulder detection means in the present embodiment, the present invention is not limited to this, and the road shoulder may be detected by image processing using a camera. In that case, the laser radar sensors 231L and 231R replace cameras installed so as to look down on the side of the vehicle body. Further, in the present embodiment, a millimeter wave radar sensor 232 is provided as a means for detecting a front obstacle, and an obstacle in front of the traveling direction of the dump 20 is detected using this output. It may be equipped with multiple cameras directed to the front. In this case, the mounting positions of the plurality of cameras may be located further above the position shown in FIG. 3 so as to look down on the front.
車載センサ２３０の検知結果は走行制御装置２００に出力され、通常時は走行路から離脱しないように走行位置の監視や加減速に用いられ、緊急時には緊急回避行動に必要な制動動作に用いられる。 The detection result of the on-vehicle sensor 230 is output to the travel control device 200, and is used for monitoring of the traveling position and acceleration / deceleration so as not to leave the traveling path normally, and used for braking operation necessary for emergency avoidance action in emergency.
走行制御装置２００は、ＣＰＵ２０１、ＲＡＭ２０２、ＲＯＭ２０３、ＨＤＤ２０４、Ｉ／Ｆ２０５、及びバス２０８を含む。そして、ＣＰＵ２０１、ＲＡＭ２０２、ＲＯＭ２０３、ＨＤＤ２０４、及びＩ／Ｆ２０５がバス２０８を介して接続されて構成される。更に、走行駆動装置２１０、位置算出装置２２０、車載センサ２３０、及びダンプ側通信装置２４０が、Ｉ／Ｆ２０５に接続される。 The traveling control device 200 includes a CPU 201, a RAM 202, a ROM 203, an HDD 204, an I / F 205, and a bus 208. The CPU 201, the RAM 202, the ROM 203, the HDD 204, and the I / F 205 are connected via the bus 208. Furthermore, the traveling drive device 210, the position calculation device 220, the on-vehicle sensor 230, and the dump side communication device 240 are connected to the I / F 205.
このようなハードウェア構成において、ＲＯＭ２０３、３１３やＨＤＤ２０４、３１４若しくは図示しない光学ディスク等の記録媒体に格納された自律走行制御プログラムがＲＡＭ２０２、３１２に読み出され、ＣＰＵ２０１、３１１の制御に従って動作することにより、自律走行制御プログラム（ソフトウェア）とハードウェアとが協働して、管制サーバ３１及び走行制御装置２００の機能を実現する。なお、本実施形態では、管制サーバ３１及び走行制御装置２００の構成をソフトウェアとハードウェアとの組み合わせにより説明したが、特にダンプ２０は、ダンプ側で実行される自律走行制御プログラムの機能を実現する集積回路を用いて構成してもよい。 In such a hardware configuration, the autonomous traveling control program stored in a recording medium such as the ROM 203 or 313 or the HDD 204 or 314 or an optical disk (not shown) is read out to the RAM 202 or 312 and operates under control of the CPU 201 or 311 Thus, the autonomous traveling control program (software) and the hardware cooperate to realize the functions of the control server 31 and the traveling control device 200. In the present embodiment, the configurations of the control server 31 and the travel control device 200 have been described using a combination of software and hardware, but in particular the dump 20 implements the function of the autonomous travel control program executed on the dump side. You may comprise using an integrated circuit.
次に図４及び図５を参照して、管制サーバ３１及びダンプ２０の機能構成について説明する。図４は、管制サーバの主な機能を示す機能ブロック図である。図５は、ダンプ２０の主な機能を示す機能ブロック図である。 Next, functional configurations of the control server 31 and the dump 20 will be described with reference to FIGS. 4 and 5. 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. As shown in FIG.
図４に示すように、管制サーバ３１は、実際のダンプ２０（以後、ダンプ２０を「実車両２０」と記載する）との実際の無線通信及び仮想車両との仮想通信を行うための制御を行うサーバ側通信制御部３１０、実車両２０及び仮想車両の目的地とそこへ至る走行路を決定し、また相互に干渉しないように交通管制を行う管制制御部３２０、実車両２０と独立して管制制御部３２０の指示に基づき実車両２０と同じ鉱山内を走行する仮想車両の走行状態をシミュレーションする仮想車両シミュレーション部３３０、表示装置３１６に対する表示制御処理を行う表示制御部３４０、実車両２０が走行する搬送路の地図データを格納するマスタ地図データデータベース（以下データベースを「ＤＢ」と記載する）３１４ａ、及び実車両２０及び仮想車両の其々に対して設定された走行許可区間を格納する区間情報ＤＢ３１４ｂを備える。上記仮想通信とは、サーバ側通信制御部３１０との間でデータの出入力を意味する。また、搬送路とは、積込場や放土場、また不図示の駐機場など、実車両２０の出発点、終点を結ぶ道路であり、この道路上に形成された実車両２０の進行方向に従った車線が走行路に相当する。 As shown in FIG. 4, the control server 31 performs control for performing actual wireless communication with the actual dump 20 (hereinafter, the dump 20 is described as “the actual vehicle 20”) and virtual communication with the virtual vehicle. Server-side communication control unit 310, the destination of the real vehicle 20 and the virtual vehicle, and the traveling route to the destination, and control control unit 320 performing traffic control so as not to interfere with each other, independently of the real vehicle 20 A virtual vehicle simulation unit 330 that simulates the traveling state of a virtual vehicle traveling in the same mine as the actual 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 actual vehicle 20 A master map data database (hereinafter referred to as "DB") 314a for storing map data of a traveling route, and an actual vehicle 20 and a virtual It comprises a section information DB314b for storing travel permission sections set for both the 其 s. The virtual communication means input / output of data with the server side communication control unit 310. The transport path is a road connecting the departure point and the end point of the real vehicle 20, such as a loading place, a dumping place, or a parking lot (not shown), and the traveling direction of the real vehicle 20 formed on this 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 real vehicle 20, and at the same time, the virtual vehicle simulation unit 330 (more specifically described later will be virtual The vehicle communication unit 331) performs input / output processing (virtual communication) of data necessary for driving simulation of the virtual vehicle.
管制制御部３２０は、配車管理部３２１、走行許可区間設定部３２２、及び地図データ生成部３２３を含む。 The control control unit 320 includes a dispatch management unit 321, a travel permission section setting unit 322, and a map data generation unit 323.
配車管理部３２１は、実車両２０及び仮想車両の目的地を設定し、マスタ地図データＤＢ３１４ａに格納された地図データを参照して現在位置から目的地に至る走行路を決定する。 The dispatch management unit 321 sets the destinations of the real vehicle 20 and the virtual vehicle, and determines the traveling route from the current position to the destination with reference to the map data stored in the master map data DB 314a.
配車管理部３２１の処理例として、例えば実車両２０又は仮想車両が駐機場にいる場合には、積込位置を含む積込場の入口を目的として設定する。そして配車管理部３２１は駐機場から積込上の入口に至るまでの走行路を設定する。この走行路の設定に際し、配車管理部３２１は、積込位置の移動に伴って動的に走行路を生成してもよい。更に、配車管理部３２１は、実車両２０又は仮想車両が積込位置にいる場合には、積載物の内容によって放土場６２、６３のいずれかを目的地として設定し、それに至るまでの走行路を生成する。 As an example of processing of the dispatch management unit 321, for example, when the real vehicle 20 or the virtual vehicle is in the parking lot, the entrance of the loading site including the loading position is set as an object. Then, the dispatch management unit 321 sets a traveling path from the parking lot to the entrance on the loading side. When setting this traveling path, the dispatch management unit 321 may dynamically generate the traveling path as the loading position moves. Furthermore, when the real vehicle 20 or the virtual vehicle is at the loading position, the dispatch management unit 321 sets one of the release places 62, 63 as the destination according to the content of the load, and travels up 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 real vehicle 20 or the virtual vehicle in the partial section on the travel road determined above. Is set as a permitted travel section, and section information indicating the position of the permitted travel section is generated. The travel permission section setting unit 322 overwrites and updates the newly generated section information on the section information stored in the section information DB 314 b. The section information includes the node ID of the front boundary point which is the node at the front end of the run permission section, and the node ID of the rear boundary point which is the node at the end. When the travel permission section setting unit 322 receives information (hereinafter referred to as a “section request message”) requesting setting of a new travel permission section from the real vehicle 20 or the virtual vehicle, the processing for setting the travel permission section is performed accordingly. Do. When the travel permission section setting unit 322 sets a new travel permission section, it generates information indicating the travel permission section (hereinafter referred to as “section response message”), and when it is not possible, it indicates that travel is not permitted. Generate an unauthorized response message.
地図データ生成部３２３は、実在の走行路を設置する位置を実走して収集した位置座標を基に走行路を規定する実地図データを生成、更新、及び格納する。本実施形態では、実在する走行路を規定する地図情報を実地図データといい、実在しない走行路（仮想の走行路）を規定する地図情報を仮想地図データと称する。地図データ生成部３２３は、入力装置３１７から実在する走行路に対して実在しない仮想の走行路を追加する設定操作を受け付けると、実在の走行路及び仮想の走行路の双方を規定する仮想地図データの生成を行う。地図データ生成部３２３は、実地図データ及び仮想地図データを、マスタ地図データＤＢ３１４ａ及び後述する仮想地図データＤＢ３３５に格納する処理を行う。 The map data generation unit 323 generates, updates, and stores actual map data that defines a traveling path based on position coordinates acquired by actually traveling a position where an existing traveling path is installed. In the present embodiment, map information that defines existing travel paths is referred to as real map data, and map information that defines travel paths that do not exist (virtual travel paths) is referred to as virtual map data. When the map data generation unit 323 receives from the input device 317 a setting operation for adding a virtual traveling path that does not exist to the existing traveling path, virtual map data defining both the actual traveling path and the virtual traveling path. Generate the The map data generation unit 323 stores real map data and virtual map data in the master map data DB 314 a and a virtual map data DB 335 described later.
仮想車両シミュレーション部３３０は、入力装置３１７から走行路を仮想的に走行する仮想車両の設定操作を受け付けると、仮想車両のシミュレーションした走行状態を規定する走行パラメータ及び地図データ（実地図データ及び仮想地図データの双方を含む）を用いて、仮想車両が走行路を仮想的に走行した際のシミュレーションを行い、走行路上の仮想車両の仮想位置や速度、加速度等の走行状態を算出する。このとき、仮想車両シミュレーション部３３０は、仮想車両に対して設定された走行許可区間に基づいてシミュレーションを行う。例えば、走行許可区間の最前端に近づきつつあるにも関わらず、走行許可区間が設定されない場合には減速、停止の制動指令と、それに従った減速、停止動作をシミュレートする。仮想車両シミュレーション部３３０は、サーバ側通信制御部３１０と仮想通信を行うための機能を備えた仮想車両通信部３３１、仮想通信を介した管制制御部３２０からの指示（走行許可区間）や仮想車両の仮想位置を基に仮想車両の走行を制御する仮想走行制御部３３２、仮想走行制御部３３２の指示に基づき、仮想車両のシミュレーションした走行状態を規定する走行パラメータを用いて仮想車両の走行シミュレーションを行う走行シミュレーション部３３３、仮想車両のシミュレーションした走行状態を基に仮想位置や速度をシミュレーションするセンサシミュレーション部３３４、及び仮想車両が走行する走行路の情報を格納する仮想地図データＤＢ３３５を含む。 When virtual vehicle simulation unit 330 receives a setting operation of a virtual vehicle traveling on a traveling path virtually from input device 317, traveling parameters and map data (real map data and virtual map defining the traveling state simulated of the virtual vehicle) A simulation is performed when the virtual vehicle virtually travels the traveling path using both of the data), and the traveling state of the virtual vehicle on the traveling road, such as the virtual position, speed, and acceleration, 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, in the case where the traveling permitted section is not set despite approaching the front end of the traveling permitted section, the braking command for deceleration and stop and the corresponding deceleration and stopping operation are simulated. The virtual vehicle simulation unit 330 is a virtual vehicle communication unit 331 having a function for performing virtual communication with the server-side communication control unit 310, an instruction from the control control unit 320 via virtual communication (traveling permitted section), a virtual vehicle Based on the instructions of the virtual travel control unit 332 and virtual travel control unit 332 that control the travel of the virtual vehicle based on the virtual position of the virtual vehicle, the travel simulation of the virtual vehicle is performed using travel parameters that define the simulated travel state of the virtual vehicle. A traveling simulation unit 333 to be performed, a sensor simulation unit 334 that simulates a virtual position and a speed based on a simulated traveling state of a virtual vehicle, and a virtual map data DB 335 that stores information on traveling paths on which the virtual vehicle travels.
仮想車両通信部３３１は、サーバ側通信制御部３１０に対して仮想車両の仮想位置や区間要求メッセージを出力するとともに、サーバ側通信制御部３１０から区間応答メッセージ情報又は不許可応答メッセージを取得する。 The virtual vehicle communication unit 331 outputs the virtual position and section request message of the virtual vehicle to the server communication control section 310, and acquires section response message information or non-permission response message from the server communication control section 310.
仮想走行制御部３３２は、センサシミュレーション部３３４から自車両の現在位置（仮想位置）を取得し、仮想地図データＤＢ３３５の地図データを参照して、走行許可区間に従って仮想車両を走行させるための制御を走行シミュレーション部３３３に対して行う。 The virtual traveling control unit 332 acquires the current position (virtual position) of the vehicle from the sensor simulation unit 334, refers to the map data of the virtual map data DB 335, and controls the virtual vehicle to travel according to the traveling permitted section. This is performed on the traveling simulation unit 333.
走行シミュレーション部３３３は、あらかじめ設定した仮想車両の車体情報である、車両の重量、加速度、減速度、操舵速度等の性能（走行パラメータ）と、仮想走行制御部３３２からの制御指令に基づき、仮想車両の走行状態（加速、減速、停車）や位置を計算する。 The traveling simulation unit 333 is a virtual vehicle based on vehicle weight, acceleration, deceleration, steering speed and other performance (traveling parameters), which are vehicle information of a virtual vehicle set in advance, and a control command from the virtual traveling control unit 332. Calculates the traveling state (acceleration, deceleration, stop) and position of the vehicle.
センサシミュレーション部３３４は、走行シミュレーション部３３３の計算結果に基づく地図データ上の仮想車両の位置に対して、実際のセンシング誤差を模擬して確率的に誤差を加える補正を行うものであってもよく、あるいはＧＰＳ衛星の軌道を計算し、仮想車両の位置においてその時刻に捕捉できるＧＰＳ衛星の数や角度を取得し、ＧＰＳ衛星捕捉状況に応じた誤差を加える補正を行うものであってもよい。これにより、例えば、崖や山影などの影響により、走行路上の各点において測位電波の捕捉状況にばらつきが生じることに鑑みて、運搬車両にＧＰＳ及びＩＭＵを搭載し、相互の出力値を補間して運搬車両の位置算出精度の向上を図る場合であっても、仮想車両の位置を実車両で算出される位置により近づけて、シミュレーション結果の精度を向上させることができる。 The sensor simulation unit 334 may perform correction to simulate an actual sensing error and add an error stochastically to the position of the virtual vehicle on the map data based on the calculation result of the traveling simulation unit 333. Alternatively, the trajectory of a GPS satellite may be calculated, the number and angle of GPS satellites that can be captured at the time of the position of the virtual vehicle may be acquired, and correction may be performed to add an error according to the GPS satellite capture situation. Thus, for example, in view of the occurrence of variations in the capturing situation of positioning radio waves at each point on the traveling road due to the influence of cliffs and hill shadows, GPS and IMU are mounted on the transport vehicle, and the mutual output values are interpolated. Even when the position calculation accuracy of the transport vehicle is to be improved, the position of the virtual vehicle can be made closer to the position calculated by the actual vehicle, and the accuracy of the simulation result can be improved.
またこれに加え、センサシミュレーション部３３４は、仮想車両の位置と周囲の環境データに基づき、レーザーレーダセンサやミリ波レーダ、ステレオカメラ等のセンサによるセンシング状況をシミュレーションして、仮想センシングデータを生成し、仮想走行制御部３３２に計算結果を渡してもよい。 In addition to this, the sensor simulation unit 334, based on the environmental data of the position and surrounding virtual vehicle, the laser over radar sensor and a millimeter wave radar, to simulate the sensing status of the sensor such as a stereo camera, it generates the virtual sensing data The calculation result may be passed to the virtual traveling control unit 332.
仮想地図データＤＢ３３５は、仮想地図データを格納する。仮想地図データの例として、例えば、鉱山の掘削を進めていく計画上で生成予定にある走行路の地図データがある。また地図データは、センサのシミュレーションで使用するための座標位置に応じた周囲の地形などの環境データを含んでもよい。なお、仮想地図データＤＢ３３５が仮想地図データを格納し、実在する地図データを用いて実車両２０を稼働しながら、仮想地図データを仮想車両の走行シミュレーションを行う場合には、マスタ地図データＤＢ３１４ａも仮想地図データを格納する。 Virtual map data DB 335 stores virtual map data. As an example of virtual map data, there is, for example, map data of a traveling route which is scheduled to be generated on a plan of advancing mining excavation. The map data may also include environmental data such as surrounding terrain according to coordinate locations for use in sensor simulation. In the case where virtual map data DB 335 stores virtual map data and the virtual map data is run to simulate traveling of a virtual vehicle while operating real vehicle 20 using existing map data, master map data DB 314a is also virtual. Stores map data.
表示制御部３４０は、実地図データ、仮想地図データ、ダンプ２０及び仮想車両の其々の位置、及び各車両に対して設定された走行許可区間の情報を取得し、走行路を示す地図画像上にダンプ２０及び仮想車両を示す画像、及び設定された走行許可区間を示す画像を重畳表示する。このとき実際の走行路及び仮想走行路、また、ダンプ２０及び仮想車両は、弁別可能に表示態様を変えてもよい。図４では説明の便宜上、表示制御部３４０は、サーバ側通信制御部３１０及びＩ／Ｆ３１５に接続して図示したが、表示制御部３４０は、管制制御部３２０や仮想車両シミュレーション部３３０、またこれらに含まれる構成要素から表示対象となるデータを取得するように構成してもよい。 The display control unit 340 acquires actual map data, virtual map data, respective positions of the dump 20 and the virtual vehicle, and information of the travel permitted section set for each vehicle, and displays on the map image showing the travel path. The image showing the dump truck 20 and the virtual vehicle and the image showing the set travel permitted section are superimposed and displayed. At this time, the actual travel path and the virtual travel path, and the dump 20 and the virtual vehicle may change the display mode so as to be distinguishable. Although the display control unit 340 is illustrated as being connected to the server side communication control unit 310 and the I / F 315 for convenience of explanation in FIG. 4, the display control unit 340 includes the control control unit 320 and the virtual vehicle simulation unit 330. The data to be displayed may be acquired from the components included in.
管制サーバ３１が備えるサーバ側通信制御部３１０、管制制御部３２０（配車管理部３２１、走行許可区間設定部３２２）、仮想車両シミュレーション部３３０（仮想地図データＤＢ３３５を除く）は、これらの機能を実現するソフトウェアが図２に示すＣＰＵ３１１（ハードウェア）により実行されることにより構成される。また、マスタ地図データＤＢ３１４ａ、区間情報ＤＢ３１４ｂ、及び仮想地図データＤＢ３３５は、情報を固定的に格納可能な記憶装置、例えばＨＤＤにより構成される。 The server-side communication control unit 310, the control control unit 320 (the dispatch management unit 321, the travel permission section setting unit 322), and the virtual vehicle simulation unit 330 (except for the virtual map data DB 335) included in the control server 31 realize these functions. Software 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 capable of fixedly storing information, such as an HDD.
また仮想車両シミュレーション部３３０は、いくつかのソフトウェアのセットで構成されてもよく、稼働する仮想車両の台数に応じて前述のセットが複数あってもよい。または、一つのソフトウェア上で複数の仮想車両が稼働するものでもよい。あるいは、仮想車両シミュレーション部３３０は、管制サーバ３１と独立して管制センタ３０（図１参照）に置かれるコンピュータにより構成し、管制サーバ３１とイーサネット（登録商標）ケーブル、あるいは無線通信によって通信接続してもよい。マスタ地図データＤＢ３１４ａ、仮想地図データＤＢ３３５に格納される地図データは、ＨＤＤ３１４やマイクロプロセッサ上に格納されたデータとして構成される。 In addition, the virtual vehicle simulation unit 330 may be configured by several sets of software, and there may be a plurality of the above-mentioned sets according to the number of operating virtual vehicles. Alternatively, a plurality of virtual vehicles may operate on one software. Alternatively, the virtual vehicle simulation unit 330 is configured by a computer placed independently at the control center 30 (see FIG. 1) independently of the control server 31, and communicatively connected to the control server 31 by Ethernet (registered trademark) cable or wireless communication. May be The map data stored in the master map data DB 314 a 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 real 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.
要求情報処理部２６０は、ダンプ地図データＤＢ２０４ａに格納された地図データ及び位置算出装置２２０（図２参照）が算出した現在位置を基に、実車両２０が要求メッセージを送信する地点に到達したかを判断し、要求地点に到達すると要求メッセージを生成してダンプ側通信制御部２５０を介して管制サーバ３１に対して要求メッセージを送信する。 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 a 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 communication control unit 250.
自律走行制御部２７０は、位置算出装置２２０から自車両の現在位置を取得し、ダンプ地図データＤＢ２０４ａの地図データを参照して、区間応答メッセージに含まれる走行許可区間に従って自車両を走行させるための制御を走行駆動装置２１０（図２参照）に対して行う。また、自律走行制御部２７０は、車載センサ２３０の検知結果に基づいて前方障害物の有無を判定し、障害物との干渉、衝突の回避動作の有無も判定し、必要があれば制動動作のための制御を行う。更に自律走行制御部２７０は、管制サーバ３１からの指示に従って、制動装置２１１に対する駆動制御を行い、減速動作、通常停止動作、又は緊急停止動作を行う。 The autonomous traveling control unit 270 acquires the current position of the vehicle from the position calculation device 220, refers to the map data of the dump map data DB 204a, and causes the vehicle to travel according to the traveling permitted 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, and also determines the presence or absence of an interference with the obstacle and a collision avoidance operation. To control. Furthermore, the autonomous traveling control unit 270 performs drive control on the braking device 211 according to 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 software for realizing these functions being executed by the CPU 201 (hardware) shown in (b) of FIG. Ru. The map data stored in the dump map data 204 a is configured as data stored on the HDD 204 or the microprocessor.
次に、図６乃至図８を参照して、実車両及び仮想車両が実際の走行及び仮想走行をする際の管制サーバとの間の処理について説明する。本実施形態では、実車両を実際に走行させながら仮想車両の走行シミュレーションも合わせて行うので、以下の説明では、２台の実車両２０−１、２０−２と１台の仮想車両７０とを走行させた状態を例に挙げて説明する。図６は、実車両が実際に走行する露天掘り鉱山現場の構成例を示す図である。図７は、自律走行開始時における実車両及び仮想車両と管制サーバとの間の通信動作を示す図であって、（ａ）は実車両から目的地の要求メッセージを送信する状態を示し、（ｂ）は管制サーバからの応答状態を示し、（ｃ）は走行許可区間の要求及び応答状態を示す。図８は、走行許可区間の設定の詳細を示す図であって、（ａ）は実車両から目的地の要求メッセージを送信する状態を示し、（ｂ）は管制サーバからの応答メッセージを示し、（ｃ）は走行許可区間の要求及び応答状態を示す。 Next, with reference to FIG. 6 to FIG. 8, processing between the actual vehicle and the virtual vehicle when performing actual traveling and virtual traveling will be described. In the present embodiment, a running simulation of a virtual vehicle is also performed while actually running a real vehicle, so in the following description, two real vehicles 20-1 and 20-2 and one virtual vehicle 70 are used. The state in which the vehicle travels will be described as an example. FIG. 6 is a diagram showing a configuration example of an open pit mining site where a real vehicle actually travels. FIG. 7 is a diagram showing communication operation between an actual vehicle and a virtual vehicle and the control server at the start of autonomous traveling, where (a) shows a state where a request message of a destination is transmitted from the actual vehicle, b) shows the response state from the control server, and (c) shows the request and response state of the run permission section. FIG. 8 is a diagram showing the details of setting of the travel permission section, where (a) shows a state of transmitting a request message of a destination from an actual vehicle, (b) shows a response message from a control server, (C) shows the request and response status of the run permission section.
図６に示す符号６１は、ショベル１０などの鉱山機械による掘削現場及び鉱山機械がダンプ２０に積み込む積込場６１を示す。積込場６１のうち、ショベル１０の周辺にダンプ２０が停車し、積込作業が行われる位置を積込位置（図６のＬＰに相当する）と称する。ショベル１０が掘った表土や鉱石は、積込場６１で実車両２０に積み込まれる。符号６２は、表土を展開する放土場であり、積込場６１から運び込まれた表土などは、この場所で放土され、層状あるいは放射状に展開される。符号６３は鉱石を破砕処理するクラッシャなどが設置された放土場であり、破砕された鉱石はベルトコンベアなどにより貨車による積み出し場あるいは処理設備などに搬送される。 The code | symbol 61 shown in FIG. 6 shows the loading spot 61 which the excavation site by mining machines, such as the shovel 10, and a mining machine load in the dump truck 20. As shown in FIG. In the loading site 61, the dump truck 20 stops around the shovel 10, and the position where the loading operation is performed is referred to as a loading position (corresponding to LP in FIG. 6). Topsoil and ore excavated by the shovel 10 are loaded into the real vehicle 20 at the loading station 61. Reference numeral 62 denotes an earth release site for developing the topsoil. Top soil and the like carried in from the loading site 61 are released at this site and developed in layers or in a radial fashion. Reference numeral 63 denotes an earth release site where a crusher or the like for crushing ore is installed, and the crushed ore is transported to a delivery site by freight cars or a processing facility by a belt conveyor or the like.
また、図６のＱＰは、積込場６１への入口であり、かつショベル１０からダンプに対して積込位置への進入許可（ＣＡＬＬ）がされるまで、ダンプ２０が停車して待つ待機位置を示す。図６のＥＸＩＴは、積込場６１からダンプ２０が退出する出口である。 Further, QP in FIG. 6 is an entrance to the loading station 61, and is a standby position where the dump 20 stops and waits until the shovel 10 permits the dump to enter the loading position (CALL). Indicates EXIT in FIG. 6 is an exit from which the dump 20 exits from the loading station 61.
実車両２０−１、２０−２や仮想車両７０は、積込場６１で表土や鉱石を積込み、搬送路６０を走行してそれらを放土場６２や６３に搬送する。搬送路６０には、走行路６４が設定されており、実車両２０および仮想車両７０は、走行路６４に沿って走行する。走行路６４は、地図上で設定された座標値として与えられる。実車両２０−１、２０−２は、ＧＰＳや他の位置算出装置により特定した自己位置と走行路６４の座標値を比較しながら加減速やステアリングを制御することにより、走行路６４に沿って自律走行する。 The actual vehicles 20-1 and 20-2 and the virtual vehicle 70 load the topsoil and ore at the loading station 61, travel on the transport path 60, and transport them to the earth release station 62 and 63. A travel path 64 is set on the conveyance path 60, and the real vehicle 20 and the virtual vehicle 70 travel along the travel path 64. The traveling 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 the steering while comparing the self position specified by the GPS and the other position calculation device with the coordinate value of the travel path 64, thereby along the travel path 64. Run autonomously.
また、仮想車両７０も同様に、仮想走行制御部３３２がセンサシミュレーション部３３４により特定した自己位置と走行路６４の座標値を比較して走行制御を行い、走行シミュレーション部３３３が仮想的な車両の走行を計算する。 Similarly, in the virtual vehicle 70, the traveling control is performed by comparing the own position specified by the sensor simulation unit 334 with the virtual traveling control unit 332 and the coordinate value of the traveling path 64, and the traveling simulation unit 333 performs virtual vehicle control. Calculate the run.
また、走行路６４上には走行路の区間の境界を示すノード６５と、隣接するノード６５を接続するリンク６６が設けられている。実在する走行路６４とノード６５、リンク６６の情報は、マスタ地図データＤＢ３１４ａ、仮想地図データＤＢ３３５、及びダンプ地図データＤＢ２０４ａに同一の地図データとして格納されている。ただし、仮想車両シミュレーション部３３０の仮想地図データＤＢ３３５が仮想の走行路を含む場合は、仮想地図データは、マスタ地図データＤＢ３１４ａ及びダンプ地図データＤＢ２０４ａに格納される実地図データよりも多い走行路の情報を含んでもよい。 Further, on the traveling path 64, a node 65 indicating the boundary of the section of the traveling path and a link 66 connecting the adjacent nodes 65 are provided. The information on the existing travel 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. However, when the virtual map data DB 335 of the virtual vehicle simulation unit 330 includes a virtual travel path, the virtual map data is information on travel paths more than the real map data stored in the master map data DB 314a and the dump map data DB 204a. May be included.
管制サーバ３１は、管制制御部３２０によって、隣接する２つのノード６５及び１つのリンク６６を含む走行区間毎に走行許可の付与・解除を行い、その情報を区間情報として実車両２０と仮想車両７０に通知する。これにより、実車両および仮想車両同士の衝突を避けるように走行を制御する。また走行路６４は区間ごとに制限速度が設けられており、実車両２０および仮想車両７０はそれぞれダンプ地図データＤＢ２０４ａ及び仮想地図データＤＢ３３５の制限速度情報を参照しながら、適切な速度で走行又は仮想走行する。 The control server 31 causes the control control unit 320 to grant and cancel the travel permission for each traveling section including two adjacent nodes 65 and one link 66, and uses the information as section information for the real vehicle 20 and the virtual vehicle 70. Notify In this way, traveling is controlled so as to avoid collision between the real vehicle and the virtual vehicle. Further, the travel path 64 is provided with a speed limit for each section, and the real vehicle 20 and the virtual vehicle 70 travel or virtual at an appropriate speed while referring to the speed limit information of the dump map data DB 204a and the virtual map data DB 335, respectively. Run.
実車両２０（以下、仮想車両７０についても同様）は、積込場６１で表土や鉱石を積み込み完了した状態、あるいは放土場６２や６３において放土し終わった状態において、実車両２０は図７の（ａ）に示すように管制サーバ３１に対して目的地を要求するメッセージ（目的地要求メッセージ）を送信する。これは、実車両２０の場合、実車両２０の走行制御装置２００に含まれる要求情報処理部２６０が現在の自己位置や車両の状況（停車中）を判断してダンプ側通信制御部２５０を介して発信するものである。仮想車両７０の場合も同様に、仮想走行制御部３３２が自車状況を判断して仮想車両通信部３３１を介して発信する。 In the state where loading of the topsoil and ore at the loading station 61 is completed, or the actual vehicle 20 is released at the dumping site 62 or 63, the actual vehicle 20 (see below also for the virtual vehicle 70) is illustrated in FIG. As shown in 7 (a), a message (destination request message) for requesting a destination is transmitted to the control server 31. This is the case of the actual vehicle 20, via a dump-end communication control section 250 requests the information processing unit 260 included in the travel control unit 200 of the actual vehicle 20 to determine the status of the current self-position and the vehicle (parked) Sending out. Similarly, in the case of the virtual vehicle 70, the virtual traveling control unit 332 determines the own vehicle condition and transmits it 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 of the section information DB 314 b and takes into consideration the conditions of the other real vehicles 20 and the virtual vehicles 70, and the destination of the dump truck that has requested the destination. And the route to the destination is determined, and 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 (b) in FIG. 7).
すると、実車両２０上の要求情報処理部２６０が、走行許可区間の設定要求をするメッセージ（区間要求メッセージ）を管制サーバ３１に送信する。サーバ側通信制御部３１０は、区間要求メッセージを管制制御部３２０に伝える。管制制御部３２０の走行許可区間設定部３２２は、以下に説明する処理に基づいて走行許可区間８２を設定し、設定した走行許可区間を示すメッセージ（区間応答メッセージ）を実車両２０に送信する（図７の（ｃ））。区間応答メッセージは、走行許可区間の最前端のノードを固有に識別する情報（ノードＩＤ）、最後端のノードＩＤ、及び走行許可区間に含まれるリンクを固有に識別する情報（リンクＩＤ）が含まれる。実車両２０は、走行許可区間を得て初めて走行を開始することができる。 Then, the request information processing unit 260 on the real vehicle 20 transmits, to the control server 31, a message (section request message) for requesting setting of the travel permission section. Server-side communication control section 3 1 0 conveys the interval request message to control the control unit 320. The travel permission section setting unit 322 of the control control section 320 sets the travel permission section 82 based on the processing described below, and transmits a message (section response message) indicating the set travel permission section to the real vehicle 20 ( (C) of FIG. The section response message includes information (node ID) that uniquely identifies the front end node of the run permission section, node ID of the rear end, and information (link ID) that uniquely identifies the link included in the run permission section. Be The real vehicle 20 can start traveling only after obtaining the travel permission section.
走行路６４のどの区間が、どの車両（実車両及び仮想車両の双方を含む）に対して走行許可を与えられているかは、走行許可区間設定部３２２が走行許可区間の付与及び削除をする度に区間情報ＤＢ３１４ｂに格納された区間情報を随時更新して管理する。そして走行許可区間設定部３２２は車両からの走行許可要求があると、区間情報及びマスタ地図データＤＢ３１４ａに格納された地図データを参照して走行許可区間の設定を行う。 As to which section of the travel path 64 is granted the travel permission to which vehicle (including both the real vehicle and the virtual vehicle), the travel permitted section setting unit 322 applies and deletes the travel permitted section. The section information stored in the section information DB 314 b is updated and managed as needed. When the travel permission request from the vehicle is received, 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.
走行許可区間の設定に際し、走行許可区間設定部３２２は、既に他の車両に対して許可されている区間については、車両からの要求があっても走行許可しないように制御を行うことで、同一の区間内に車両が複数台進入しないようにする。 When setting the travel permitted section, the travel permitted section setting unit 322 performs the same control by performing control such that the travel is not permitted even if there is a request from the vehicle for the section already permitted for another vehicle. Make sure that multiple vehicles do not enter in the section
一方、車両側では、管制サーバ３１から受信した走行許可区間を車両上のマスタ地図データＤＢ３１４ａ（仮想車両７０の場合は、仮想地図データＤＢ３３５）に記録し、これを参照しながら自律走行又は仮想走行することで、どこまで走行することができるかを判断する。 On the other hand, on the vehicle side, the travel permitted section received from control server 31 is recorded in master map data DB 314a (virtual map data DB 335 in the case of virtual vehicle 70) on the vehicle, and autonomous traveling or virtual traveling By doing this, you can determine how far you can travel.
走行許可区間の設定状況は、区間応答メッセージに含まれる最前端ノードＩＤ、最後端ノードＩＤ、及びそれらの間に位置するリンクＩＤを走行許可区間に含まれるリンク６６を固有に示す固有情報（リンクＩＤ）を用いて管理する。管制サーバ３１は区間情報ＤＢ３１４ｂの区間情報に上記最前端ノードＩＤ、最後端ノードＩＤ、及びそれらの間に位置するリンクＩＤを記録するが、管制制御部３２０の走行許可区間設定部３２２が一次的に記録することで管理する。また、各車両側については実車両２０の場合は自律走行制御部２７０、仮想車両７０の場合は仮想走行制御部３３２が一次的に最前端ノードＩＤ、最後端ノードＩＤ、及びそれらの間に位置するリンクＩＤを記録して、マスタ地図データＤＢ３１４ａや仮想地図データＤＢ３３５には記録しないように構成してもよい。 The setting status of the travel permission section is a unique information uniquely indicating the link 66 included in the travel permission section (the link ID located between the foremost end node ID and the rear end node ID included in the section response message, and the link ID) Manage using ID). Control server 31 segment information DB314b section information to the foremost end node ID of the last-end node ID, and is to record the link ID which is positioned between them, run permission section setting unit 322 of the control the control unit 320 is primarily Manage by recording in. In addition, for each vehicle side, in the case of the real vehicle 20, the autonomous traveling control unit 270 in the case of the virtual vehicle 70 and the virtual traveling control unit 332 in the case of the virtual vehicle 70 temporarily The link ID may be recorded and not recorded in the master map data DB 314 a or the virtual map data DB 335.
新しい走行許可区間が設定されると同時に、既に通過し終えた走行許可区間は解放される。 At the same time as the new travel permission section is set, the travel permission section that has already passed is released.
次に、走行許可区間の設定の詳細について図８を参照して説明する。図８の（ａ）において、実車両２０−１、２０−２は走行中の車両であり、符号８１−１、８１−２はそれぞれの車両に許可されている走行許可区間である。実車両２０−１、２０−２は、いずれも矢印Ａに示す方向に走行しているものとする。符号８３は、実車両２０−１の現在位置から走行許可区間８１−１の最前端（終端）までの走行路に沿った距離を示す走行許可残存距離である。符号８４は、最前端（終端）から実車両２０−１が区間要求メッセージの送信を開始する点までの距離を示す走行許可要求開始距離である。 Next, details of setting of the travel permission section will be described with reference to FIG. In (a) of FIG. 8, actual vehicles 20-1 and 20-2 are vehicles in travel, and reference numerals 81-1 and 81-2 are travel permission sections permitted for the respective vehicles. The real vehicles 20-1 and 20-2 are both traveling in the direction indicated by the arrow A. The code | symbol 83 is driving | running | working permission residual distance which shows the distance along the traveling path from the present position of the real vehicle 20-1 to the foremost end (termination) of the traveling permission area 81-1. Reference numeral 84, from the foremost end (termination) the actual vehicle 20 - a travel permission request starting distance indicating a distance to the point where 1 starts transmission of the interval request message.
走行許可要求開始距離８４は、実車両が停止可能な距離よりも長い距離であり、例えば停止可能距離に所定のオフセット距離を加えたものである。実車両の停止可能な距離Ｌは、例えば、車両の積荷を含めた質量をｍ、車両の現在の速度をｖ、車両の制動力をｆ、安全率に対応して規定されるオフセット係数ｃとすると、下式（１）により求められる。
オフセット係数ｃは１以上の値であって、例えば無線通信にかかる時間や無線通信の障害の発生度合いなどを考慮して設定する。車両の速度は、車両の現在速度を車輪の回転数などから測定したものであってもよく、また、車両の現在の走行位置に対して地図データで規定されている制限速度（最大許容速度）を用いてもよい。 The offset coefficient c is a value of one or more, and is set in consideration of, for example, the time required for wireless communication, the degree of occurrence of a failure in wireless communication, and the like. The speed of the vehicle may be obtained by measuring the current speed of the vehicle from the number of rotations of the wheels, etc. Also, the speed limit defined in the map data with respect to the current traveling position of the vehicle (maximum allowable speed) May be used.
図８の（ａ）に示すように、実車両２０−１の走行許可残存距離８３が走行許可要求開始距離８４以下となったとき、実車両２０−１は、管制サーバ３１に対して区間要求メッセージを送信する。この区間要求メッセージには、実車両２０−１の現在位置情報も含まれる。 As shown in (a) of FIG. 8, when the travel permission remaining distance 83 of the real vehicle 20-1 becomes equal to or less than the travel permission request start distance 84, the real vehicle 20-1 requests the control server 31 for a section Send a message The section request message also includes current position information of the real vehicle 20-1.
管制サーバ３１は、実車両２０−１から区間要求メッセージを受け取ると、送られてきた現在位置情報を用いて実車両２０−１が存在する走行区間を特定する。そして、実車両２０−１の進行方向に沿って、実車両２０−１の存在する区間の終端から予め定められた走行許可区間として与えられる最短距離（走行許可付与長さ）以上となる区間に対して走行許可を与える。但し、他の車両（実車両又は仮想車両）に許可が与えられている区間がある場合には、その手前までについて走行許可を与える。 When the control server 31 receives the section request message from the real vehicle 20-1, the control server 31 specifies a traveling 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, from the end of the section where the actual vehicle 20-1 exists to a section which is equal to or longer than the shortest distance (the travel permission granting length) given as a travel permission section determined in advance. Give travel permission to. However, if there is a section for which permission is given to another vehicle (actual vehicle or virtual vehicle), the travel permission is given up to that side.
図８の（ｂ）に示す例では、実車両２０−１が存在する区間は８５であり、その終端から走行許可付与長さ９０以上の区間は、８６、８７、８８、８９となる。但し、区間８８、８９は既に実車両２０−２に走行許可が与えられているので、８６、８７の走行許可が与えられる。なお、区間８６は既に走行許可が与えられているので、この場合、結果として区間８７が新たな走行許可区間として与えられることになる。 In the example shown in (b) of FIG. 8, the section in which the actual vehicle 20-1 is present is 85, and the section from which the travel permission given length is 90 or more is 86, 87, 88, 89 from the end thereof. However, since travel permission is already given to the real vehicle 20-2 in sections 88 and 89, travel permission for 86 and 87 is given. Since the travel permission has already been given to the section 86, in this case, as a result, the section 87 is given as a new travel permitted section.
走行許可を与えられた区間は、車両がその区間を通過した後に、車両の位置から区間の終端までの距離が走行許可解除距離以上となったときに解除される。図８の（ｃ）の例では、実車両２０−１に走行許可が与えられていた区間８８は、実車両２０−２と区間終端までの距離９１が走行許可解除距離９２以上となった段階で走行許可が解除され、後続の実車両２０−１への走行許可割り当てが可能となる。 The section to which the travel permission is given is canceled when the distance from the position of the vehicle to the end of the section becomes equal to or greater than the travel permission release distance after the vehicle passes through the section. In the example of (c) of FIG. 8, in the section 88 where the travel permission is given to the real vehicle 20-1, the stage at which the distance 91 between the real vehicle 20-2 and the section end becomes the travel permission cancellation distance 92 or more. The travel permission is cancelled, and the travel permission assignment to the subsequent real vehicle 20-1 becomes possible.
次に、本実施形態に係る自律走行システムの動作手順の概略を、図９を参照して説明する。図９は、本実施形態に係る管制サーバを含む自律走行システムの動作手順の概略を示すフローチャートである。 Next, an outline of the operation procedure of the autonomous traveling system according to the present embodiment will be described with reference to FIG. FIG. 9 is a flowchart showing an outline of the operation procedure of the autonomous traveling system including the control server according to the present embodiment.
まず、地図データ生成部３２３による地図データ生成処理を行う（Ｓ９０１）。地図データ生成処理の詳細については後述する。 First, 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.
次いで実車両２０を必要な台数分稼動させる（Ｓ９０２）。本ステップでは、管制サーバ３１により実車両だけの管制制御処理（詳細は後述する）が継続的に行われる。 Next, the required number of real vehicles 20 is operated (S902). In this step, the control server 31 continuously performs control control processing (details will be described later) of the actual vehicle.
仮想車両を混走させてシミュレーションをしない場合（Ｓ９０３／Ｎｏ）、ステップＳ９０２へ戻り、管制サーバ３１のシミュレーション機能を用いることなく実車両のみを対象とした管制制御処理を続行する。 If the simulation is not performed by mixing the virtual vehicles (S903 / No), the process returns to step S902, and control control processing for only real vehicles is continued without using the simulation function of the control server 31.
仮想車両を混走させてシミュレーションをする場合（Ｓ９０３／Ｙｅｓ）、ダンプ２０を実走させた状態で、ユーザは管制サーバ３１のＧＵＩ（グラフィカルインターフェース：表示装置３１６及び入力装置３１７に相当する）を用いて仮想車両を実車両の運行状況に追加する（Ｓ９０４）。 When simulating by mixing virtual vehicles (S903 / Yes), the user uses the GUI of the control server 31 (graphical interface: corresponding to the display device 316 and the input device 317) in a state where the dump 20 is actually run. The virtual vehicle is added to the operation status of the actual vehicle (S904).
仮想車両シミュレーション部３３０により走行シミュレーションを行い、その結果を管制制御部３２０に出力する。管制制御部３２０は、実際に走行中の車両（実車両）と仮想車両シミュレーション部３３０から取得した仮想車両とを混走させて管制制御処理を行う（Ｓ９０５）。ここでの実車両及び仮想車両を混走させた管制制御処理の詳細については後述する。 The virtual vehicle simulation unit 330 performs traveling simulation and outputs the result to the control control unit 320. The control control unit 320 performs control control processing by causing the vehicle (actual vehicle) actually traveling and the virtual vehicle acquired from the virtual vehicle simulation unit 330 to coexist (S905). Details of the control control processing in which the real vehicle and the virtual vehicle are mixed here will be described later.
ユーザは、仮想車両を削除したい場合（Ｓ９０６／Ｙｅｓ）、削除した仮想車両を指定して削除処理を行う（Ｓ９０７）。仮想車両を削除したい場合とは、例えば、仮想車両を用いたシミュレーション処理を終了して、実車両のみの管制制御処理に戻したい場合の他、複数の仮想車両を加えてシミュレーションを行ったが望ましい結果が得られない場合に、仮想車両の台数を減らして再度シミュレーションを行う場合などがある。その後、ステップＳ９０２へ戻る。 When the user wants to delete the virtual vehicle (S906 / Yes), the user specifies the deleted virtual vehicle and performs deletion processing (S907). In the case where it is desired to delete a virtual vehicle, for example, simulation processing using a virtual vehicle is ended, and in addition to a case where control control processing of only real vehicles is desired to be returned, simulation is preferably performed by adding a plurality of virtual vehicles When a result is not obtained, the number of virtual vehicles may be reduced and simulation may be performed again. Thereafter, the process returns to step S902.
仮想車両を削除しない場合（Ｓ９０６／Ｎｏ）、ステップＳ９０５へ戻り、実車両と仮想車両を混走させて管制制御処理を続行する。 If you do not want to delete the virtual vehicle (S906 / No), it returns to step S905, to continue the control control processing by travel together the virtual vehicle and the actual vehicle.
（地図データ生成処理）
図１０及び図１１を参照して、地図データ生成処理について説明する。図１０は、地図データ生成処理の流れを示すフローチャートである。図１１を参照して地図データの構成例について説明する。図１１は、地図データの一例を示す図であって、（ａ）はリンク情報を示し、（ｂ）はノード情報を示す。以下で説明する地図データ生成処理は、地図データ生成部３２３を用いて仮想地図を生成し、仮想車両を用いた走行シミュレーションを経てマスタ地図データＤＢ３１４ａに実地図データとして格納する処理である。
(Map data generation process)
Map data generation processing will be described with reference to FIGS. 10 and 11. FIG. 10 is a flowchart showing the flow of map data generation processing. A configuration example of map data will be described with reference to FIG. FIG. 11 is a diagram showing an example of map data, wherein (a) shows link information and (b) shows node information. Map data generation process described below is a process of generating a virtual map using the map data generation unit 323, and stores the actual map data in the master map data DB314a through traveling simulation using a virtual vehicle.
まず、地図データを生成するに当たり、ＧＰＳを搭載した車両で新たに追加する走行路を有人走行し、その結果に基づき、地図データを生成するためのセンサデータを収集する。ＧＰＳを搭載した車両は、例えば地図を生成するためのデータ収集専用の車両（航測車）でもよいし、自律走行ダンプトラックを地図計測モードに設定し、ダンプに搭載されたＧＰＳを用いて位置情報を収集しながら有人走行を行ってもよい。またＧＰＳ以外にも、レーザレーダなどのセンサを用いて周囲の地形形状を計測するようにしてもよい。 First, in order to generate map data, a vehicle equipped with a GPS carries on a traveling route to be newly added, and sensor data for generating map data is collected based on the result. The vehicle equipped with GPS may be, for example, a vehicle exclusively used for data collection for generating a map (vehicle measurement), or an autonomous traveling dump truck may be set to the map measurement mode, and position information using GPS mounted on the dump. You may travel manned while collecting In addition to the GPS, a sensor such as a laser radar may be used to measure the topography of the surrounding area.
次いで地図データ生成部３２３は、収集したセンサデータを用いて地図データを生成する（Ｓ１００１）。この処理は例えば、時系列の座標点列からクラスタリングを行い、搬送路の形状に応じて適切な間隔でノードを生成し、走行路を生成するような処理であってもよい。地図データ生成部３２３は、生成した地図データを仮想地図データＤＢ３３５に格納する。この地図データは仮想地図データに相当する。 Next, the map data generation unit 323 generates map data using the collected sensor data (S1001). This process may be, for example, a process of performing clustering from a time-series coordinate point sequence, generating nodes at appropriate intervals according to the shape of the transport path, and generating a travel path. 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.
地図データは、走行路上のノードとそのつながりを示すリンクで表されている。図１１の（ａ）に示すように、地図データにはリンクを識別するためのリンクＩＤ１１０１とそのリンクが始まる座標にあるノードＩＤ１１０２、リンクの終わる座標にあるノードＩＤ１１０３、リンク始点に接続される別のリンクＩＤ１１０４（複数存在する場合もある。）、及びリンク終点に接続される別のリンクＩＤ１１０５（複数存在する場合もある。）を規定するテーブルがある。更に図１１の（ｂ）に示すように、ノードＩＤ１１０６に対応する座標値１１０７、その属性１１０８のテーブルが存在する。このノードＩＤのうち、いずれかを積載地点もしくは放土地点として属性１１０８に設定されている。 Map data is represented by links on nodes on the road and their links. As shown in FIG. 11A, in the map data, a link ID 1101 for identifying a link, a node ID 1102 at a coordinate at which the link starts, a node ID 1103 at a coordinate at which the link ends, Of the link ID 1104 (there may be a plurality of links) and another link ID 1105 (there may be a plurality of links) connected to the link end point. Further, as shown in (b) of FIG. 11, there is a table of coordinate values 1107 corresponding to the node ID 1106 and its attribute 1108. One of the node IDs is set in the attribute 1108 as a loading point or a land point.
仮想地図データが生成されると、仮想走行制御部３３２は仮想地図データＤＢ３３５に格納された仮想地図を参照し、走行シミュレーション部３３３に対して仮想地図に沿って仮想車両を走行させるシミュレーション処理を実行させ、ダンプトラックのモデルが、生成した走行路データに適切に追従できることを確認する（Ｓ１００２）。これは、例えば生成した走行路のカーブがきつ過ぎて車両が旋回し切れなかったり、ノードの間隔が不適切なために管制制御がうまくいかなかったりといった不具合がないことを確認するために必要である。この確認の際のシステム構成としては、管制サーバ３１に対し仮想車両１台でもよいし、複数台を同時に管制する形でもよい。また、鉱山内の地図更新に関係のないエリアについては、既存の搬送路や既存の実車が稼働し続けるような構成としてもよい。仮想車両のシミュレーションが正常に行えると、地図データ生成部３２３は、検証した仮想地図をマスタ地図データＤＢ３１４ａに実地図データとして格納する。 When virtual map data is generated, the virtual travel control unit 332 refers to the virtual map stored in the virtual map data DB 335, and executes simulation processing for causing the travel simulation unit 333 to travel the virtual vehicle along the virtual map. , And confirm that the dump truck model can appropriately follow the generated traveling route data (S1002). This is necessary, for example, to confirm that there are no problems such as that the curve of the generated travel path is too tight and the vehicle can not turn or the control control does not work because the distance between the nodes is inadequate. is there. As a system configuration at the time of this confirmation, one virtual vehicle may be provided to the control server 31, or a plurality of vehicles may be simultaneously controlled. In addition, existing transportation paths and existing vehicles may continue to operate for areas not related to map update in the mine. When the simulation of the virtual vehicle is performed successfully, the map data producing formation unit 323 stores the actual map data virtual map of verifying the master map data DB314a.
管制制御部３２０はマスタ地図データＤＢ３１４ａに格納された実地図データを参照しながら、自律走行ダンプトラックの実車両１台を走行させ、地図データと実際の搬送路が一致しているかを確認する（Ｓ１００３）。地図データを生成する際、例えばＧＰＳによるデータ取得では、その時の衛星配置や周囲の地形による遮蔽により、データに誤差が乗る場合がある。またソフトウェアで走行路を生成する処理によっても、誤差が乗ってしまう場合がある。もちろんそのようなことのないように、正しい走行路を生成するような地図データ生成ソフトウェアとすることが望ましいが、信頼性を完全に保証することは難しく、動作確認は必要である。実車両１台で走行する際には、万が一走行路のデータが搬送路上の正しい位置から外れていたとしても、例えばレーザレーダによる路肩検出機能によって、走行路の位置が正しくないことを検出することができる。 The control control unit 320 causes one real vehicle of the autonomous traveling dump truck to travel and checks whether the map data matches the actual transport path while referring to the real map data stored in the master map data DB 314a ( S1003). When generating map data, for example, in data acquisition by GPS, errors may occur in the data due to the satellite arrangement at that time and shielding by surrounding terrain. In addition, an error may be acquired even by the process of generating a traveling path by software. Of course, it is desirable to use map data generation software that generates a correct travel path so as not to do such a thing, but it is difficult to completely guarantee the reliability, and operation confirmation is necessary. When traveling with one actual vehicle, even if the data of the traveling route should be out of the correct position on the transporting route, for example, the road shoulder detection function by laser radar should detect that the position of the traveling route is not correct. Can.
走行路の位置が正しくないことが判明した場合（Ｓ１００４／Ｎｏ）、もう一度ＧＰＳデータ等の収集、地図データ生成を行う（Ｓ１００１）。 If it is determined that the position of the traveling path is not correct (S1004 / No), collection of GPS data etc. and generation of map data are performed again (S1001).
実車両１台で走行路に対する実地図データの正しさを確認できたら（Ｓ１００４／Ｙｅｓ）、稼働させたい必要な台数と同数の仮想車両で走行シミュレーションを行う（Ｓ１００５）。この段階において、例えば合流地点や狭路など、実車両複数台での稼働では衝突の懸念がある地点が残っていないかを検証する。 If the correctness of the actual map data for the traveling road can be confirmed by one actual vehicle (S1004 / Yes), the driving simulation is performed with the same number of virtual vehicles as the number required to operate (S1005). At this stage, it is verified, for example, whether there is a point where there is a concern of collision in operation with a plurality of actual vehicles, such as a junction or a narrow road.
複数台のシミュレーション結果が良好（実車両の走行が可能）であれば（Ｓ１００６／Ｙｅｓ）、地図データ生成処理を終了する。複数台のシミュレーション結果が不良（実車両の走行に支障がある）であれば（Ｓ１００６／Ｎｏ）、ステップＳ１００１へ戻り、再度地図データの生成を行う。 If a plurality of simulation results are good (the actual vehicle can travel) (S1006 / Yes), the map data generation process is ended. If defective plurality of simulation results (it interferes with the running of the actual vehicle) (S1006 / No), the process returns to step S1001, the and generates the map data again.
以上、地図データ生成時の車両の動作確認を行うことで、鉱山の地形変化に対して安全に対応することができる。特に本実施形態では、実車両の管制制御を行う管制サーバにシミュレーション機能を実装することにより、外部にシミュレーション機能を備えたソフトウェアを用意することなく、仮想車両を利用して素早く動作確認を行うことができる。 As described above, by checking the operation of the vehicle at the time of map data generation, it is possible to safely cope with the topography change of the mine. In particular, in the present embodiment, by implementing a simulation function on a control server that performs control control of an actual vehicle, operation check can be performed quickly using a virtual vehicle without preparing software with a simulation function outside. Can.
（実車両だけの管制制御処理）
次に図１２を参照して実車両だけの管制制御処理について説明する。図１２は、実車両だけの管制制御処理の流れを示すフローチャートである。なお、図１２では、実車両２０の走行制御装置２００及び管制サーバ３１で実施される処理の流れを示すが、実車両に対する管制制御処理と仮想車両に対する管制制御処理とは同様の処理であるため、走行制御装置２００及びその構成要素を仮想車両シミュレーション部３３０及びその構成要素に読みかえることで、仮想車両の管制制御も行える。以下、図１２の各ステップ順に沿って説明する。
(Control control processing for real vehicles only)
Next, with reference to FIG. 12, control control processing of only the actual vehicle will be described. FIG. 12 is a flow chart showing the flow of control control processing of an actual vehicle only. Although FIG. 12 shows the flow of processing performed by the travel control device 200 and the control server 31 of the actual vehicle 20, the control control processing for the actual vehicle and the control control processing for the virtual vehicle are the same processing. The control control of the virtual vehicle can also be performed by reading the travel control device 200 and the components thereof as the virtual vehicle simulation unit 330 and the components thereof. The steps will be described below in order of FIG.
まず、実車両２０の目的地が設定されていない場合（Ｓ１２０１／Ｎｏ）、走行制御装置２００の要求情報処理部２６０は、無線通信回線４０を介して管制サーバ３１に目的地要求メッセージ（現在位置情報を含む）を送信する（Ｓ１２０２）。実車両２０の目的地が設定されている場合（Ｓ１２０１／Ｙｅｓ）は、ステップＳ１２０４へ進む。 First, when the destination of the real vehicle 20 is not set (S1201 / No), the request information processing unit 260 of the traveling control device 200 sends the destination request message (current position to the control server 31 via the wireless communication line 40) The information is transmitted (S1202). If the destination of the real vehicle 20 is set (S1201 / Yes), the process proceeds to step S1204.
管制サーバ３１の配車管理部３２１が実車両２０の現在位置情報とマスタ地図データＤＢ３１４ａの実地図データを参照して目的地を設定し、その結果を示す目的地応答メッセージを実車両２０に対して送信する（Ｓ１２０３）。 The dispatch management unit 321 of the control server 31 sets a destination with reference to the current position information of the real vehicle 20 and the real map data of the master map data DB 314a, and sends a destination response message indicating the result to the real vehicle 20. Send (S1203 ).
区間要求メッセージの送信が必要な場合、例えば実車両２０は走行許可区間が設定されていない場合、または現在の走行許可区間から走行許可残存距離が走行許可要求開始距離以下である場合（図８の（ａ）参照、Ｓ１２０４／Ｙｅｓ）は、要求情報処理部２６０から区間要求メッセージを送信する（Ｓ１２０５）。 When transmission of the section request message is necessary, for example, when the travel permission section is not set for the actual vehicle 20, or when the travel permission remaining distance from the current travel permission section is equal to or less than the travel permission request start distance (FIG. (A) Reference: S1204 / Yes) transmits a section request message from the request information processing unit 260 (S1205).
区間要求メッセージの送信が不必要な場合、即ち、既に走行許可区間が設定されており、走行許可残存距離が走行許可要求開始距離より長い場合（Ｓ１２０４／Ｎｏ）や、区間要求メッセージを受信した場合、自律走行をする（Ｓ１２０６）。 When transmission of the section request message is unnecessary, that is, when the travel permission section has already been set, and the travel permission remaining distance is longer than the travel permission request start distance (S 1204 / No), or when the section request message is received , Run autonomously (S1206).
実車両２０は区間要求メッセージを送信後、現在付与されている走行許可区間に従って走行を続けながら、管制サーバ３１からの区間応答メッセージの受信を待機する。実車両２０は走行中に定期的に現在位置を管制サーバ３１に送信する。自律走行制御部２７０は、位置算出装置２２０からの現在位置とダンプ地図データＤＢ２０４ａ、及び現在付与されている走行許可区間とを比較し、走行許可残存距離が停止可能距離以下である場合（Ｓ１２０７／Ｙｅｓ）、走行許可区間内で停止するように走行駆動装置２１０の制動装置２１１に対して制動指示を行い、実車両２０が減速を開始する（Ｓ１２０８）。 After transmitting the section request message, the actual vehicle 20 waits for reception of the section response message from the control server 31 while continuing traveling in accordance with the currently permitted travel permitted section. The actual vehicle 20 periodically transmits the current position to the control server 31 while traveling. The autonomous traveling control unit 270 compares the current position from the position calculation device 220 with the dump map data DB 204a and the currently permitted traveling permitted section, and if the traveling permitted remaining distance is equal to or less than the stoppable distance (S1207 / Yes), a braking instruction is issued to the braking device 211 of the traveling drive device 210 so as to stop within the travel permission section, and the actual vehicle 20 starts to decelerate (S1208).
管制サーバ３１は区間要求メッセージを受信すると、走行許可区間設定部３２２が実車両２０の現在位置及びマスタ地図データＤＢ３１４ａに格納された地図情報に基づいて、走行許可区間を設定し、その内容を示す区間応答メッセージを実車両２０に対して送信する（Ｓ１２０９）。走行許可区間設定部３２２は、受信した車両の現在位置と区間情報ＤＢ３１４ｂの区間情報を用いて、車両の進行方向に対して車両の存在する区間の終端から走行許可付与長さ以上となる区間について、他の車両に許可が与えられていない限り、あるいは他の車両に許可が与えられている区間がある場合はその手前までについて走行許可区間として設定する。更に走行許可区間設定部３２２は、どの区間に走行許可区間を設定したかを示す情報を区間情報ＤＢ３１ｂに格納されている区間情報に追加する。 When the control server 31 receives the section request message, the travel permission section setting unit 322 sets the travel permission section based on the current position of the real vehicle 20 and the map information stored in the master map data DB 314a, and indicates the content thereof A section response message is transmitted to the real vehicle 20 (S1209). The travel permission section setting unit 322 uses the received current position of the vehicle and the section information of the section information DB 314 b to determine a section that is longer than the travel permission given length from the end of the section where the vehicle is present in the traveling direction of the vehicle. If there is a section where permission is given to other vehicles, or if there is a section where permission is given to other vehicles, it is set as a travel permitted section up to that side. Furthermore, the travel permitted section setting unit 322 adds information indicating which section the travel permitted section is set to the section information stored in the section information DB 31 b.
実車両２０は、区間応答メッセージを受信すると（Ｓ１２１０／Ｙｅｓ）、区間応答メッセージに示される新たな走行許可区間に従って走行を開始する（Ｓ１２１１）。実車両２０が、区間応答メッセージを受信しない場合、ステップＳ１２０５へ戻る（Ｓ１２１０／Ｎｏ）。区間応答メッセージを受信しない場合とは、例えば通信エラーにより区間要求メッセージが管制サーバ３１に届いていない、また区間応答メッセージが実車両２０に届いていない場合がある。 When receiving the section response message (S1210 / Yes), the actual vehicle 20 starts traveling in accordance with 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). When the section response message is not received, for example, the section request message may not reach the control server 31 due to a communication error, and the section response message may not reach the real vehicle 20.
走行許可区間設定部３２２は、実車両２０の現在位置から区間の終端までの距離が走行許可解除距離以上となると（図８の（ｃ）参照、Ｓ１２１２／Ｙｅｓ）、走行許可区間の設定を解除する（Ｓ１２１３）。走行許可区間設定部３２２は、区間情報から解除した走行許可区間を示す情報を削除する。その後ステップＳ１２０１へ戻る。また、走行許可区間設定部３２２は、実車両２０の現在位置から区間の終端までの距離が走行許可解除距離未満の場合（Ｓ１２１２／Ｎｏ）、走行許可解除距離以上となるまで解除せずに、ダンプが走行する（Ｓ１２１２）。 When the distance from the current position of the real vehicle 20 to the end of the section becomes equal to or more than the travel permission cancellation distance (see (c) in FIG. 8, S1212 / Yes), the travel permission section setting unit 322 cancels the setting of the travel permission section (S1213). The travel permitted section setting unit 322 deletes the information indicating the travel permitted section canceled from the section information. Thereafter, the process returns to step S1201. In addition, when the distance from the current position of the real vehicle 20 to the end of the section is less than the travel permission cancellation distance (S1212 / No), the travel permission section setting unit 322 does not cancel until the travel permission cancellation distance or more. The dump truck travels (S1212).
（実車両及び仮想車両を混走させた管制制御処理）
次に図１３乃至図１５を参照して、実車両及び仮想車両を混走させた管制制御処理について説明する。図１３は、実車両及び仮想車両を用いてシステム動作検証を行う際の、管制制御装置と自律走行ダンプトラックと仮想車両の関係を説明するための図である。図１４は、実車両及び仮想車両に対して設定された走行許可区間の情報を格納する区間情報の例を示す図であって、（ａ）は、仮想車両（ＩＤ：Ｖ０１）が待機位置で待機中の状態における区間情報例を示し、（ｂ）は、（ａ）から仮想車両（ＩＤ：Ｖ０１）が１動作（１フェーズ）遷移した状態における区間情報を示す。図１５は、実車両及び仮想車両を混走させて管制制御処理の流れを示すフローチャートである。
(Control control processing in which real and virtual vehicles are mixed)
Next, with reference to FIG. 13 to FIG. 15, a control control process in which an actual vehicle and a virtual vehicle are mixed is described. FIG. 13 is a diagram for explaining the relationship between a control control device, an autonomous traveling dump truck, and a virtual vehicle when performing system operation verification using an actual vehicle and a virtual vehicle. FIG. 14 is a diagram showing an example of section information storing information on travel permission sections set for a real vehicle and a virtual vehicle, where (a) is a virtual vehicle (ID: V01) in a standby position An example of section information in a standby state is shown, and (b) shows section information in a state where the virtual vehicle (ID: V01) has made one action (one phase) transition from (a). FIG. 15 is a flowchart showing a flow of control control processing in which an actual vehicle and a virtual vehicle are mixed.
図１３では、現在５台の実車両２０−１、２０−２、２０−３、２０−４、２０−５が稼働している鉱山において、新たに３台の自律走行ダンプトラックの導入を検討している場合を想定する。新規車両を導入する理由としては、例えば搬送路の長さ・制限速度から見てダンプトラックの数が少なく、積込場においてショベルが１台のダンプトラックに積み込みをしてから、次のダンプトラックが到着するまでの時間が長いために、ショベルがダンプトラックを待つ時間が発生し、生産効率が低い、といったことが挙げられる。このような場合、新規にダンプトラックを追加することで搬送路に対するダンプトラックの密度を上げ、ショベルの待ち時間を減らして生産効率を上げることができる。 In FIG. 13, in the mine where five actual vehicles 20-1, 20-2, 20-3, 20-4, and 20-5 are currently operating, the introduction of three autonomous traveling dump trucks is considered. Assume that you are The reason for introducing a new vehicle is, for example, the number of dump trucks is small in view of the length and speed limit of the transport path, and after the shovel is loaded on one dump truck at the loading site, the next dump truck It takes long time for the shovel to wait for the dump truck due to the long time until the truck arrives, and the production efficiency is low. In such a case, by adding a new dump truck, it is possible to increase the density of the dump truck relative to the transport path, reduce the waiting time of the shovel, and increase the production efficiency.
しかしながら、実際に新規車両を導入した場合に、全ての車両が効率よく動作できることは簡単には保証できない。それは、実環境における天候・気温・路面状況などといった様々な外乱要素があり、車両の走行速度に影響を与えることや、各車両が走行許可区間に基づき自車の前方車両に衝突しないように走行しており、あまりに搬送路に対する車両密度が高すぎる場合、減速と加速を繰り返すような走行をしてしまうといった理由からである。また一方で、ダンプトラックは非常に高価であり、このような懸念がある限り安易に新規車両の導入を決断することは難しい。 However, when a new vehicle is actually introduced, it can not easily be guaranteed that all vehicles can operate efficiently. It has various disturbance elements such as weather, temperature, road surface condition etc. in the real environment, and affects the running speed of the vehicle and runs so that each vehicle does not collide with the preceding vehicle of the own vehicle based on the run permission section. This is because, if the density of the vehicle with respect to the transport path is too high, the vehicle will travel in such a manner as to repeat deceleration and acceleration. On the other hand, dump trucks are very expensive, and it is difficult to easily decide on the introduction of a new vehicle if there is such a concern.
この解決策として、新規車両を導入した場合に上記のような問題が起こらないかを、本発明で提案する仮想車両を用いて検証することができる。ここでは、新規に導入する計画の３台の自律走行ダンプトラックの動作を、仮想車両７０−１、７０−２，７０−３でシミュレーションする。 As a solution to this, it can be verified using the virtual vehicle proposed by the present invention whether the above problems will occur when a new vehicle is introduced. Here, operations of three autonomous traveling dump trucks of a plan to be newly introduced are simulated by virtual vehicles 70-1, 70-2, and 70-3.
このシミュレーションに際して、自律走行システム１は、図１３に示すように管制サーバ３１に対して５台の実車両２０−１〜２０−５のそれぞれが実際に無線通信接続され、３台の仮想車両７０−１〜７０−３のそれぞれが仮想通信接続（サーバ側通信制御部３１０を介して仮想車両シミュレーション部３３０及び管制制御部３２０の間のデータの出入力）される。仮想車両７０−１〜７０−３の実体は、仮想車両シミュレーション部３３０上のデータであり、前述の通り、管制サーバ３１上で動作する。実車両及び仮想車両にはそれぞれ重複の無いように車両ＩＤが割り当てられており、管制サーバ３１は車両ＩＤによって通信を行う対象の車両が実車両であるか仮想車両であるかを判別することができる。 In this simulation, as shown in FIG. 13, in the autonomous traveling system 1, each of the five actual vehicles 20-1 to 20-5 is actually connected to the control server 31 by wireless communication, and three virtual vehicles 70 70-1 are virtual communication connections (input and output of data 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. A 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 may determine whether the target vehicle to communicate with is a real vehicle or a virtual vehicle based on the vehicle ID. it can.
図１４の（ａ）に実車両及び仮想車両に対して設定された走行許可区間の情報を格納する区間情報の一例を示す。図１４の（ａ）のＲ０１〜Ｒ０５は実車両を固有に識別する車両ＩＤ１４０１であり、Ｖ０１は仮想車両を固有に識別する車両ＩＤ１４０１である。図１４では走行許可区間を示す情報として、走行許可区間の最前端に位置するノード（前方境界点）、及び最後端に位置するノード（後方境界点）を格納する。また図１４の（ａ）では説明の便宜のため各車両の稼働状態を記載しているが、稼働状態を示す情報はノードＩＤをキーレコードにして図１１の（ｂ）に示すノードの属性情報と関連付けることにより不要となる。以下図１４の（ｂ）、図２２、図２３の（ａ）、（ｂ）についても同様である。 An example of the area information which stores the information of the run permission area set up to a real vehicle and a virtual vehicle at (a) of Drawing 14 is shown. R01 to R05 in (a) of FIG. 14 are vehicle IDs 1401 for uniquely identifying an actual vehicle, and V01 is a vehicle ID 1401 for uniquely identifying a virtual vehicle. In FIG. 14, a node (front boundary point) located at the foremost end of the travel permitted section and a node (rear border point) located at the rearmost end are stored as information indicating the travel permitted section. Further, although the operating state of each vehicle is described in (a) of FIG. 14 for the convenience of explanation, the information indicating the operating state is the attribute information of the node shown in (b) of FIG. It becomes unnecessary by associating with. The same applies to (b) of FIG. 14, and (a) and (b) of FIG.
管制サーバ３１と実車両、および仮想車両は全く同じフォーマットで、車両ＩＤを始めとし、走行許可区間を表すノードやリンクのＩＤや実車両、仮想車両の其々の位置情報（地図上のどこに存在するか）等の情報を通信し合うことができる。このような構成において、後述する図１５に示す管制制御処理を実施することにより、実車両と仮想車両とが互いに衝突することのないように走行許可区間を設定する。その結果、新規の実車両を導入する前に仮想車両を用いてあらかじめ導入後の動作を検証することができる。 The control server 31, the real vehicle, and the virtual vehicle have completely the same format, including the vehicle ID, the ID of the node or link representing the travel permitted section, the real vehicle, and the respective position information of the virtual vehicle (where on the map Can communicate with each other. In such a configuration, by performing control control processing shown in FIG. 15 described later, the travel permission section is set so that the real vehicle and the virtual vehicle do not collide with each other. As a result, it is possible to verify the operation after introduction in advance using a virtual vehicle before introducing a new actual vehicle.
次に図１５の各ステップ順に沿って実車両と仮想車両とを混在させた管制制御処理について説明する。 Next, control control processing in which an actual vehicle and a virtual vehicle are mixed will be described along the order of steps in FIG.
管制サーバ３１の走行許可区間設定部３２２は、実車両２０、即ち要求情報処理部２６０（図５参照）から走行許可要求があったか（Ｓ１５０１／Ｙｅｓ）、又は仮想車両７０、即ち仮想走行制御部３３２から走行許可要求があったかどうかを判定する（Ｓ１５０１／Ｎｏ、かつＳ１５０２／Ｙｅｓ）。どちらからも走行許可要求がない場合（Ｓ１５０２／Ｎｏ）は、処理をせず要求を待ち続ける。 Run permission section setting unit 322 of the control server 31, the actual vehicle 20, i.e. the request information processing unit 260 whether there has been (see FIG. 5) or al run line authorization request (S1501 / Yes), or virtual vehicle 70, i.e. the virtual travel control It is determined whether or not there is a travel permission request from the section 332 (S1501 / No, and S1502 / Yes). If there is no request for permission to travel from either (S1502 / No), processing is not performed and the request is kept waiting.
走行許可区間設定部３２２は、いずれかの車両から走行許可要求があった場合（Ｓ１５０１／Ｙｅｓ、Ｓ１５０２／Ｙｅｓ）、以下の処理を実行する。実車両と仮想車両の優先順位は逆でもよく、また特に区別せずにいずれかからの走行許可要求の有無を判定してもよい。以下、実車両と仮想車両を含む概念として、車両という言葉を用いる。走行許可区間設定部３２２は、車両から走行許可要求があったら、既述のステップＳ１２０９と同様、受信した車両の現在位置と区間情報ＤＢ３１４ｂの情報を用いて、車両の進行方向に対して車両の存在する区間の終端から走行許可付与長さ以上となる区間について、他の車両に許可が与えられていない限り、あるいは他の車両に許可が与えられている区間がある場合はその手前までについて走行許可区間として設定する処理を実行する（Ｓ１５０３）。 When there is a travel permission request from any of the vehicles (S1501 / Yes, S1502 / Yes), the travel permission section setting unit 322 executes the following processing. The priority order of the real vehicle and the virtual vehicle may be reversed, or the presence or absence of a travel permission request from any one may be determined without distinction. Hereinafter, the term vehicle is used as a concept including an actual vehicle and a virtual vehicle. Run permission section setting unit 322, if there is running permission request from the vehicle, similar to step S120 9 described above, by using the information of the current position and the segment information DB314b of received vehicle, the vehicle to the traveling direction of the vehicle For the section from the end of the section where the section is present to the driving permission granted length or more, if there is a section where permission is given to other vehicles, or if there is a section where permission is given to other vehicles, A process of setting as a travel permitted section is executed (S1503).
この処理において、車両が現在存在する走行区間のすぐ隣の区間が他の車両に許可されているなどして、走行許可区間設定部３２２は走行許可区間を設定できない場合（Ｓ１５０４／Ｎｏ）、走行許可区間が設定できなかったことを示す不許可応答メッセージを生成し、車両に送信又は出力してＳ１５０１へ戻る。 In this process, if the section permitted to set the traveling permission section can not be set because the section immediately adjacent to the traveling section where the vehicle currently exists is permitted to another vehicle (S1504 / No), the traveling is performed. It generates a non-permission response message indicating that the authorization period can not be set, the process returns to S1501 to send or output to the vehicle.
走行許可区間設定部３２２は、走行許可区間を設定できた場合は（Ｓ１５０４／Ｙｅｓ）、その走行許可区間を示す区間応答メッセージを生成し、車両に送信または出力する（Ｓ１５０５）。 Run permission section setting unit 322, if it can set the travel permission section (S1504 / Yes), its section response message indicating running permission section forms the raw, and transmits or outputs to the vehicle (S1505).
また、走行許可を与える区間に合流する区間がある場合、走行許可区間設定部３２２は、その区間を同一の車両に対する走行許可区間として設定し、区間情報に格納する（Ｓ１５０６）。また、走行許可を与える区間と交差する区間がある場合、走行許可区間設定部３２２は、その区間を同一の車両に対する走行許可区間としてマスタ地図データＤＢ３１４ａ上に設定する（Ｓ１５０７）。これらの処理は、合流点又は交差点に他の車両が進入し、走行許可区間の設定対象となった車両と干渉することを防ぐための処理であり、走行許可区間の設定対象となった車両に対しては、車両の進行方向に沿った走行許可区間だけを通知すればよいので、本ステップで設定した走行許可区間は区間応答メッセージに含まず、管制サーバ３１の処理に完結する。 Also, when there is a section joining the section to which the travel permission is given, 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). Also, when there is a section that intersects with a section to which the travel permission is given, the travel permission section setting unit 322 sets the section as a travel permitted section for the same vehicle on the master map data DB 314a (S1507). These processes are processes for preventing another vehicle from entering the junction or intersection and interfering with the vehicle for which the travel permission section is set, and for the vehicle for which the travel permission section is set Since it is sufficient to notify only the travel permitted section along the traveling direction of the vehicle, the travel permitted section set in this step is not included in the section response message, and the processing of the control server 31 is completed.
走行許可区間設定部３２２は、ステップＳ１２１２と同様、車両の現在位置から既に通過した走行許可区間の終端までの距離が走行許可解除距離以上になると、通過した区間の走行許可を解除して区間情報を更新する（Ｓ１５０８）。 The run permission section setting unit 322 cancels the run permission of the passed section when the distance from the current position of the vehicle to the end of the run permission section already passed is equal to or more than the run permission release distance, as in step S1212 Is updated (S1508).
図１４の（ｂ）は、各車両が前進して、走行許可区間が再設定された状態を示す。例えば、図１４の（ａ）では実車両（Ｒ０１）に対してｎｏｄｅ＿１からｎｏｄｅ＿２までが走行許可区間として設定されているが、実車両（Ｒ０１）がｎｏｄｅ＿１を通過後、ｎｏｄｅ＿１からｎｏｄｅ＿２が開放される。そして図１４の（ｂ）では実車両（Ｒ０２）に対してｎｏｄｅ＿１からｎｏｄｅ＿２が走行許可区間として設定される。 (B) of FIG. 14 shows a state in which the travel permission section is reset as each vehicle advances. For example, in (a) of FIG. 14, from the actual vehicle (R01), node_1 to node_2 are set as the travel permitted section, but after the actual vehicle (R01) passes node_1, node_1 to node_2 are released . And in (b) of Drawing 14, node_1 to node_2 are set up as a run permission section to real vehicles (R02).
実車両２０及び管制サーバ３１は以上の処理を繰り返す。この繰返処理の過程において、仮想車両に設定された走行許可区間に従って走行路を走行した際の走行状態や位置を含む走行状態のシミュレーションが行われ、その結果（特に仮想車両の位置）が走行許可区間設定部に返される。 The actual vehicle 20 and the control server 31 repeat the above processing. In the process of this repetitive processing, a simulation of the traveling state including the traveling state and the position when traveling along the traveling road according to the traveling permitted section set to the virtual vehicle is performed, and the result (especially the position of the virtual vehicle) travels It is returned to the permission interval setting unit.
走行許可区間設定部３２２は、要求を行った車両が自律走行ダンプトラックであるか、仮想車両であるかを特に区別せずに、即ち両車両に対して同一の処理で走行許可区間の設定をする。またこれにより、現実に走行する自律走行ダンプトラックと、シミュレーション上の仮想車両についても、互いに衝突を防止するように管制制御される。 The run permission section setting unit 322 sets the run permission section in the same processing for both vehicles without making a distinction between the requested vehicle and the autonomous traveling dump truck or the virtual vehicle. Do. Further, the autonomous traveling dump truck which is actually traveling and the virtual vehicle on the simulation are also controlled and controlled so as to prevent the collision with each other.
次に、図１６を参照して単一の搬送路の鉱山にて実車両と仮想車両が混走する場合について、管制サーバ３１のユーザインターフェースである表示装置３１６（図２参照）に表示される画面を説明する。図１６は仮想車両の設定入力画面の一例を示す図である。図１６の画面１６０１には、鉱山内の積込場６１、放土場６２と、それらを結ぶ搬送路６０とを含む地図画面１６０２が表示される。走行許可区間設定部３２２は、表示装置３１６（図２参照）に画面１６０１を表するための制御も行う。本図では明示しないが、搬送路上には、座標データとして走行路と、その区間を表すためのノードが設定されている。走行許可区間設定部３２２は、マスタ地図データＤＢ３１４ａの地図データに実車両２０及び仮想車両７０の位置及び区間情報ＤＢ３１４ｂに格納された走行許可区間を重畳表示することにより、地図画面１６０２を生成・表示する。また、実車両２０と仮想車両７０とは表示態様を変えて地図画面に重畳表示される。 Next, referring to FIG. 16, a screen displayed on the display device 316 (see FIG. 2) , which is a user interface of the control server 31, when real vehicles and virtual vehicles coexist in the mine of a single transport path . Explain. FIG. 16 is a diagram showing an example of a setting input screen of a virtual vehicle. On the screen 1601 of FIG. 16, a map screen 1602 including a loading site 61 in the mine, an earth release site 62 and a transport 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). Although not explicitly shown in the drawing, a traveling path as coordinate data and a node for representing the section thereof are set on the conveying path. The run permission section setting unit 322 generates and displays a map screen 1602 by superimposing and displaying the positions of the real vehicle 20 and the virtual vehicle 70 and the run permission sections stored in the section information DB 314b on the map data of the master map data DB 314a. Do. Also, the actual vehicle 20 and the virtual vehicle 70 are displayed superimposed on the map screen with the display mode changed.
図１６では、鉱山エリア内において、実車両２０−１〜２０−５の５台と、仮想車両７０−１〜７０−３の３台とが、それぞれ管制サーバ３１から指示された走行許可区間８１−１〜８１−８に従って混走している。 In FIG. 16, in the mine area, five permitted vehicles 20-1 to 20-5 and three virtual vehicles 70-1 to 70-3 are run permission sections 81 instructed by control server 31. -1 to 81-8.
仮想車両を追加する際の処理について説明する。画面１６０１には、仮想車両アイコンを表示するツールボックス１６０３を表示する。ユーザがマウスカーソル１６０４により仮想車両アイコンを搬送路６０上において、走行許可区間が未設定の位置にドラッグする。 A process of adding a virtual vehicle will be described. The screen 1601 displays a tool box 1603 that displays a virtual vehicle icon. The user drags the virtual vehicle icon on the conveyance path 60 with the mouse cursor 1604 to a position where the travel permission section is not set.
また、画面１６０１に、ノードＩＤの入力欄１６０５を設けてもよい。ユーザが入力欄１６０５にノードＩＤを入力すると、そのノードＩＤのＸ座標１６０６、Ｙ座標１６０７を仮想走行制御部３３２が地図データを参照して表示し、その位置に仮想車両のアイコンを表示してもよい。 In addition, the screen 1601 may be provided with an input field 1605 for the node ID. When the user inputs the node ID in the input field 1605, the virtual travel control unit 332 displays the X coordinate 1606 and the Y coordinate 1607 of the node ID with reference to the map data, and displays the icon of the virtual vehicle at that position. It is also good.
仮想車両アイコンが地図画像に重畳表示された状態で、実行ボタン１６０８が操作されると、仮想走行制御部３３２及び走行シミュレーション部３３３を含む仮想車両シミュレーション部３３０が処理を開始する。 When the execution button 1608 is operated in a state where the virtual vehicle icon is superimposed on the map image, the virtual vehicle simulation unit 330 including the virtual traveling control unit 332 and the traveling simulation unit 333 starts processing.
上記の例では、実車両５台に対して仮想車両３台を加える構成としたが、実車両・仮想車両のそれぞれの台数は、管制サーバ３１の計算処理性能、あるいは通信手段の性能を越えない限り、任意に設定可能である。 In the above example, three virtual vehicles are added to five real vehicles, but the numbers of real vehicles and virtual vehicles do not exceed the calculation processing performance of the control server 31 or the performance of the communication means. As long as it is set arbitrarily.
本実施形態によれば、実際に走行中の運搬車両の位置及び仮想車両の仮想位置を基に、運搬車両及び仮想車両に走行許可区間を設定するので、実際に運搬車両を走行させながら、仮想車両を追加した際の走行許可区間の設定可否の検証を行うことができる。またこの検証に際して、運搬車両を稼働させた状態を維持できるので、運搬車両の稼働停止に伴う鉱山の生産性の低下を抑制することができる。 According to the present embodiment, since the travel permission section is set to the transport vehicle and the virtual vehicle based on the position of the transport vehicle actually traveling and the virtual position of the virtual vehicle, the virtual vehicle is actually traveled while traveling It is possible to verify whether or not the travel permission section can be set when a vehicle is added. Moreover, since the state which made the conveyance vehicle operate can be maintained in this verification, the fall of the productivity of the mine accompanying the operation stop of a conveyance vehicle can be suppressed.
＜第二実施形態＞
第二実施形態は、既存の地図データに、新たな走行路を追加するための検証を行う実施形態である。以下、図１７乃至図１９を参照して第二実施形態について説明する。図１７は、仮想走行路を追加するための画面表示例である。図１８は、第二実施形態の処理の概要を示すフローチャートである。図１９は、仮想走行路追加処理の詳細を示すフローチャートである。
Second Embodiment
The second embodiment is an embodiment in which verification for adding a new traveling route is performed on existing map data. Hereinafter, the second embodiment will be described with reference to FIGS. 17 to 19. FIG. 17 is a screen display example for adding a virtual traveling path. FIG. 18 is a flowchart showing an outline of processing of the second embodiment. FIG. 19 is a flowchart showing the details of the virtual traveling road addition process.
鉱山は、掘削が進むにつれて鉱石のある掘削場所が変化し、ショベルが掘削・積込みを実施する積込み場の位置も変化する。一般的に露天掘り鉱山においては、すり鉢状に掘削を進め、次第に深い位置での掘削を行うようになる。この掘削位置を変更する際、合わせてそこに至るまでの搬送路も生成しなければならない。自律走行ダンプトラックであるダンプ２０は、地図データを基にして自律走行を行うため、新しく生成した搬送路に対しては、合わせて地図データを生成する必要がある。また、生成した地図データは、そのデータに基づいて走行することで実際の搬送路を正しい位置で走行できるかどうかについてもあらかじめ確認し、システムの正常動作を確認する必要がある。そこで、本実施形態ではダンプを稼働させている状態を維持しつつ、新たな走行路を追加した場合の走行シミュレーションを行う。 In the mine, as drilling progresses, the site where the ore is located changes, and the position of the loading site where the shovel carries out excavation and loading also changes. Generally, in open pit mines, drilling is carried out in the shape of a mortar, and drilling is gradually performed at deeper positions. At the time of changing the digging position, it is also necessary to create a transport path up to that point. Since the dump truck 20 , which is an autonomous traveling dump truck , performs autonomous traveling based on map data, it is necessary to generate map data for the newly generated transport route. In addition, it is necessary to confirm in advance whether the generated map data can travel on the actual transport path at the correct position by traveling based on the data, and to confirm the normal operation of the system. Therefore, in the present embodiment, while maintaining a state in which the dump is operated, traveling simulation in the case where a new traveling path is added is performed.
図１７に仮想走行路追加処理で表示される画面表示例を示す。図１７の画面１７０２は、計画中の搬送路を含む鉱山にて実車両と仮想車両が混走する場合において、実際の走行路に仮想走行路を追加した際に管制サーバ３１の表示装置３１６に表示される画面である。実際の走行路と仮想走行路とは表示態様を変えて表示される。画面１７０２は、図１６で説明した積込場６１、放土場６２、搬送路６０の構成に加え、新たに仮想の積込場６８を設けている。放土場６２は積込場６１、６８からの運搬の共通の放土場とする。また、搬送路６０から分岐して仮想の搬送路６７を設け、積込場６８にアクセスできるようにしている。５台のダンプ２０−１〜２０−５は、もともとある積込場６１と放土場６２の間を往復し、３台の仮想車両７０−１〜７０−３は仮想の積込場６８と放土場６２の間を往復する。 FIG. 17 shows an example of screen display displayed in the virtual traveling path addition process. The screen 1702 of 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 the real vehicle and the virtual vehicle coexist in the mine including the planned transport path. Screen. The actual traveling path and the virtual traveling path are displayed by changing the display mode. The screen 1702 has a virtual loading place 68 newly in addition to the configuration of the loading place 61, the release place 62, and the transport path 60 described in FIG. The release site 62 is a common release site for transportation from the loading sites 61 and 68. Further, a virtual conveyance path 67 is branched from the conveyance path 60 so that the loading place 68 can be accessed. The five dumps 20-1 to 20-5 reciprocate between the original loading site 61 and the release site 62, and the three virtual vehicles 70-1 to 70-3 and the virtual loading site 68 Reciprocate between the release places 62.
この仮想地図データ（積込場６８及び搬送路６７）を含む鉱山エリア内において、ダンプ２０−１〜２０−５、仮想車両７０−１〜７０−３は、それぞれ管制サーバ３１から指示された走行許可区間８１―１〜８１−８に従って走行する。 In the mine area including the virtual map data (loading place 68 and transport path 67), dumps 20-1 to 20-5 and virtual vehicles 70-1 to 70-3 are respectively instructed by control server 31 The vehicle travels according to the permission sections 81-1 to 81-8.
次に図１８を参照して第二実施形態に係る処理の概要について説明する。なお図１８の各処理において第一実施形態（図９の各ステップ）と同処理については同じステップ番号を付け、重複説明を省略する。 Next, an outline of processing according to the second embodiment will be described with reference to FIG. In the processes of FIG. 18, the same processes as those of the first embodiment (steps of FIG. 9) are denoted by the same step numbers, and redundant description is omitted.
図１８に示すように、地図データ生成処理を行い（Ｓ９０１）、仮想の走行路を追加しない場合は（Ｓ１８０１／Ｎｏ）、第一実施形態と同様、ステップＳ９０２〜Ｓ９０７の処理を行う。 As shown in FIG. 18, map data generation processing is performed (S901), and when not adding a virtual traveling path (S1801 / No), processing of steps S902 to S907 is performed as in the first embodiment.
生成された地図データに対して仮想の走行路を追加する場合（Ｓ１８０１／Ｙｅｓ）、仮想走行路追加処理を行う（Ｓ１８０２）。ここでいう仮想走行路追加処理とは、鉱山内に既に走行路が設定されている状態で、実際には存在しない搬送路や積込場、放土場の形状を設定する処理である。 When a virtual traveling path is added to the generated map data (S1801 / Yes), a virtual traveling path addition process is performed (S1802). The virtual travel path addition processing referred to here is processing for setting the shape of a transport path, a loading site, and a discharge site which do not actually exist, in a state where the travel path is already set in the mine.
仮想走行路追加処理では、図１９に示すように、まず、地図データ生成部３２３が、例えば管制サーバ３１に外付けされた記憶装置から仮想地図設定の際に用いる鉱山の航空写真などの参考データと、既存の地図データ（マスタ地図データＤＢ３１４ａからでも仮想地図データＤＢ３３５のどちらに格納されたものでもよい）を読み込む（Ｓ１９０１）。参考データは、写真に限らず開発計画の鉱山地形の情報を持つＣＡＤデータなどでもよい。地図データ生成部３２３は、表示装置３１６の画面にこれらデータに基づく地図画像を表示する。地図画像には、航空写真等を用いた地形情報に、マスタ地図データＤＢ３１４ａ等に格納された地図データを重畳表示してもよい。 In the virtual travel route addition process, as shown in FIG. 19, first, the map data generation unit 323 uses, for example, a storage device externally attached to the control server 31 to reference data such as an aerial photograph of a mine used in virtual map setting. And existing map data (which may be stored in either the master map data DB 314a or the virtual map data DB 335) (S1901). The reference data may be not only photos but also CAD data having information on mine topography in the development plan. Map data producing formation 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 topographical information using an aerial photograph or the like.
ユーザは入力装置３１７を用いて地図画像上に既存の走行路に対して追加する仮想走行路のノード座標をプロットする（Ｓ１９０２）。プロットされたノード座標は地図データ生成部３２３が格納する。 The user uses the input device 317 to plot the node coordinates of the virtual runway to be added to the existing runway on the map image (S1902). Plotted node coordinates are stored in the map data producing formation unit 323.
ユーザは入力装置３１７を用いてプロットしたノード間の接続関係を設定する（Ｓ１９０３）。例えば、１つのノードをクリックした後でそれに接続したいノードをクリックすることで設定してもよいし、２つのノードを選択して実行処理をすることで設定してもよい。またこの時、既存の地図データが含むノードから搬送路を分岐する場合は、既存の地図データとの接続関係を設定してもよい。 The user uses the input device 317 to set the connection relationship between the plotted nodes (S1903). For example, the setting may be made by clicking on one node and then clicking on the node to be connected to it, or setting may be made by selecting two nodes and performing execution processing. Further, at this time, in the case where the transport path is branched from the node included in the existing map data, the connection relationship with the existing map data may be set.
ユーザは入力装置３１７を用いてプロットしたノードのパラメータを設定する（Ｓ１９０４）。これにより、プロットしたノードに積込み地点や放土地点などの、車両に指示を与えるための属性（図１１の符号１１０８に相当）を持たせる。 The user sets the parameters of the plotted node using the input device 317 (S1904). This causes the plotted nodes to have attributes (corresponding to reference numeral 1108 in FIG. 11) for giving instructions to the vehicle, such as a loading point and a landed point.
最後に、地図データ生成部３２３は、生成された地図データを仮想地図データＤＢ３３５及びマスタ地図データＤＢ３１４ａに格納する（Ｓ１９０５）。このとき、実在しない（仮想の）ノード及びリンクは、実在するノード及びリンクとは弁別可能なデータとして定義する。例えば、車両ＩＤと同様、実在するノードＩＤ、リンクＩＤと仮想のノードＩＤ、リンクＩＤに両者を区別可能な文字を加えておき、シミュレーション走行において走行許可区間を設定する際、実車両は実在するノードＩＤだけを用いて走行許可区間を設定し、仮想車両は実在するノードＩＤ及び仮想ノードＩＤの両者を用いて走行許可区間を設定する。 Finally, 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). At this time, nonexistent (virtual) nodes and links are defined as data distinguishable from existing nodes and links. For example, as in the case of the vehicle ID, an actual vehicle actually exists when setting a travel permitted section in simulation traveling while adding distinguishable characters to the existing node ID, link ID and virtual node ID, and link ID. The run permission section is set using only the node ID, and the virtual vehicle sets the run permission section using both the existing node ID and the virtual node ID.
上記で格納された地図データはあくまで仮想の走行路の情報であり、実際に開発した搬送路等における走行路のデータは改めてＧＰＳやレーザレーダ等のセンサによって、定められた地図生成の処理手順で生成する必要がある。 The map data stored above is information of a virtual traveling route to the last, and the data of the traveling route in the actually developed transportation route etc. is newly created by the processing procedure of map generation determined by sensors such as GPS and laser radar. Need to generate.
仮想走行路追加処理Ｓ１８０２を行ってから仮想車両と実車両とを混送させる管制制御処理では（図１８のステップＳ９０５）、走行許可区間設定部３２２が区間情報の車両ＩＤとノードＩＤ、リンクＩＤを基に仮想車両は仮想地図データを参照して仮想走行路に走行許可区間を設定し、実車両に対しては実地図データを参照し、実在する走行路上に走行許可区間を設定する。 In the control control process in which the virtual vehicle and the real vehicle are mixedly sent after the virtual traveling path addition process S1802 (step S905 in FIG. 18), the traveling permitted section setting unit 322 transmits the vehicle ID of the section information, the node ID, and the link ID. The virtual vehicle sets a traveling permitted section on the virtual traveling route with reference to the virtual map data, and refers to the actual map data for the real vehicle, and sets the traveling permitted section on the existing traveling road.
なお、ダンプ地図データＤＢ２０４ａは、実地図データのみを記憶しており、自律走行制御部２７０は位置算出装置２２０の位置データと実地図データとを比較しながら走行制御し、両者が一致しない場合は停車するので、仮想走行路上に実車両が迷い込むことは回避できる。 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 when both do not match Since the vehicle is stopped, it is possible to prevent the vehicle from getting lost on the virtual runway.
本実施形態によれば、運搬車両は実際の走行路に設定された走行許可区間に従って走行し、仮想車両は仮想の走行路に設定された走行許可区間に従って走行するので、運搬車両が仮想の走行路に間違って侵入することがない。そして、既存の搬送路に加え、実在しない搬送路等における走行路を事前に想定して仮想の地図データを生成し、それに基づいて実車両と仮想車両が管制制御に基づき走行するようなシステム構成とすることにより、開発計画中である搬送路を実際に開発し、新規車両を導入した場合の管制制御、および既存の実車両の動作を事前に確認することが可能となる。 According to the present embodiment, the transport vehicle travels according to the travel permission section set on the actual travel path, and the virtual vehicle travels according to the travel permission section set on the virtual travel path. There is no chance of getting into the road by mistake. Then, in addition to the existing transport route, virtual map data is generated assuming in advance a travel route on a transport route that does not exist, and a system configuration in which the real vehicle and the virtual vehicle travel based on the control control based thereon. By doing this, it becomes possible to actually develop the transport route under development planning, and to confirm in advance the control control when a new vehicle is introduced and the operation of the existing real vehicle.
＜第三実施形態＞
第三実施形態は、自律走行ダンプトラックの実際の走行データ、又はユーザからの入力操作に基づき仮想車両の走行モデルを修正する実施形態である。以下図２０及び図２１を参照して第三実施形態について説明する。図２０は、第三実施形態に係る管制サーバ３１の機能ブロック図である。図２１は、第三実施形態で表示される画面表示例である。
Third Embodiment
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. The third embodiment will be described below with reference to FIGS. 20 and 21. 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.
図２０に示すように、管制サーバ３１は、第一実施形態の管制サーバ３１の構成に加え、走行中の前記運搬車両から受信した当該運搬車両の走行データを用いて、仮想車両のシミュレーションした走行状態が前記実車両の走行状態と一致するように、走行パラメータを修正する走行パラメータ修正部３５０を更に備える。走行パラメータとは、仮想車両のシミュレーションした走行状態に影響を与えるパラメータであって、例えば、車両の重量、加速度、勾配、路面の摩擦係数μ等を修正する。摩擦係数μの設定は、その点における車輪の回転数とトルクとを用いて設定する。 As shown in FIG. 20, in addition to the configuration of the control server 31 of the first embodiment, the control server 31 simulates traveling of a virtual vehicle using traveling data of the transportation vehicle received from the transportation vehicle during traveling. The vehicle further includes a traveling parameter correction unit 350 that corrects the traveling parameters so that the state matches the traveling state of the actual vehicle. The travel parameter is a parameter that affects the simulated travel state of the virtual vehicle, and, for example, the vehicle weight, acceleration, slope, and road surface friction coefficient μ are corrected. The setting of the coefficient of friction μ is set using the number of rotations of the wheel and the torque at that point.
実車両２０は、走行中に車載センサ２３０により検出した車両の座標に応じた速度や加速度、傾き、荷重センサのデータなどを一時的に記録する走行データ格納部（不図示）を備える。実車両２０は、走行中に車載センサ２３０からの出力を、無線通信回線４０を介して送信する。 The real vehicle 20 includes a travel data storage unit (not shown) that temporarily records the speed, acceleration, inclination, data of a load sensor, and the like according to the coordinates of the vehicle detected by the on-vehicle sensor 230 while traveling. The real 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 value of the sensor, identifies the point where the virtual vehicle 70 travels differently from the dump 20 based on the value, and the virtual vehicle 70 is determined from the slope and the acceleration of the vehicle at that point. The traveling parameters of the virtual vehicle are calculated so that the vehicle travels closer to the actual vehicle. Then, the travel parameter of the travel simulation unit 333 is corrected to the calculated value. As a result, the simulated traveling state of the virtual vehicle can be made closer to the traveling state of the transport vehicle during traveling, and the reliability of the simulation result can be further enhanced.
また、走行モデルの他の修正例として、入力装置３１７からユーザが走行パラメータを入力できるように構成してもよい。図２１に、走行パラメータの入力画面例を示す。図２１の画面２１０１は、車両スペックを規定するパラメータの入力画面を示す。車両スペックのうち、仮想車両のシミュレーションした走行状態に影響を与えるパラメータ例として、車体重量、最大積載量、ホイールベース、最小回転半径を例示したが、走行パラメータはこれに限定されない。例えば、加速度、減速度（制動量）、操舵速度などがあってもよい。走行シミュレーション部３３３は、画面２１０１から走行パラメータが入力され、実行ボタン２１０２が操作されると、走行シミュレーション部３３３で用いる走行パラメータを入力値に更新する。そして、走行シミュレーション部３３３は入力値を用いて仮想車両の走行シミュレーションを行う。その際も、実車両２０から受信したセンサ値に基づいて、走行路の状態に由来するパラメータ、例えば路面の勾配や摩擦係数を随時修正してもよい。 In addition, as another modification example of the traveling model, the user may be configured to input traveling parameters from the input device 317. FIG. 21 shows an example of a travel parameter input screen. A screen 2101 of FIG. 21 shows an input screen of parameters defining the vehicle specification. Although vehicle body weight, maximum load, wheel base, and minimum turning radius are illustrated as an example of parameters affecting the simulated running state of the virtual vehicle among the vehicle specifications, the running parameters are not limited thereto. For example, there may be acceleration, deceleration (braking amount), steering speed, and the like. The traveling simulation unit 333 updates the traveling parameter used by the traveling simulation unit 333 to an input value when the traveling parameter is input from the screen 2101 and the execution button 2102 is operated. Then, the traveling simulation unit 333 performs traveling simulation of the virtual vehicle using the input value. Also in this case, based on the sensor value received from the real vehicle 20, parameters derived from the state of the traveling path, for example, the slope of the road surface or the friction coefficient may be corrected as needed.
また、路面の摩擦係数を規定する走行パラメータ、例えば車輪回転数やトルクは、走行路のノード、リンクごとに異なるので、ノードＩＤやリンクＩＤを指定して走行パラメータを設定できるように構成してもよい。 In addition, since traveling parameters that define the friction coefficient of the road surface, such as wheel rotation speed and torque, are different for each node and link of the traveling road, node ID and link ID can be specified to set traveling parameters. It is also good.
図２１の例では、ユーザが走行パラメータを修正できるようにすることで、実車両により近い状態での走行シミュレーションや、実車両とは異なるスペックの車両を新規に投入した際のシミュレーションが行える。 In the example of FIG. 21, by enabling the user to correct the traveling parameters, it is possible to perform traveling simulation in a state closer to the actual vehicle and simulation when a vehicle having a spec different from that of the actual vehicle is newly introduced.
＜第四実施形態＞
本実施形態は、仮想車両シミュレーション時において仮想車両が特定の動作を瞬時に終わらせたように処理を行う（スキップ処理を行う）実施形態である。以下、図２２及び図２３を参照して第四実施形態について説明する。図２２は、仮想車両に対して積込場において設定される走行許可区間を時系列に沿って記載した区間情報の例である。図２３は、仮想車両をスキップ処理した際の区間情報の例を示す図であって、（ａ）はスキップ処理のみを行った状態を示し、（ｂ）はスキップ処理時にタイムラグ調整処理を行った状態を示す。
Fourth Embodiment
The present embodiment is an embodiment in which processing is performed (skipping processing is performed) as if the virtual vehicle instantaneously ends a specific operation at the time of virtual vehicle simulation. The fourth embodiment will be described below with reference to FIGS. 22 and 23. FIG. 22 is an example of section information in which travel permission sections set at a loading site for virtual vehicles are described in time series. FIG. 23 is a diagram showing an example of section information when skipping a virtual vehicle, where (a) shows a state in which only skipping is performed, and (b) shows time lag adjustment processing at the time of skipping Indicates the status.
走行許可区間設定部３２２はスキップ処理をしない場合では、実車両と同スペックの仮想車両に対して、図２２に示すように、「フェーズ１：待機位置で待機」、「フェーズ２；待機位置での待機から積込位置に向かって走行中」、「フェーズ３：積込作業中（停車中）」、「フェーズ４：積込位置から出口に向かって出発」、「フェーズ５：出口から放土場に向かって走行」するための走行許可区間を実車両に対する動作と同様のタイミングで設定する。 If run permission section setting unit 322 does not skip the process, for the real vehicle and the specifications of the virtual vehicle, as shown in FIG. 22, "Phase 1: standby at the standby position", "Phase 2; standby position ", while driving toward the loading position from the standby in" phase 3: loading in work (parked) "," phase 4: onset out toward the outlet from the loading position "," phase 5: from the exit The travel permission section for traveling toward the release site is set at the same timing as the operation for the actual vehicle.
しかし、仮想車両に対し、図２２に示す各走行許可区間を実車両と同じ時間を空けて設定すると、例えば積込作業中は実際にはショベルが稼働できずに鉱山の生産性が低下する。 However, if the travel permission sections shown in FIG. 22 are set at the same time as the actual vehicle with respect to the virtual vehicle, for example, the shovel can not actually operate during the loading operation, and the productivity of the mine decreases.
そこで、走行許可区間設定部３２２は仮想車両に対しては、例えばフェーズ１，２，３は瞬時に終了したものとし、フェーズ１からフェーズ４にスキップさせ、フェーズ１の走行許可区間を設定した後、フェーズ４の走行許可区間を設定してもよい（図２３の（ａ）参照）。 Therefore, for the virtual vehicle, for example, it is assumed that phases 1, 2 and 3 are instantaneously ended, and the run permission section setting unit 322 skips from phase 1 to phase 4 and sets the run permission section of phase 1 , And the travel permitted section of phase 4 may be set (see (a) of FIG. 23).
但し、図２３の（ａ）に示すように、仮想車両の前に位置する車両との関係上、フェーズ４にスキップした場合、直前車両の位置を飛び越えてしまう場合がある（図２３の（ａ）の車両ＩＤ：Ｖ０１、Ｒ０４参照）。この場合、実車両と仮想車両との前後関係が変わり、走行シミュレーションの正確性に支障をきたすことがある。 However, as shown in (a) of FIG. 23, due to the relationship with the vehicle located in front of the virtual vehicle, when skipping to phase 4, the position of the immediately preceding vehicle may be skipped ((a) in FIG. ) Vehicle ID: V01, see R04). In this case, the anteroposterior relationship between the real vehicle and the virtual vehicle may change, which may affect the accuracy of the driving simulation.
そこで、管制サーバ３１にタイマーを備え、走行許可区間設定部３２２は、スキップ処理に際して仮想車両が直前車両（特に実車両）を飛び越さない時間を計測してから、スキップ処理を行うように構成してもよい。図２３の（ｂ）は、仮想車両（Ｖ０１）の直前の実車両（Ｒ０４）が積込場の出口から退出してから、仮想車両（Ｖ０１）のスキップ処理を行った際の区間情報を示す。この区間情報では、仮想車両（Ｖ０１）と直前の実車両（Ｒ０４）との前後関係が維持される。走行許可区間設定部３２２は、計時処理に代わり、直前の実車両（Ｒ０４）から受信する現在位置が出口を退出したことを確認して、スキップ処理を実行してもよい。 Therefore, the control server 31 is provided with a timer, and the travel permission section setting unit 322 is configured to perform the skip processing after measuring the time during which the virtual vehicle does not jump over the immediately preceding vehicle (especially the real vehicle) in the skip processing. You may (B) of FIG. 23 shows section information when the skip processing of the virtual vehicle (V01) is performed after the real vehicle (R04) immediately before the virtual vehicle (V01) has exited from the exit of the loading site. . In the section information, the anteroposterior relationship between the virtual vehicle (V01) and the immediately preceding actual vehicle (R04) is maintained. The run 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 time counting process.
本実施形態によれば、仮想車両シミュレーション時におけるショベルの不稼働時間をより短くし、シミュレーションが実際の鉱山の稼働状況に与える影響を減らすことができる。 According to the present embodiment, it is possible to further shorten the non-operation time of the shovel at the time of virtual vehicle simulation, and to reduce the influence of the simulation on the actual mine operating condition.
上記各実施形態は、本発明の実施態様の一例を示すにすぎず、本発明を限定するものではない。実施形態には上記に記載したものの他、本発明の要旨を変更しない範囲で様々な変形例があり、それらも本発明に含まれるものである。 Each of the above embodiments merely shows one example of the embodiment of the present invention, and does not limit the present invention. The embodiments addition to those described above, there are various modifications within the scope not changing the gist of the present invention are those which are also included in the present invention.
例えば、図１６の仮想車両を追加するＧＵＩでは走行路上に仮想車両を追加したが、仮想車両を追加する操作を行うと、予め決められた出発点、例えば駐機場から仮想車両が出発するように構成してもよい。 For example, in the GUI for adding a virtual vehicle shown in FIG. 16, a virtual vehicle is added on the traveling road, but when an operation for adding a virtual vehicle is performed, the virtual vehicle leaves from a predetermined departure point, for example, a parking lot It may be configured.
また第四実施形態のスキップ動作例として積込動作に関するものを例示したが、放土動作に関連する動作をスキップしてもよい。 Moreover, although the thing regarding loading operation was illustrated as an example of skip operation of 4th embodiment, you may skip the operation | movement relevant to earth release operation.
更に、図１６、図１７の表示画面において、走行許可区間が設定できない状況が生じると警告表示を行うようにしてもよい。この場合も、仮想車両及び直後の後続車両（実車両、及び仮想車両を含む）に対して上記状況が生じた場合に限定してもよい。これにより、仮想車両を追加したことに起因する走行許可区間設定不可な状況が把握しやすくなり、自律走行システムの動作検証に好適な表示画面を提供できる。 Furthermore, on the display screens of FIG. 16 and FIG. 17, a warning may be displayed when a situation in which the travel permission section can not be set occurs. Also in this case, the above situation may be limited to the virtual vehicle and the immediately following vehicle (including the real vehicle and the virtual vehicle). This makes it easy to grasp the situation in which the travel permission section can not be set due to the addition of the virtual vehicle, and can provide a display screen suitable for the operation verification of the autonomous travel system.
１：自律走行システム
２０、２０−１、２０−２：自律走行ダンプ（実車両）
３１：管制サーバ（管制制御装置）
７０、７０−１、７０−２：仮想車両
1: Autonomous traveling system 20, 20-1, 20-2: Autonomous traveling dump (actual vehicle)
31: Control server (control control device)
70, 70-1, 70-2: virtual vehicles
Claims (9)
実在する走行路を規定した実地図データを記憶する地図データ記憶部と、
前記走行路を仮想的に走行する仮想車両の設定操作を受け付ける入力部と、
前記仮想車両の走行状態を規定する走行パラメータ及び前記実地図データを用いて、前記仮想車両が前記走行路を走行した際の走行状態のシミュレーションを行う仮想車両シミュレーション部と、
前記運搬車両と無線通信を行うことにより、前記走行路を自律走行中の前記運搬車両の位置情報を受信する通信部と、
前記運搬車両の位置情報、前記実地図データ、及び前記仮想車両のシミュレーションした走行状態に基づいて、前記運搬車両及び前記仮想車両の其々に対し、各車両の走行を許可する前記走行路の部分区間からなる走行許可区間を設定する走行許可区間設定部と、を備え、
前記通信部は、前記運搬車両に対し、当該運搬車両に対して設定された走行許可区間を示す走行許可区間情報を送信し、前記仮想車両シミュレーション部は、前記仮想車両に対して設定された前記走行許可区間に従って前記走行路を走行した際のシミュレーションを行い、その結果を前記走行許可区間設定部に返す、
ことを特徴とする管制制御装置。 A control control device that controls the traveling of a transport vehicle that autonomously travels along a predetermined travel path in a mine yard, comprising:
A map data storage unit that stores actual map data that defines an existing travel path;
An input unit that receives a setting operation of a virtual vehicle virtually traveling on the traveling path;
A virtual vehicle simulation unit that simulates a traveling state when the virtual vehicle travels on the traveling path using the traveling parameter defining the traveling state of the virtual vehicle and the actual map data;
A communication unit configured to receive position information of the transporter vehicle traveling autonomously on the traveling path by performing wireless communication with the transporter vehicle;
A portion of the travel path for permitting travel of each vehicle to each of the transport vehicle and the virtual vehicle based on position information of the transport vehicle, the actual map data, and a simulated traveling state of the virtual vehicle A travel permission section setting unit for setting a travel permission section consisting of sections;
The communication unit transmits, to the transport vehicle, travel permission section information indicating a travel permission section set for the transport vehicle, and the virtual vehicle simulation unit is configured for the virtual vehicle. The simulation when traveling on the traveling road according to the travel permitted section is performed, and the result is returned to the travel permitted section setting unit.
Control control device characterized by.
前記入力部は、前記実在する走行路に接続する、実在しない仮想の走行路を追加する設定操作を更に受け付け、
前記地図データ生成部は、前記実在する走行路及び前記仮想の走行路を規定する仮想地図データを生成し、
前記地図データ記憶部は、前記仮想地図データを記憶し、
前記走行許可区間設定部は、前記仮想地図データに基づいて、前記運搬車両に対する走行許可区間は、前記実在する走行路に設定し、前記仮想車両に対する走行許可区間は、前記実在する走行路及び前記仮想の走行路の少なくとも一方に設定する、
ことを特徴とする請求項１に記載の管制制御装置。 It further comprises a map data generation unit that generates map data that defines a travel path,
The input unit further receives a setting operation for adding a non-existent virtual traveling path connected to the existing traveling path.
The map data generation unit generates virtual map data that defines the existing traveling path and the virtual traveling path.
The map data storage unit stores the virtual map data,
The travel permission section setting unit sets the travel permission section for the transport vehicle to the existing travel path based on the virtual map data, and the travel permission section for the virtual vehicle includes the actual travel path and the actual travel path. Set at least one of the virtual travel paths,
The control control device according to claim 1, characterized in that:
ことを特徴とする請求項１に記載の管制制御装置。 When traveling on the same spot using traveling data of the transport vehicle received from the transport vehicle while the communication unit is traveling, the simulated traveling state of the virtual vehicle matches the traveling state of the transport vehicle And a driving parameter correction unit that corrects the driving parameters.
The control control device according to claim 1, characterized in that:
前記仮想車両シミュレーション部は、前記シミュレーションにおいて、前記仮想車両が前記積込場の入口で待機する待機動作、前記入口から前記積込位置へ向かう走行動作、及び前記積込位置における停車動作、のうち少なくとも一つの動作は、前記運搬車両が実際に同じ動作を行ったときに要する時間よりも短い時間で終わらせる、
ことを特徴とする請求項１に記載の管制制御装置。 The existing runway is a runway connected to a loading station including a loading position where loading of a load is performed to the transport vehicle,
The virtual vehicle simulation unit is, among the simulation, a standby operation in which the virtual vehicle stands by at the entrance of the loading space, a traveling operation from the entrance toward the loading position, and a stopping operation at the loading position At least one operation is completed in a time shorter than the time required for the transport vehicle to actually perform the same operation.
The control control device according to claim 1, characterized in that:
前記走行パラメータに基づいて前記仮想車両の加減速を含む走行状態及び位置を計算する走行シミュレーション部と、
前記走行シミュレーション部の計算結果に基づいて、前記仮想車両の位置を算出するセンサシミュレーション部と、
前記仮想車両に対して設定された走行許可区間及び前記仮想車両の位置に基づいて、前記仮想車両を走行させるための加減速の制御指令を前記走行シミュレーション部に対して行う仮想走行制御部と、を含む、
ことを特徴とする請求項１に記載の管制制御装置。 The virtual vehicle simulation unit
A traveling simulation unit that calculates a traveling state and a position including acceleration and deceleration of the virtual vehicle based on the traveling parameter;
A sensor simulation unit that calculates the position of the virtual vehicle based on the calculation result of the traveling simulation unit;
A virtual traveling control unit which issues, to the traveling simulation unit, an acceleration / deceleration control command for causing the virtual vehicle to travel based on the traveling permitted section set for the virtual vehicle and the position of the virtual vehicle; including,
The control control device according to claim 1, characterized in that:
ことを特徴とする請求項５に記載の管制制御装置。 The sensor simulation unit generates an error based on a value actually calculated by the position calculation device mounted on the transport vehicle with respect to the position of the virtual vehicle calculated by the traveling simulation unit, and a positioning radio wave from a positioning satellite Correct using at least one of the errors according to the capture situation of
The control control device according to claim 5, characterized in that:
ことを特徴とする請求項１に記載の管制制御装置。 Each of the transport vehicle and the virtual vehicle corresponds to the travel position of the transport vehicle and the virtual vehicle on the travel path included in the map image on the map image showing the existing travel path. Further comprising a display unit for changing the display mode of the image showing
The control control device according to claim 1, characterized in that:
前記仮想車両シミュレーション部は、前記設定された走行パラメータを用いて前記仮想車両の走行シミュレーションを行う、
ことを特徴とする請求項１に記載の管制制御装置。 The input unit further receives at least one setting operation of the weight, maximum load, wheel base, minimum turning radius, speed, acceleration, wheel rotation number, and torque of the virtual vehicle as the traveling parameters;
The virtual vehicle simulation unit performs traveling simulation of the virtual vehicle using the set traveling parameters.
The control control device according to claim 1, characterized in that:
実在しない走行路である仮想の走行路を規定する仮想地図データを生成するステップと、
前記仮想の走行路を走行する実在しない車両である仮想車両の設定操作を受け付けるステップと、
前記仮想車両の走行状態を規定する走行パラメータ及び前記仮想地図データを用いて、前記仮想車両に前記仮想の走行路を走行させるシミュレーション処理を実行するステップと、
前記仮想地図データを、前記運搬車両が実際に自律走行する際に用いる実地図データとして格納するステップと、
前記実地図データに基づく実在の走行路上を仮想的に走行する仮想車両の設定入力を受け付けるステップと、
前記仮想車両の走行状態を規定する走行パラメータ及び前記実地図データを用いて、前記仮想車両が前記実在の走行路を仮想的に走行した際の走行状態のシミュレーションを行うステップと、
前記実在の走行路を走行する前記運搬車両から当該運搬車両の位置情報を取得するステップと、
前記運搬車両の位置情報、前記実地図データ、及び前記仮想車両のシミュレーションした走行状態に基づいて、前記運搬車両及び前記仮想車両の其々に対し、各車両の走行を許可する前記走行路の部分区間からなる走行許可区間を設定するステップと、
を含むことを特徴とする運搬車両の走行シミュレーション方法。 A traveling simulation method of a transport vehicle that autonomously travels along a predetermined traveling path in a mine yard,
Generating virtual map data defining a virtual traveling path which is a non-existent traveling path;
Accepting a setting operation of a virtual vehicle, which is a non-existent vehicle traveling on the virtual traveling path;
Executing simulation processing for causing the virtual vehicle to travel on the virtual travel path using travel parameters defining the travel state of the virtual vehicle and the virtual map data;
Storing the virtual map data as actual map data used when the transport vehicle actually travels autonomously;
Accepting a setting input of a virtual vehicle virtually traveling on an existing traveling road based on the real map data;
Simulating a running condition when the virtual vehicle virtually runs on the existing running route, using the running parameter defining the running condition of the virtual vehicle and the actual map data;
Acquiring position information of the transport vehicle from the transport vehicle traveling on the existing traveling path;
A portion of the travel path for permitting travel of each vehicle to each of the transport vehicle and the virtual vehicle based on position information of the transport vehicle, the actual map data, and a simulated traveling state of the virtual vehicle Setting a travel permission section consisting of sections;
A method of simulating the travel of a transport vehicle, comprising:
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2014167813A JP6426941B2 (en) | 2014-08-20 | 2014-08-20 | Control control device and driving simulation method of transport vehicle |
| PCT/JP2015/073230 WO2016027830A1 (en) | 2014-08-20 | 2015-08-19 | Management control system and method for simulating transportation vehicle travel |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2014167813A JP6426941B2 (en) | 2014-08-20 | 2014-08-20 | Control control device and driving simulation method of transport vehicle |
Publications (3)
| Publication Number | Publication Date |
|---|---|
| JP2016045585A JP2016045585A (en) | 2016-04-04 |
| JP2016045585A5 JP2016045585A5 (en) | 2017-04-06 |
| JP6426941B2 true JP6426941B2 (en) | 2018-11-21 |
Family
ID=55350774
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2014167813A Active JP6426941B2 (en) | 2014-08-20 | 2014-08-20 | Control control device and driving simulation method of transport vehicle |
Country Status (2)
| Country | Link |
|---|---|
| JP (1) | JP6426941B2 (en) |
| WO (1) | WO2016027830A1 (en) |
Families Citing this family (17)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP6701343B2 (en) * | 2016-08-03 | 2020-05-27 | 三菱電機株式会社 | Road condition diagnosis system |
| KR101897992B1 (en) * | 2017-03-28 | 2018-09-13 | 재단법인대구경북과학기술원 | Autonomous drive control development kit for autonomous vehicle design |
| KR101938064B1 (en) * | 2017-05-17 | 2019-01-11 | 현대오토에버 주식회사 | Autonomous Driving Test System |
| KR102375306B1 (en) * | 2018-01-24 | 2022-03-16 | 한화디펜스 주식회사 | Driving information display device and method and driving speed control method for a working vehicle |
| JP7141883B2 (en) * | 2018-07-31 | 2022-09-26 | 株式会社小松製作所 | WORKING MACHINE CONTROL SYSTEM, WORKING MACHINE, AND WORKING MACHINE CONTROL METHOD |
| JP7129891B2 (en) * | 2018-11-21 | 2022-09-02 | 日立建機株式会社 | Work vehicle, work area management system |
| JP7262609B2 (en) * | 2019-03-22 | 2023-04-21 | ボルボトラックコーポレーション | How to control a vehicle in a mission along the path |
| JP7293914B2 (en) * | 2019-06-28 | 2023-06-20 | トヨタ自動車株式会社 | Autonomous vehicle, operation control center and vehicle operation system |
| US11280616B2 (en) | 2019-07-11 | 2022-03-22 | Caterpillar Inc. | Operating status identification system for machine |
| CN110543173B (en) * | 2019-08-30 | 2022-02-11 | 上海商汤智能科技有限公司 | Vehicle positioning system and method, and vehicle control method and device |
| JP6860640B2 (en) * | 2019-11-20 | 2021-04-21 | ヤンマーパワーテクノロジー株式会社 | Route generation system |
| CN111123740B (en) * | 2019-12-19 | 2024-04-16 | 北京经纬恒润科技股份有限公司 | Hardware-in-loop test method and device |
| CN111815771A (en) * | 2020-07-07 | 2020-10-23 | 中冶北方（大连）工程技术有限公司 | Web page end simulation strip mine production method |
| JP7478092B2 (en) | 2020-12-28 | 2024-05-02 | 株式会社日立製作所 | Cargo handling system |
| KR102568969B1 (en) * | 2021-03-31 | 2023-08-23 | 주식회사 한국디지털트윈연구소 | Driving environment scenario generator for autonomous driving testing using digital twin technology |
| JP2024071265A (en) * | 2022-11-14 | 2024-05-24 | 株式会社小松製作所 | Unmanned vehicle management system and unmanned vehicle management method |
| KR102576733B1 (en) * | 2022-11-30 | 2023-09-08 | 주식회사 모라이 | Method and system for simulating traffic environment based on vils linked to control platform |
Family Cites Families (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2006244124A (en) * | 2005-03-03 | 2006-09-14 | Techno Craft Co Ltd | Operation management device |
| JP4463757B2 (en) * | 2005-12-09 | 2010-05-19 | 株式会社小松製作所 | Vehicle travel control device |
| JP4779638B2 (en) * | 2005-12-20 | 2011-09-28 | アイシン・エィ・ダブリュ株式会社 | Travel prediction system |
| JP5362691B2 (en) * | 2010-11-30 | 2013-12-11 | 株式会社小松製作所 | Driving control method in unmanned vehicle traveling system and unmanned vehicle traveling system |
-
2014
- 2014-08-20 JP JP2014167813A patent/JP6426941B2/en active Active
-
2015
- 2015-08-19 WO PCT/JP2015/073230 patent/WO2016027830A1/en active Application Filing
Also Published As
| Publication number | Publication date |
|---|---|
| JP2016045585A (en) | 2016-04-04 |
| WO2016027830A1 (en) | 2016-02-25 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP6426941B2 (en) | Control control device and driving simulation method of transport vehicle | |
| EP3217380B1 (en) | Map creation device | |
| JP6498542B2 (en) | Control control system and in-vehicle terminal device | |
| US10140871B2 (en) | Wireless system and operation management server | |
| JP6247622B2 (en) | Air traffic control device | |
| JP6475227B2 (en) | Work machine control system, work machine, and work machine management system | |
| JP5362691B2 (en) | Driving control method in unmanned vehicle traveling system and unmanned vehicle traveling system | |
| US10339806B2 (en) | Traffic control server and system | |
| JP2022509762A (en) | Performing tasks using autonomous machines | |
| JP6025848B2 (en) | Vehicle control system | |
| JP6145024B2 (en) | Dump truck operation management system | |
| JP6352841B2 (en) | In-vehicle terminal device and traffic control system | |
| JP2016071568A5 (en) | ||
| JP6487561B2 (en) | Mining machine logging system, in-vehicle terminal device, and mining machine logging method | |
| JP6339412B2 (en) | Traffic control server | |
| JP2020086779A (en) | Work vehicle and work area management system |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20170224 |
|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20170224 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20171205 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20180129 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20180703 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20180831 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20181023 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20181026 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 6426941 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |