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