JP2715201B2 - Operation method and device for preventing collision of unmanned self-propelled body - Google Patents
Operation method and device for preventing collision of unmanned self-propelled bodyInfo
- Publication number
- JP2715201B2 JP2715201B2 JP3290595A JP29059591A JP2715201B2 JP 2715201 B2 JP2715201 B2 JP 2715201B2 JP 3290595 A JP3290595 A JP 3290595A JP 29059591 A JP29059591 A JP 29059591A JP 2715201 B2 JP2715201 B2 JP 2715201B2
- Authority
- JP
- Japan
- Prior art keywords
- unmanned self
- area
- propelled
- self
- position 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims description 14
- 230000002265 prevention Effects 0.000 claims description 40
- 238000001514 detection method Methods 0.000 claims description 13
- 238000012544 monitoring process Methods 0.000 claims description 6
- 238000010586 diagram Methods 0.000 description 8
- 238000013459 approach Methods 0.000 description 6
- 238000002360 preparation method Methods 0.000 description 5
- 230000005540 biological transmission Effects 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 230000001174 ascending effect Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000005065 mining Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000002250 progressing effect Effects 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
Description
【０００１】[0001]
【産業上の利用分野】この発明は、走行予定コース上を
走行する複数の無人自走体を無線通信を用いて追突や衝
突を防止するための無人自走体の衝突防止方法およびそ
の装置に関する。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a method and a device for preventing collision of unmanned self-propelled bodies traveling on a scheduled course by using wireless communication to prevent collision or collision. .
【０００２】[0002]
【従来の技術】従来、走行予定コース上に前後に複数の
無人自走体を走行させる場合には、各無人自走体の衝突
を防ぐには、障害物検出用の各種センサを取付け、コー
ス上の障害物や走行上支障の生じる障害物を探索しなが
ら走行している。これらは、超短波や赤外線等の発受信
装置を特別に設ける必要があり、構造が複雑化する欠点
がある。ここで、予め設定された走行予定コースを複数
の無人自走体が走行している場合には、これらの無人自
走体が先行する無人自走体に追突しなければよく、簡便
な構成で確実に無人自走体間の追突や衝突を防止する衝
突防止方法やその装置の開発が望まれていた。本出願人
らは、既に、無人自走体を走行予定コースに沿って誘導
制御するための構成として、特開昭６１−７０６１５号
の自動走行体の自己誘導制御方法、特開昭６３−１４８
３１２号の位置検出システム等を提案しているが、上記
走行予定コースに誘導制御するために算出される無人自
走体の位置データを利用するば衝突防止を図ることがで
きることを見いだし、本発明を完成するに至った。2. Description of the Related Art Conventionally, when a plurality of unmanned self-propelled bodies are to be run back and forth on a scheduled course, various sensors for detecting obstacles are installed to prevent collision of the unmanned self-propelled bodies. The vehicle is traveling while searching for an upper obstacle or an obstacle that causes a trouble in traveling. These require the provision of a special device for transmitting and receiving ultra-short waves, infrared rays, and the like, which has a drawback that the structure is complicated. Here, when a plurality of unmanned self-propelled bodies are traveling on a predetermined scheduled traveling course, it is sufficient that these unmanned self-propelled bodies do not collide with the preceding unmanned self-propelled body, and have a simple configuration. It has been desired to develop a collision prevention method and device for surely preventing collision or collision between unmanned self-propelled bodies. The present applicants have already disclosed a self-guidance control method for an automatic traveling body disclosed in Japanese Patent Application Laid-Open No. Sho 61-70615 and Japanese Patent Application Laid-Open No. 63-148 as a configuration for performing guidance control of an unmanned self-propelled object along a scheduled course.
No. 312 has been proposed, but it has been found that collision can be prevented by using the position data of the unmanned self-propelled body calculated to control the guidance on the planned course. Was completed.
【０００３】[0003]
【発明が解決しようとする問題点】この発明の主たる課
題は、各無人自走体が自己誘導のために検出する位置デ
ータを送受し、これを受信した無人自走体が先行する他
の無人自走体の位置データが、衝突の可能性のあるエリ
アにあるか否かを判定して衝突を防止することのできる
衝突防止方法またはその装置を提供することにある。こ
の発明の別の課題は、走行予定コースが交差する等し
て、無人自走体の位置を基準とする相対的なエリアで衝
突の可能性を判断できない場合には、無人自走体を待機
ポイントで停止させ、先行する無人自走体が指定エリア
に入るまで、または指定エリアから出るまでは発進しな
いように制御して衝突を確実に防止するようにした衝突
防止方法またはその装置を提供することにある。SUMMARY OF THE INVENTION The main problem of the present invention is that each unmanned self-propelled vehicle transmits and receives position data detected for self-guidance, and the unmanned self-propelled vehicle receiving the data transmits another unmanned self-propelled vehicle. It is an object of the present invention to provide a collision prevention method and apparatus capable of determining whether or not position data of a self-propelled body is in an area where a collision is likely to occur to prevent a collision. Another object of the present invention is to wait for an unmanned self-propelled body when it is not possible to determine the possibility of collision in a relative area based on the position of the unmanned self-propelled body due to, for example, intersections of scheduled courses. A collision prevention method or device is provided that stops at a point and controls so that the unmanned self-propelled vehicle does not start until the preceding unmanned self-propelled vehicle enters or exits the designated area to reliably prevent collision. It is in.
【０００４】[0004]
【課題を解決するための手段】上記課題を解決するため
に、請求項１の発明では、予め設定した走行予定コース
上を同時に走行する複数の無人自走体が、それぞれ位置
検出装置により自己の位置を検出し、該検出された位置
データを基に誘導制御装置により走行予定コースに沿っ
て各無人自走体を自己誘導する無人自走体の衝突防止方
法であって、各無人自走体が自己の位置を発信すると共
に、他の無人自走体の位置を受信可能としており、位置
検出装置から得られた無人自走体の自己の位置データを
もとに、該位置データを中心にその外側に所定範囲の停
止エリアを算出し、更にその外側で進行方向に向かって
広がる減速エリアを算出する、上記受信装置から入力さ
れた他の無人自走体の位置データが上記エリアに含まれ
るか否かを判定する、上記位置データが停止エリアに含
まれる場合に無人自走体を停止させ、減速エリアに含ま
れる場合に無人自走体の車速を所定速度に減速させるよ
うに走行を制御する、という技術的手段を講じている。
また、請求項２の発明では、上記構成に加えて、当該無
人自走体が走行予定コース上を待機ポイントに向かう際
に、他の無人自走体から送信された上記位置データが監
視エリア内に含まれるか否か判定する、監視エリアに含
まれる場合に、自己の無人自走体を上記待機ポイントに
停止させる、該待機ポイント上で、他の無人自走体の受
信した位置データが予め設定した指定エリアに入ったか
否か、または指定エリアから出たか否かを判定する、該
指定エリアに入った場合、または指定エリアから出た場
合に無人自走体を発進させる、という技術的手段を講じ
ている。また、請求項４の発明では、各無人自走体に、
上記検出された自己の位置データを送信する送信装置を
設ける、他の無人自走体が送信した他の位置データを受
信する受信装置を設ける、衝突防止装置に、位置検出装
置から得られた自己の位置データをもとに、該位置デー
タを中心にその外側に所定範囲の停止エリアを算出し、
更にその外側で進行方向に向かって広がる減速エリアを
算出するエリア算出手段を設ける、上記受信装置から入
力された他の無人自走体の位置データが上記エリアに含
まれるか否かを判定する衝突防止判定手段を設ける、上
記位置データが停止エリアに含まれる場合に無人自走体
を停止させ、減速エリアに含まれる場合に無人自走体の
車速を所定速度に減速させる衝突防止制御手段を設け
る、という技術的手段を講じている。また請求項５の発
明では、上記請求項４の発明に加えて、フリート制御装
置を設け、該フリート制御装置に、受信した他の無人自
走体の位置が監視エリア内にあるとき、自己の位置デー
タをもとに自己の無人自走体を待機ポイントに停止させ
る待機制御手段を設ける、上記待機ポイント上で、他の
所定の無人自走体から受信した他の位置データが予め設
定した指定エリアに入ったか否か、または指定エリアか
ら出たか否かを判定し、該指定エリアに入った場合、ま
たは該指定エリアから出た場合に無人自走体を発進さ
せ、走行予定コースに沿った走行制御を行なう発進制御
手段を設ける、という技術的手段を講じている。In order to solve the above-mentioned problems, according to the invention of claim 1, a plurality of unmanned self-propelled bodies traveling simultaneously on a predetermined course to be traveled are individually self-propelled by a position detecting device. A method for preventing collision of unmanned self-propelled vehicles, comprising detecting a position and self-guiding each unmanned self-propelled vehicle along a scheduled course by a guidance control device based on the detected position data. Transmits its own position and can receive the position of another unmanned self-propelled body.Based on its own position data obtained from the position detection device, A stop area of a predetermined range is calculated outside the area, and a deceleration area expanding further in the traveling direction is calculated outside the area. Position data of another unmanned self-propelled object input from the receiving device is included in the area. Judge whether or not A technical means for stopping the unmanned self-propelled body when the position data is included in the stop area, and controlling the traveling such that the vehicle speed of the unmanned self-propelled body is reduced to a predetermined speed when the position data is included in the deceleration area. Have taken.
In addition, in the invention of claim 2, in addition to the above configuration, when the unmanned self-propelled body heads to the standby point on the planned course, the position data transmitted from another unmanned self-propelled body is stored in the monitoring area. It determines whether or not it is included in the surveillance area. If it is included in the monitoring area, it stops its own unmanned self-propelled body at the above-mentioned waiting point. Technical means for determining whether or not the vehicle has entered or exited the specified designated area, and to start the unmanned self-propelled body when entering or leaving the designated area Have taken. In the invention of claim 4, each unmanned self-propelled body has:
Providing a transmitting device for transmitting the detected self-position data, providing a receiving device for receiving other position data transmitted by another unmanned self-propelled vehicle, Based on the position data, a stop area of a predetermined range outside the position data is calculated around the position data,
Further, an area calculating means for calculating a deceleration area spreading toward the advancing direction on the outside thereof is provided. The collision determining whether or not the position data of another unmanned self-propelled object input from the receiving apparatus is included in the area is provided. A collision prevention control means for stopping the unmanned self-propelled body when the position data is included in the stop area and decelerating the vehicle speed of the unmanned self-propelled body to a predetermined speed when the position data is included in the deceleration area; , Taking the technical measures of. According to a fifth aspect of the present invention, in addition to the fourth aspect of the present invention, a fleet control device is provided, and when the position of the other unmanned self-propelled vehicle received is within the monitoring area, the fleet control device has its own fleet control device. Providing standby control means for stopping the unmanned self-propelled vehicle at the standby point based on the position data. On the standby point, another position data received from another predetermined unmanned self-propelled vehicle is designated in advance. It is determined whether or not the vehicle has entered the area, or whether or not the vehicle has exited the designated area. Technical means of providing start control means for controlling traveling is provided.
【０００５】[0005]
【作用】次に、図１の機能ブロック図をもとに無人自走
体の衝突防止運行方法および装置の作用を説明する。こ
こで走行制御装置１は同一構成のものが各無人自走体に
装備されるが、説明の都合上、無人自走体を１０と１
０’とする。各無人自走体１０、１０’に設けられた位
置検出装置２は、現在の無人自走体の位置を検出し、得
られた位置データを誘導制御装置６と共に送信装置３Ａ
に出力する。該誘導制御装置６では、上記位置データと
予め記憶されている走行予定コースとを比較し、無人自
走体１０を走行予定コース上に誘導する。一方、受信装
置３Ｂでは、他の無人自走体１０’の送信装置３Ａから
送られた位置データを入力する。そして、一方の無人自
走体１０の衝突防止装置４では、エリア算出手段４Ａ
で、位置検出装置２から得られた自己の位置を中心とし
て小径に設定される停止エリアと、その外側に大径に設
定させる減速エリアを算出する。次いで、衝突防止判定
手段４Ｂでは、受信装置３Ｂから得られた先行する無人
自走体の位置データが上記各エリアに含まれるか否か、
いずれのエリアに含まれるかを判定する。そして、衝突
防止制御手段４Ｃにより、上記エリアに含まれない場合
には、誘導制御装置６による平常の走行が行なわれ、減
速エリアに含まれる場合には所定車速に減速させ、停止
エリアに含まれる場合には無人自走体を停止するよう制
御する。図２の機能ブロック図は上記構成にフリート制
御装置５が加わった構成を示すもので、例えば走行予定
コース中に交差するコースが含まれている場合には、上
記制御では十分な衝突防止が図られない場合あるのでこ
れを解消するために用いられる。即ち、上記構成に更に
加えて、待機制御手段５Ａで、前記受信装置３Ｂから得
た他方の無人自走体１０’の位置が積込みエリア内に含
まれるか否か判定し、含まれる場合には、上記減速エリ
アおよび停止エリアによる判定を中止し、誘導制御装置
６を介して走行予定コース上の待機ポイントで停止させ
る。次に、発進制御手段５Ｂで、他方の無人自走体１
０’から受信した他の位置データが予め設定した指定エ
リアに入ったか否かを判定し、該指定エリアに入った場
合に無人自走体１０を発進させ、または他の無人自走体
１０’が該指定エリアから出たか否かを判定し、該指定
エリアから出た場合に無人自走体１０を待機ポイントか
ら発進させ、前記誘導制御装置６による誘導制御を続行
させる。Next, the operation of the method and the apparatus for preventing collision of an unmanned self-propelled vehicle will be described with reference to the functional block diagram of FIG. Here, the traveling control device 1 is provided with the same configuration for each of the unmanned self-propelled bodies.
Set to 0 '. The position detecting device 2 provided in each of the unmanned self-propelled bodies 10 and 10 'detects the current position of the unmanned self-propelled body and transmits the obtained position data together with the guidance control device 6 to the transmitting device 3A.
Output to The guidance control device 6 compares the position data with a pre-stored traveling course and guides the unmanned self-propelled body 10 on the traveling course. On the other hand, in the receiving device 3B, the position data transmitted from the transmitting device 3A of the other unmanned self-propelled body 10 'is input. In the collision prevention device 4 for one of the unmanned self-propelled bodies 10, the area calculation means 4A
Then, a stop area having a small diameter centered on its own position obtained from the position detection device 2 and a deceleration area having a large diameter set outside thereof are calculated. Next, the collision prevention determination means 4B determines whether or not the position data of the preceding unmanned self-propelled vehicle obtained from the receiving device 3B is included in each of the areas.
It is determined which area is included. Then, when the vehicle is not included in the above-mentioned area, normal traveling by the guidance control device 6 is performed by the collision prevention control unit 4C. When the vehicle is included in the deceleration area, the vehicle is decelerated to a predetermined vehicle speed and included in the stop area. In this case, control is performed to stop the unmanned self-propelled body. The functional block diagram of FIG. 2 shows a configuration in which the fleet control device 5 is added to the above configuration. For example, in the case where an intersecting course is included in the scheduled traveling course, the above control is sufficient to prevent collision. Since it may not be possible, it is used to solve this. That is, in addition to the above configuration, the standby control unit 5A determines whether or not the position of the other unmanned self-propelled object 10 'obtained from the receiving device 3B is included in the loading area. Then, the determination based on the deceleration area and the stop area is stopped, and the vehicle is stopped via the guidance control device 6 at a standby point on the scheduled course. Next, the other unmanned self-propelled body 1 is controlled by the start control means 5B.
It is determined whether or not the other position data received from 0 'has entered a designated area set in advance, and when entering the designated area, the unmanned self-propelled body 10 is started or the other unmanned self-propelled body 10' is started. It is determined whether or not the vehicle has exited the designated area. If the vehicle has exited the designated area, the unmanned self-propelled body 10 is started from the standby point, and the guidance control by the guidance control device 6 is continued.
【０００６】[0006]
【実施例】以下に、この発明の無人自走体の衝突防止運
行装置を採鉱現場のダンプトラック（オフハイウエイト
ラック）に適用した場合の好適実施例について図３及び
図４を参照しながら説明する。DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS Hereinafter, a preferred embodiment in which the unmanned self-propelled vehicle collision prevention operation device of the present invention is applied to a dump truck (off-highway truck) at a mining site will be described with reference to FIGS. .
【０００７】この衝突防止システム１は、ダンプトラッ
クからなる各無人自走体１０に同一の装置がそれぞれ設
けられているもので、位置検出装置２と、送信装置３Ａ
と、受信装置３Ｂと、衝突防止装置４と、誘導制御装置
６とからなっている。ここで位置検出装置２は、無人自
走体１０の走行可能エリアにＸ軸、Ｙ軸を想定して、該
無人自走体１０の位置を二次元座標で表示する。In this collision prevention system 1, the same device is provided for each unmanned self-propelled body 10 composed of a dump truck, and a position detection device 2 and a transmission device 3A are provided.
, A reception device 3B, a collision prevention device 4, and a guidance control device 6. Here, the position detection device 2 displays the position of the unmanned self-propelled body 10 in two-dimensional coordinates, assuming the X-axis and the Y-axis in the travelable area of the unmanned self-propelled body 10.
【０００８】即ち、本実施例で位置検出装置２は公知構
成からなっており、相対位置検出手段２Ａと、絶対位置
検出手段２Ｂと、起算位置更新手段２Ｃとを有してい
る。相対位置検出手段２Ａは、無人自走体１０の速度と
ステアリングの角度を検出するセンサＳ１、Ｓ２を有し
ており、該センサから得られた無人自走体１０の速度
（距離）と方位角から、スタート地点（または起算点）
を基にした相対的な位置（上記二次元座標上での位置）
をリアルタイムに算出する構成からなっている。That is, in this embodiment, the position detecting device 2 has a known configuration, and has a relative position detecting means 2A, an absolute position detecting means 2B, and a starting position updating means 2C. The relative position detecting means 2A has sensors S1 and S2 for detecting the speed of the unmanned self-propelled body 10 and the steering angle, and the speed (distance) and azimuth of the unmanned self-propelled body 10 obtained from the sensors. From, starting point (or starting point)
Relative position based on (the position on the above two-dimensional coordinates)
Is calculated in real time.
【０００９】また、絶対位置検出手段２Ｂは、走行予定
コースに沿って所定位置（上記二次元座標上での固定
点）に、無人自走体１０が発信した信号（赤外線等）を
反射して返す反射装置を備えたポールを設けておき、無
人自走体１０が通過する際に、無人自走体１０に設けた
センサＳ３により反射信号を受信して、座標上の位置が
決まっているポールと、そこを通過する無人自走体１０
の変位量（進入角度、及び距離）を算出し、これをもと
に無人自走体１０の位置を算出する構成からなってい
る。The absolute position detecting means 2B reflects a signal (such as infrared rays) transmitted by the unmanned self-propelled body 10 at a predetermined position (fixed point on the two-dimensional coordinates) along the course to be traveled. A pole provided with a reflecting device for returning is provided, and when the unmanned self-propelled body 10 passes, a reflected signal is received by a sensor S3 provided on the unmanned self-propelled body 10, and a pole whose position on coordinates is determined. And the unmanned self-propelled body 10 passing there
Is calculated (the approach angle and the distance), and the position of the unmanned self-propelled body 10 is calculated based on the calculated displacement.
【００１０】そして、起算位置更新手段２Ｃでは、上記
相対位置検出手段２Ａで得られた位置データを、上記ポ
ールを通過する毎に上記絶対位置検出手段２Ｂで得られ
た位置データと比較し、前者の位置データとの間に誤差
がある場合には後者の位置データを正しい位置データと
して訂正し、その位置を新たな相対位置算出の起算点と
して更新している。このようにして得られた位置データ
はリアルタイムに出力される構成となっている。[0010] The starting position updating means 2C compares the position data obtained by the relative position detecting means 2A with the position data obtained by the absolute position detecting means 2B every time the vehicle passes the pole. If there is an error between the position data and the position data, the latter position data is corrected as correct position data, and the position is updated as a new relative position calculation starting point. The position data obtained in this manner is output in real time.
【００１１】次に、送信装置３Ａは、これが装備された
無人自走体１０の固有コードと共に上記位置検出装置２
で検出された位置データを送信するもので、受信装置３
Ｂにより受信される。この位置データの通信に関して
は、例えば、走行予定コース３０に沿って中継用の地上
監視局を設け、各無人自走体１０間の送信した位置デー
タを中継して、受信距離を実質的に長くする構成を用い
てもよい。Next, the transmitting device 3A transmits the position detecting device 2 along with the unique code of the unmanned self-propelled body 10 equipped with the transmitting device 3A.
And transmits the position data detected by the receiving device 3.
B. Regarding the communication of the position data, for example, a ground monitoring station for relay is provided along the scheduled traveling course 30, and the transmitted position data between the unmanned self-propelled vehicles 10 is relayed to substantially increase the reception distance. A configuration may be used.
【００１２】次に、誘導制御装置６は、記憶部６Ｍに予
め設定された走行予定コース３０のデータを記憶してい
る。この走行予定コース３０は前記二次元座標上で、二
点間を結ぶセグメントの連続として設定されており、各
セグメント毎に予定走行速度と、次のセグメントに移行
するための予定旋回半径とが定められており、これらが
ストアされている。上記走行予定コース３０は本実施例
の場合、図４に示すように、ホッパと切羽の間を循環す
るコースからなっており、切羽の手前で走路が交差する
ように設定されている。Next, the guidance control device 6 stores data of the preset traveling course 30 in the storage section 6M. The scheduled traveling course 30 is set as a continuation of a segment connecting two points on the two-dimensional coordinates, and an expected traveling speed and an expected turning radius for shifting to the next segment are determined for each segment. And these are stored. In the case of the present embodiment, as shown in FIG. 4, the scheduled traveling course 30 is a course that circulates between the hopper and the face, and is set so that the running paths intersect before the face.
【００１３】即ち、この走行予定コース３０は、ホッパ
から切羽に向かって自己誘導して進む往路３１が、切羽
近傍の積込みエリア３８に沿って進むように切羽乃至切
羽予定地の形状に沿って略平行に設定される切羽進入準
備路３２を有している。この切羽進入準備路３２に無人
自走体１０がくると、積込みエリア３８にいる積込機４
０のオペレータが無線操縦によって、無人自走体１０を
自己誘導制御から遠隔制御に切り換え、積込地点まで図
示しないジョイスティックの操作でリモトコントロール
して走行させ、積込み作業を行なう。In other words, the scheduled traveling course 30 substantially follows the shape of the face or the expected face so that the forward path 31 which proceeds by self-guided from the hopper toward the face advances along the loading area 38 near the face. It has a face entry preparation path 32 set in parallel. When the unmanned self-propelled body 10 comes to the face approach preparation road 32, the loading machine 4 in the loading area 38
The operator 0 switches the self-propelled self-propelled body 10 from self-guidance control to remote control by radio control, performs remote control of the unmanned self-propelled body 10 to a loading point by operating a joystick (not shown), and performs a loading operation.
【００１４】この積込みエリア３８での積込地点は記憶
されると共に、誘導制御装置６の積込みコース学習手段
（図示せず）で、上記切羽進入準備路３２から後進して
積込み地点へ無理なくターンして進入すると共に、積込
み後は切羽進入準備路３２と交差しホッパへ向かう復路
３４に戻る積込みコース３３を自動的に算出して記憶学
習する。また、走行予定コース３０の往路３１には、切
羽進入準備路３２の手前に待機ポイント３５が設定され
ており、また復路３４には指定エリア３６が設けられて
いる。なお、上記待機ポイント３５と指定エリア３６と
は、走行予定コース３０上で無人自走体と衝突する虞れ
のない離反位置に設定されている。The loading point in the loading area 38 is stored, and the loading course learning means (not shown) of the guidance control device 6 moves backward from the face approach preparation road 32 and turns to the loading point without difficulty. Then, after loading, the loading course 33 which intersects the face approach preparation path 32 and returns to the return path 34 toward the hopper is automatically calculated and stored and learned. Further, a standby point 35 is set on the outbound path 31 of the scheduled traveling course 30 before the face approach preparation path 32, and a designated area 36 is provided on the return path 34. The standby point 35 and the designated area 36 are set at separated positions where there is no possibility of collision with the unmanned self-propelled body on the scheduled course 30.
【００１５】次に、また誘導制御装置６は、無人自走体
１０の車速とステアリングを制御するアクチュエータ７
Ａ、７Ｂと制御可能に接続されている。そこで、誘導制
御装置６は、前記位置検出手段１で検出した位置データ
をもとに、走行予定コース３０上で現在追従しているコ
ースとのずれを算出し、該コースに追従するよう上記ア
クチュエータ７Ａ、７Ｂを制御して無人自走体１０のス
テアリング角や速度を制御し、またコーナー部では最適
の旋回半径で曲がってコースに追従するよう誘導制御し
ている。Next, the guidance control device 6 includes an actuator 7 for controlling the vehicle speed and steering of the unmanned self-propelled body 10.
A and 7B are controllably connected. Therefore, the guidance control device 6 calculates a deviation from a course currently following on the planned traveling course 30 based on the position data detected by the position detecting means 1, and sets the actuator so as to follow the course. 7A and 7B are controlled to control the steering angle and speed of the unmanned self-propelled body 10, and guidance control is performed so that the vehicle turns at an optimum turning radius and follows the course at the corner.
【００１６】そして、上記誘導制御装置６と位置検出装
置２との間に衝突防止装置４が設けられている。この衝
突防止装置４は、エリア算出手段４Ａと、衝突防止判定
手段４Ｂと、衝突防止制御手段４Ｃとを有しており、受
信装置３Ｂが接続されて他の無人自走体（説明の便宜上
１０’とする）からの位置データが入力可能となってい
る。A collision prevention device 4 is provided between the guidance control device 6 and the position detection device 2. The collision prevention device 4 includes an area calculation unit 4A, a collision prevention determination unit 4B, and a collision prevention control unit 4C. The reception unit 3B is connected to another unmanned self-propelled body (10 units for convenience of explanation). ') Can be entered.
【００１７】エリア算出手段４Ａでは、図５に示すよう
に、位置検出装置２から得た自己の位置座標データをも
とに、危険度の高い順に（距離の近い順に）緊急停止エ
リアＥ１、通常停止エリアＥ２、第２減速エリアＥ３お
よび第１減速エリアＥ４が算出される。即ち、緊急停止
エリアＥ１は、その範囲内に先行する無人自走体１０’
の位置データが含まれる場合に直ちに制動を行なうエリ
アで、自らの無人自走体１０を中心に、現在走行してい
る車速（所定セグメントにおける設定車速）で制動時に
要する停止までの距離を含む長さを半径とした円形の領
域として算出される。In the area calculating means 4A, as shown in FIG. 5, based on its own position coordinate data obtained from the position detecting device 2, the emergency stop area E1, in the descending order of danger degree (in ascending order of distance), The stop area E2, the second deceleration area E3, and the first deceleration area E4 are calculated. That is, the emergency stop area E1 includes the unmanned self-propelled body 10 ′ preceding the area.
Is an area where braking is performed immediately when the position data is included, including the distance to the stop required at the time of braking at the current vehicle speed (set vehicle speed in a predetermined segment), centering on the own unmanned self-propelled body 10. It is calculated as a circular area with the radius as the radius.
【００１８】通常停止エリアＥ２は、いったん低速に減
速した後に制動を行ない停止する、通常の停止制御を行
なうエリアで、上記緊急停止エリアの外側で、現在走行
している車速から、停止指令が出たときに、停止前の低
速走行に移行し停止するまでの距離を含む長さを半径と
した円形の領域として算出される。図示例では進行方向
に更に余裕分の長さを加えた扇状の部分が通常停止エリ
アに含まれる。The normal stop area E2 is an area for performing a normal stop control in which the vehicle is once decelerated to a low speed and then stopped by performing a braking operation. Outside the emergency stop area, a stop command is issued from the speed of the vehicle currently traveling. Is calculated as a circular area having a radius equal to the length including the distance from the low-speed running before the stop to the stop. In the illustrated example, a fan-shaped portion obtained by adding a margin to the traveling direction is included in the normal stop area.
【００１９】第２減速エリアＥ３は、無人自走体の車速
を後述の第１低速よりも更に減速した第２低速に変更す
るエリアで、無人自走体１０の進行方向に所定の角度で
扇状に広がって形成される。また、第１減速エリアＥ４
は、無人自走体の車速を所定の第１低速に減速するエリ
アで、第２減速エリアＥ３の外側でその相似形の扇状に
形成されている。この第１および第２減速エリアＥ４、
Ｅ３は、無人自走体１０の現在走行している車速をもと
に、扇形の中心角と半径が定められている。このエリア
の形状や種類、数等の設定は上記実施例に限定されず、
無人自走体の作業、運行条件に応じて適宜に最適のエリ
アを設定すればよい。The second deceleration area E3 is an area for changing the vehicle speed of the unmanned self-propelled vehicle to a second low speed that is further decelerated from a first low speed described later. Is formed. Also, the first deceleration area E4
Is an area for reducing the speed of the unmanned self-propelled vehicle to a predetermined first low speed, and is formed in a fan shape similar to the area outside the second deceleration area E3. The first and second deceleration areas E4,
In E3, the central angle and the radius of the sector are determined based on the speed of the unmanned self-propelled body 10 currently traveling. The setting of the shape, type, number, etc. of this area is not limited to the above embodiment,
An optimum area may be appropriately set according to the operation and operating conditions of the unmanned self-propelled body.
【００２０】次ぎに、衝突防止判定手段４Ｂでは、受信
装置３Ｂから得た他方の無人自走体１０の位置座標デー
タが上記各エリアＥ１〜Ｅ４にいずれかに含まれるか、
あるいは含まれないかを判定する。そして、いずれのエ
リアにも含まれない場合には、そのまま誘導制御装置６
による通常の制御が行なわれる。Next, the collision prevention determining means 4B determines whether the position coordinate data of the other unmanned self-propelled vehicle 10 obtained from the receiving device 3B is included in any of the areas E1 to E4.
Alternatively, it is determined whether or not it is included. If it is not included in any area, the guidance control device 6
Is performed.
【００２１】受信された先行する無人自走体１０’の位
置データが第１減速エリアＥ４に含まれる場合には、衝
突防止制御手段４Ｃで、無人自走体１０の車速が所定の
第１低速に減速するように、誘導制御装置６を介して車
速制御用のアクチュエータ７Ａを制御する。When the received position data of the preceding unmanned self-propelled vehicle 10 'is included in the first deceleration area E4, the collision prevention control means 4C controls the vehicle speed of the unmanned self-propelled vehicle 10 to a predetermined first low speed. The vehicle speed control actuator 7A is controlled via the guidance control device 6 so as to reduce the speed.
【００２２】位置データが第２減速エリアＥ３に含まれ
る場合には、衝突防止制御手段４Ｃは同様に第２低速に
減速するようにアクチュエータ７Ａを制御する。無人自
走体１０’の位置が通常停止エリアＥ２に含まれる場合
には、衝突防止制御手段４Ｃは停止用減速を行なってか
ら制動が行なわれるようにアクチュエータ７Ａを制御す
る。更に、無人自走体１０’の位置が緊急停止エリアＥ
１に含まれる場合には、直ちに制動が行なわれ無人自走
体が停止して追突を確実に防止することができる。When the position data is included in the second deceleration area E3, the collision prevention control means 4C similarly controls the actuator 7A to decelerate to the second low speed. When the position of the unmanned self-propelled body 10 'is included in the normal stop area E2, the collision prevention control means 4C controls the actuator 7A so that braking is performed after deceleration for stopping. Furthermore, the position of the unmanned self-propelled body 10 'is the emergency stop area E.
In the case where it is included in 1, the braking is performed immediately, the unmanned self-propelled body stops, and the rear-end collision can be reliably prevented.
【００２３】次ぎに、上記構成にフリート制御装置６を
加えた異なる実施例について説明する。即ち、この衝突
防止運行装置１は、図６に示すように、前記誘導制御装
置６と位置検出装置２との間に衝突防止装置４と共にフ
リート制御装置５が設けられている。Next, another embodiment in which the fleet control device 6 is added to the above configuration will be described. That is, as shown in FIG. 6, the anti-collision operation device 1 includes a fleet control device 5 together with the anti-collision device 4 between the guidance control device 6 and the position detection device 2.
【００２４】このフリート制御装置５は、待機制御手段
５Ａと発進制御手段５Ｂを有しており、位置検出装置２
から自己の位置データを入力し、受信装置３Ｂからは他
の先行する無人自走体１０’からの位置データが入力可
能となっている。The fleet control device 5 has a standby control means 5A and a start control means 5B.
, And the position data from another preceding unmanned self-propelled body 10 'can be input from the receiving device 3B.
【００２５】待機制御手段５Ａでは、受信装置３Ｂから
得た先行する他方の無人自走体１０’の位置座標データ
が、前記記憶されている走行予定コース３０上の積込み
エリア３８の領域内に含まれるか否か判定する。従っ
て、この積込みエリア３８内に、上記受信した先行する
無人自走体１０’の位置データが含まれている場合に
は、待機制御手段５Ａは、前記誘導制御装置６を介して
当該無人自走体１０を走行予定コース３０上の待機ポイ
ント３５で停止するように誘導制御する。In the standby control means 5A, the position coordinate data of the preceding unmanned self-propelled vehicle 10 'obtained from the receiving device 3B is included in the stored area 38 of the loading area 38 on the planned course 30. Is determined. Therefore, if the received position data of the preceding unmanned self-propelled vehicle 10 ′ is included in the loading area 38, the standby control unit 5 A transmits the unmanned self-propelled vehicle via the guidance control device 6. Guidance control is performed so that the body 10 stops at the standby point 35 on the scheduled course 30.
【００２６】次に、フリート制御装置５の発進制御手段
５Ｂで、上記先行する無人自走体１０’の発信装置３Ａ
から送られた位置座標が、走行予定コース３０上の指定
エリア３６の範囲内に入ったか否かを判定する。本実施
例では、先行する無人自走体１０’は積込機４０のオペ
レータが遠隔制御装置の再起動ボタンを押すことによ
り、コースに向かって走行する。このとき、待機ポイン
ト３５で待機中の無人自走体１０は、上記先行する無人
自走体１０’の位置データを入力し、モニターしてい
る。そこで、上記先行する無人自走体１０’が指定エリ
ア３６に入ったと判定した場合に、待機ポイント３５で
停止中の無人自走体１０を発進させる。Next, the starting control means 5B of the fleet control device 5 controls the transmitting device 3A of the preceding unmanned self-propelled body 10 '.
Then, it is determined whether or not the position coordinates sent from within the designated area 36 on the scheduled traveling course 30. In the present embodiment, the preceding unmanned self-propelled body 10 'runs toward the course when the operator of the loader 40 presses the restart button of the remote control device. At this time, the unmanned self-propelled body 10 waiting at the waiting point 35 inputs and monitors the position data of the preceding unmanned self-propelled body 10 ′. Therefore, when it is determined that the preceding unmanned self-propelled body 10 ′ has entered the designated area 36, the unmanned self-propelled body 10 stopped at the standby point 35 is started.
【００２７】あるいは、発信制御手段５Ｂを、積込みエ
リア３８にいずれの無人自走体もいないか否かを判定
し、該積込みエリア３８から出た場合に待機ポイント３
５で停止中の無人自走体１０を発進させる構成としても
よい。この場合は、受信装置３で受信した位置データの
全てが、積込みエリア３８内にないか否かを判定しても
よく、特定の固有コードの位置データをもとに判定しな
くてもよい。Alternatively, the transmission control means 5B determines whether or not there is any unmanned self-propelled body in the loading area 38, and when the vehicle exits the loading area 38, the standby point 3
The configuration may be such that the stopped unmanned self-propelled body 10 is started at 5. In this case, it may be determined whether or not all the position data received by the receiving device 3 is within the loading area 38, and it is not necessary to determine based on the position data of a specific unique code.
【００２８】次に、衝突防止装置４と、フリート制御装
置５の関係について説明する。無人自走体１０が、走行
予定コース３０のスタート地点から走行を開始する。該
無人自走体１０は、センサＳ１及びＳ２により相対位置
検出手段２Ａでリアルタイムに無人自走体１０の位置座
標を算出する。また、待機ポイント３５や指定エリア３
８の進入側近傍等の所定位置には反射装置を備えたポー
ルが立設されており、センサＳ３により絶対位置検出手
段２Ｂで、その位置での無人自走体１０の位置座標を算
出する。Next, the relationship between the collision prevention device 4 and the fleet control device 5 will be described. The unmanned self-propelled body 10 starts traveling from the start point of the scheduled traveling course 30. The unmanned self-propelled body 10 calculates the position coordinates of the unmanned self-propelled body 10 in real time by the relative position detecting means 2A using the sensors S1 and S2. In addition, the waiting point 35 and the designated area 3
A pole provided with a reflection device is erected at a predetermined position such as near the approach side of 8, and the absolute position detecting means 2B calculates the position coordinates of the unmanned self-propelled body 10 at that position by the sensor S3.
【００２９】そして、起算位置更新手段２Ｃで、相対位
置検出手段２Ａで得られた位置座標を絶対位置検出手段
２Ｂで得られた位置座標で修正し、その修正された位置
座標を新たな起算点として相対位置検出手段２Ａで位置
座標の算出が行なわれ、位置データとして出力される。Then, the starting position updating unit 2C corrects the position coordinates obtained by the relative position detecting unit 2A with the position coordinates obtained by the absolute position detecting unit 2B, and replaces the corrected position coordinates with a new starting point. The position coordinates are calculated by the relative position detecting means 2A and output as position data.
【００３０】このようにして進行する無人自走体１０
は、自己の位置データと車速を基準として、緊急停止エ
リアＥ１、通常停止エリアＥ２、第２減速エリアＥ３お
よび第１減速エリアＥ４が算出される。一方、無人自走
体１０は、受信装置３Ｂで、先行する無人自走体１０’
の固有コードと共に入力される位置データを受信しモニ
ターする。この場合、衝突防止装置４にはモニターする
固有モードを登録しておき、受信装置３Ｂから受信され
た信号のうち、上記固有コードを有する位置データだけ
を衝突防止装置４に入力する。The unmanned self-propelled body 10 progressing in this manner
Calculates the emergency stop area E1, the normal stop area E2, the second deceleration area E3, and the first deceleration area E4 based on the own position data and the vehicle speed. On the other hand, the unmanned self-propelled body 10 receives the preceding unmanned self-propelled body 10 ′ by the receiving device 3B.
Receives and monitors the position data entered with the unique code of. In this case, a unique mode to be monitored is registered in the collision prevention device 4, and only the position data having the above-described unique code among the signals received from the reception device 3B is input to the collision prevention device 4.
【００３１】そして、入力した先行する他の無人自走体
１０’の位置データが上記エリアに含まれるか否か、ま
た含まれる場合にはいずれに含まれるかを判定する。自
らの無人自走体１０が待機ポイント８に向かう場合で、
待機ポイント３５より所定前方位置においては上記衝突
防止装置４による作動より、フリート制御装置５による
作動を優先させる。あるいはフリート制御装置５が作動
している間、衝突防止装置４の作動を中断してもよい。Then, it is determined whether or not the input position data of the preceding unmanned self-propelled vehicle 10 'is included in the area, and if so, which is included. When the unmanned self-propelled body 10 goes to the waiting point 8,
At a predetermined position ahead of the standby point 35, the operation by the fleet control device 5 is prioritized over the operation by the collision prevention device 4. Alternatively, the operation of the collision prevention device 4 may be interrupted while the fleet control device 5 is operating.
【００３２】そして、走行予定コース上に待機ポイント
３５の手前に判定ポイントを予め設けておき、その位置
で、無人自走体１０は、受信した他の無人自走体１０’
の位置データが、自らの前方で積込みエリア３８に至る
コース上および積込みエリア３８内に含まれるか否かの
判定を行なう。そしてその範囲内の場合には、待機ポイ
ント３５で当該無人自走体１０が停止するよう誘導制御
し、範囲内にない場合には、そのままコースに沿って進
行する。A judgment point is provided before the standby point 35 on the scheduled course, and the unmanned self-propelled body 10 receives the other unmanned self-propelled body 10 'at that position.
It is determined whether or not the position data is included in the loading area 38 on the course leading to the loading area 38 in front of itself. If it is within the range, guidance control is performed so that the unmanned self-propelled body 10 stops at the standby point 35, and if it is not within the range, the vehicle proceeds along the course as it is.
【００３３】待機ポイント３５上で待機している場合に
は、先行する他の無人自走体１０’から発信される位置
データをモニターし、該無人自走体１０’が指定エリア
３６に入りったことが判定できた場合に、待機ポイント
３５で停止している無人自走体１０を発進させる。この
ようにして、フリート制御装置５による制御が終了する
と、再度、前記衝突防止装置４により、先行する他の無
人自走体１０’との間隔を検出して追突を防止するよう
になっている。またこの無人自走体１０に後続する無人
自走体１０”も同様に当該無人自走体１０の固有コード
と共に発信される位置データをモニターして同様の処理
が行なわれる。When waiting on the waiting point 35, the position data transmitted from the preceding unmanned self-propelled vehicle 10 'is monitored, and the unmanned self-propelled vehicle 10' enters the designated area 36. If it is determined that the self-propelled vehicle 10 has stopped at the standby point 35, the unmanned self-propelled body 10 is started. When the control by the fleet control device 5 is completed in this way, the collision prevention device 4 detects the interval with the preceding unmanned self-propelled vehicle 10 'again to prevent a rear-end collision. . Similarly, the unmanned self-propelled body 10 ″ following the unmanned self-propelled body 10 monitors the position data transmitted together with the unique code of the unmanned self-propelled body 10, and performs the same processing.
【００３４】[0034]
【発明の効果】以上のように、この発明の無人自走体の
衝突防止運行方法及びその装置では、複数の無人自走体
が走行予定コース上を走行している場合に、自己誘導制
御のために検出される位置データを無人自走体間で通信
することにより、両者の間隔を算出し、衝突の危険度を
判定して追突を防止することができる。また、走行予定
コースに交差するコースが含まれている場合等は、フリ
ート制御を併用することにより、位置データだけでの判
定による欠点を補い、確実に無人自走体間の衝突を防止
することができ、安全性と共に運行効率を高めることが
できる。As described above, according to the unmanned self-propelled vehicle collision prevention operation method and apparatus of the present invention, when a plurality of unmanned self-propelled vehicles are traveling on the scheduled course, the self-guidance control is performed. Therefore, by communicating the detected position data between the unmanned self-propelled bodies, the distance between the two can be calculated, the risk of collision can be determined, and the rear-end collision can be prevented. Also, when a course that intersects with the planned course is included, fleet control is also used to compensate for the shortcomings caused by the determination using only position data, and to reliably prevent collision between unmanned self-propelled bodies. It is possible to improve operation efficiency as well as safety.
【図１】この発明の無人自走体の衝突防止運行装置にか
かる機能ブロック図である。FIG. 1 is a functional block diagram of an unmanned self-propelled vehicle collision prevention operation device according to the present invention.
【図２】フリート制御装置を組み合わせたこの発明の無
人自走体の衝突防止運行装置にかかる機能ブロック図で
ある。FIG. 2 is a functional block diagram of an unmanned self-propelled vehicle collision prevention operation device of the present invention in which a fleet control device is combined.
【図３】衝突防止運行装置の第１実施例を示すブロック
図である。FIG. 3 is a block diagram showing a first embodiment of the collision prevention operation device.
【図４】走行予定コースの一例を示す説明図である。FIG. 4 is an explanatory diagram showing an example of a scheduled traveling course.
【図５】衝突防止のための各エリアを示す説明図であ
る。FIG. 5 is an explanatory diagram showing each area for preventing collision.
【図６】衝突防止運行装置の第２実施例を示すブロック
図である。FIG. 6 is a block diagram showing a second embodiment of the collision prevention operation device.
１ 位置検出装置 ２ 送信装置 ３ 受信装置 ４ 衝突防止装置 ４Ａ エリア算出手段 ４Ｂ 衝突防止判定手段 ４Ｃ 衝突防止制御手段 ５ フリート制御装置 ５Ａ 待機制御手段 ５Ｂ 発進制御手段 ６ 誘導制御装置 １０ 無人自走体 ３０ 走行予定コース ３５ 待機ポイント ３６ 指定エリア Ｅ１ 緊急停止エリア Ｅ２ 通常停止エリア Ｅ３ 第２減速エリア Ｅ４ 第１減速エリア REFERENCE SIGNS LIST 1 position detection device 2 transmission device 3 reception device 4 collision prevention device 4A area calculation means 4B collision prevention determination means 4C collision prevention control means 5 fleet control device 5A standby control means 5B start control means 6 guidance control device 10 unmanned self-propelled body 30 Scheduled course 35 Standby point 36 Designated area E1 Emergency stop area E2 Normal stop area E3 Second deceleration area E4 First deceleration area
フロントページの続き (72)発明者 広瀬 晋也 東京都港区北青山一丁目２番３号 新キ ャタピラー三菱株式会社内 (72)発明者 広池 昌弘 東京都港区北青山一丁目２番３号 新キ ャタピラー三菱株式会社内 (72)発明者 宮本 勝志 東京都千代田区丸の内二丁目３番２号 日鉄鉱業株式会社内 (56)参考文献 特開 昭63−148312（ＪＰ，Ａ) 特開 昭63−150710（ＪＰ，Ａ) 特開 昭59−8014（ＪＰ，Ａ)Continued on the front page (72) Inventor Shinya Hirose 1-3-2 Kitaaoyama, Minato-ku, Tokyo New Caterpillar Mitsubishi Corporation (72) Inventor Masahiro Hiroike 1-2-3 Kitaaoyama, Minato-ku, Tokyo New Catapilla Inside Mitsubishi Co., Ltd. (72) Inventor Katsushi Miyamoto 2-3-2 Marunouchi, Chiyoda-ku, Tokyo Nippon Steel Mining Co., Ltd. (56) References JP-A-63-148312 (JP, A) JP-A-63-150710 (JP, A) JP-A-59-8014 (JP, A)
Claims (6)
走行する複数の無人自走体が、それぞれ位置検出装置に
より自己の位置を検出し、該検出された位置データを基
に誘導制御装置により走行予定コースに沿って各無人自
走体を自己誘導する無人自走体の衝突防止運行方法であ
って、 各無人自走体が自己の位置を発信すると共に、他の無人
自走体の位置を受信可能としており、 位置検出装置から得られた無人自走体の自己の位置デー
タをもとに、該位置データを中心にその外側に所定範囲
の停止エリアを算出し、更にその外側で進行方向に向か
って広がる減速エリアを算出し、 上記受信装置から入力された他の無人自走体の位置デー
タが上記エリアに含まれるか否かを判定し、 上記位置データが停止エリアに含まれる場合に無人自走
体を停止させ、減速エリアに含まれる場合に無人自走体
の車速を所定速度に減速させるように走行を制御してな
ることを特徴とする無人自走体の衝突防止運行方法。1. A plurality of unmanned self-propelled bodies simultaneously traveling on a predetermined course to be traveled, each of which detects its own position by a position detection device, and travels by a guidance control device based on the detected position data. This is an unmanned self-propelled vehicle collision prevention operation method in which each unmanned self-propelled vehicle is self-guided along a scheduled course, and each unmanned self-propelled vehicle transmits its own position and determines the position of other unmanned self-propelled vehicles. It is possible to receive, based on the position data of the unmanned self-propelled body obtained from the position detection device, based on the position data, calculates a stop area of a predetermined range outside the center, and further, the traveling direction outside the stop area Calculate the deceleration area that spreads toward, and determine whether or not the position data of the other unmanned self-propelled vehicle input from the receiving device is included in the area.If the position data is included in the stop area, Unmanned self-propelled body Sealed so, collision prevention operation method of an unmanned self-propelled body, characterized in that the vehicle speed of the unmanned self-propelled body formed by controlling the traveling so as to decelerate to a predetermined speed when included in the deceleration area.
走行する複数の無人自走体が、それぞれ位置検出装置に
より自己の位置を検出し、該検出された位置データを基
に誘導制御装置により走行予定コースに沿って各無人自
走体を自己誘導する無人自走体の衝突防止運行方法であ
って、 各無人自走体が自己の位置を発信すると共に、他の無人
自走体の位置を受信可能としており、 位置検出装置から得られた無人自走体の自己の位置デー
タをもとに、該位置データを中心にその外側に所定範囲
の停止エリアを算出し、更にその外側で進行方向に向か
って広がる減速エリアを算出し、 上記受信装置から入力された他の無人自走体の位置デー
タが上記エリアに含まれるか否かを判定し、 上記位置データが停止エリアに含まれる場合に無人自走
体を停止させ、減速エリアに含まれる場合に無人自走体
の車速を所定速度に減速させるように走行を制御すると
共に、 当該無人自走体が走行予定コース上を待機ポイントに向
かう際に、他の無人自走体から送信された上記位置デー
タが監視エリア内に含まれる場合に、自己の無人自走体
を上記待機ポイントに停止させ、 該待機ポイント上で、他の無人自走体の受信した位置デ
ータが予め設定した指定エリアに入ったか否か、または
指定エリアから出たか否かを判定し、該指定エリアに入
った場合、または指定エリアから出た場合に無人自走体
を発進させることを特徴とする無人自走体の衝突防止運
行方法。2. A plurality of unmanned self-propelled bodies traveling simultaneously on a predetermined course to be traveled, each of which detects its own position by a position detection device, and travels by a guidance control device based on the detected position data. This is an unmanned self-propelled vehicle collision prevention operation method in which each unmanned self-propelled vehicle is self-guided along a scheduled course, and each unmanned self-propelled vehicle transmits its own position and determines the position of other unmanned self-propelled vehicles. It is possible to receive, based on the position data of the unmanned self-propelled body obtained from the position detection device, based on the position data, calculates a stop area of a predetermined range outside the center, and further, the traveling direction outside the stop area Calculate the deceleration area that spreads toward, and determine whether or not the position data of the other unmanned self-propelled vehicle input from the receiving device is included in the area.If the position data is included in the stop area, Unmanned self-propelled body When the vehicle is in the deceleration area, the traveling is controlled so that the vehicle speed of the unmanned self-propelled body is reduced to a predetermined speed. When the position data transmitted from the unmanned self-propelled vehicle is included in the monitoring area, the own unmanned self-propelled vehicle is stopped at the standby point, and the other unmanned self-propelled vehicle receives the data on the standby point. To determine whether the position data has entered or exited a designated area set in advance, and to start the unmanned self-propelled vehicle when entering or leaving the designated area. An operation method for preventing unmanned self-propelled vehicles from colliding.
速エリアの内側に第２減速エリアが形成されてなり、停
止エリアが内側に緊急停止エリアが形成されその外側に
通常停止エリアが形成されてなることを特徴とする請求
項１または２に記載のいずれかの無人自走体の衝突防止
運行方法。3. The deceleration area of the area calculation means is such that a second deceleration area is formed inside the first deceleration area, an emergency stop area is formed inside the stop area, and a normal stop area is formed outside the stop area. 3. The operation method for preventing collision of an unmanned self-propelled vehicle according to claim 1, wherein
走行する複数の無人自走体がそれぞれ、自己の無人自走
体の位置を検出する位置検出装置と、該位置検出装置か
ら得られた位置データを基に走行予定コースに沿って自
己誘導する誘導制御装置とを有する無人自走体の衝突防
止運行装置において、 各無人自走体に、上記検出された自己の位置データを送
信する送信装置と、 他の無人自走体が送信した他の位置データを受信する受
信装置とを備え、 位置検出装置から得られた自己の位置データをもとに、
該位置データを中心にその外側に所定範囲の停止エリア
を算出し、更にその外側で進行方向に向かって広がる減
速エリアを算出するエリア算出手段と、 上記受信装置から入力された他の無人自走体の位置デー
タが上記エリアに含まれるか否かを判定する衝突防止判
定手段と、 上記位置データが停止エリアに含まれる場合に無人自走
体を停止させ、減速エリアに含まれる場合に無人自走体
の車速を所定速度に減速させる衝突防止制御手段とを有
する衝突防止装置を設けてなることを特徴とする無人自
走体の衝突防止運行装置。4. A plurality of unmanned self-propelled bodies traveling simultaneously on a predetermined scheduled course, each of which detects a position of its own unmanned self-propelled body, and a position obtained from the position detection apparatus. A collision control device for an unmanned self-propelled vehicle having a guidance control device for self-guiding along a scheduled course based on data, wherein the transmitting device transmits the detected self-position data to each unmanned self-propelled vehicle. And a receiving device for receiving other position data transmitted by another unmanned self-propelled vehicle. Based on own position data obtained from the position detecting device,
Area calculation means for calculating a predetermined range of stop area outside the center of the position data and further calculating a deceleration area extending toward the traveling direction outside the area, and other unmanned self-propelled vehicle input from the receiving device. Collision prevention determining means for determining whether or not the position data of the body is included in the area; stopping the unmanned self-propelled body when the position data is included in the stop area; An anti-collision operation device for an unmanned self-propelled vehicle, comprising: an anti-collision device having anti-collision control means for reducing the vehicle speed of the running body to a predetermined speed.
走行する複数の無人自走体がそれぞれ、自己の無人自走
体の位置を検出する位置検出装置と、該位置検出装置か
ら得られた位置データを基に走行予定コースに沿って自
己誘導する誘導制御装置とを有する無人自走体の衝突防
止運行装置において、 各無人自走体に、上記検出された自己の位置データを送
信する送信装置と、 他の無人自走体が送信した他の位置データを受信する受
信装置とを備え、 位置検出装置から得られた自己の位置データをもとに、
該位置データを中心にその外側に所定範囲の停止エリア
を算出し、更にその外側で進行方向に向かって広がる減
速エリアを算出するエリア算出手段と、 上記受信装置から入力された他の無人自走体の位置デー
タが上記エリアに含まれるか否かを判定する衝突防止判
定手段と、 上記位置データが停止エリアに含まれる場合に無人自走
体を停止させ、減速エリアに含まれる場合に無人自走体
の車速を所定速度に減速させる衝突防止制御手段とを有
する衝突防止装置と、 受信した他の無人自走体の位置が監視エリア内にあると
き、自己の位置データをもとに自己の無人自走体を待機
ポイントに停止させる待機制御手段と、 該待機ポイント上で、他の所定の無人自走体から受信し
た他の位置データが予め設定した指定エリアに入ったか
否か、または指定エリアから出たか否かを判定し、該指
定エリアに入った場合、または該指定エリアから出た場
合に無人自走体を発進させ、走行予定コースに沿った走
行制御を行なう発進制御手段を有するフリート制御装置
とを設けてなることを特徴とする無人自走体の衝突防止
運行装置。5. A plurality of unmanned self-propelled bodies traveling simultaneously on a predetermined scheduled course, each of which detects a position of its own unmanned self-propelled body, and a position obtained from the position detection apparatus. A collision control device for an unmanned self-propelled vehicle having a guidance control device for self-guiding along a scheduled course based on data, wherein the transmitting device transmits the detected self-position data to each unmanned self-propelled vehicle. And a receiving device for receiving other position data transmitted by another unmanned self-propelled vehicle. Based on own position data obtained from the position detecting device,
Area calculation means for calculating a predetermined range of stop area outside the center of the position data and further calculating a deceleration area extending toward the traveling direction outside the area, and other unmanned self-propelled vehicle input from the receiving device. Collision prevention determining means for determining whether or not the position data of the body is included in the area; stopping the unmanned self-propelled body when the position data is included in the stop area; A collision prevention device having collision prevention control means for decelerating the vehicle speed of the running body to a predetermined speed; and when the position of the other received unmanned self-propelled body is within the monitoring area, its own Standby control means for stopping the unmanned self-propelled body at the standby point, and whether or not other position data received from another predetermined unmanned self-propelled body has entered a preset designated area on the standby point; or Start control means for judging whether or not the vehicle has left the designated area, starting the unmanned self-propelled body when entering the designated area, or when exiting from the designated area, and controlling travel along the scheduled course. And a fleet control device having the same.
速エリアの内側に第２減速エリアが形成されてなり、停
止エリアが内側に緊急停止エリアが形成されその外側に
通常停止エリアが形成されてなることを特徴とする請求
項４または５に記載のいずれかの無人自走体の衝突防止
運行装置。6. The deceleration area of the area calculation means is such that a second deceleration area is formed inside the first deceleration area, an emergency stop area is formed inside the stop area, and a normal stop area is formed outside the stop area. The collision prevention operation device for an unmanned self-propelled body according to any one of claims 4 and 5, wherein
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP3290595A JP2715201B2 (en) | 1991-10-09 | 1991-10-09 | Operation method and device for preventing collision of unmanned self-propelled body |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP3290595A JP2715201B2 (en) | 1991-10-09 | 1991-10-09 | Operation method and device for preventing collision of unmanned self-propelled body |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH05127747A JPH05127747A (en) | 1993-05-25 |
| JP2715201B2 true JP2715201B2 (en) | 1998-02-18 |
Family
ID=17758045
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP3290595A Expired - Fee Related JP2715201B2 (en) | 1991-10-09 | 1991-10-09 | Operation method and device for preventing collision of unmanned self-propelled body |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2715201B2 (en) |
Families Citing this family (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE4414192C2 (en) * | 1994-04-22 | 1996-06-13 | Siemens Ag | Method for determining a security zone around a mobile mobile unit |
| JP4089154B2 (en) * | 2000-12-07 | 2008-05-28 | 株式会社ダイフク | Travel control method for moving body |
| EP1728738B1 (en) * | 2005-05-31 | 2008-09-17 | Daifuku Co., Ltd. | Article transport facility and a method of operating the facility |
| JP4978494B2 (en) | 2008-02-07 | 2012-07-18 | トヨタ自動車株式会社 | Autonomous mobile body and control method thereof |
| WO2011064821A1 (en) | 2009-11-27 | 2011-06-03 | トヨタ自動車株式会社 | Autonomous moving object and control method |
| CN107407936A (en) * | 2015-03-17 | 2017-11-28 | 亚马逊技术股份有限公司 | To promote the system and method that man/machine interacts |
| JP6391536B2 (en) | 2015-06-12 | 2018-09-19 | 日立建機株式会社 | In-vehicle device, vehicle collision prevention method |
| JP6425622B2 (en) | 2015-06-12 | 2018-11-21 | 日立建機株式会社 | In-vehicle device, vehicle collision prevention method |
| JP6816379B2 (en) * | 2016-04-14 | 2021-01-20 | 富士ゼロックス株式会社 | Collision avoidance system, information processing device, collision avoidance program and information processing program |
| JP6796041B2 (en) | 2017-09-07 | 2020-12-02 | 日立建機株式会社 | Safe driving support device |
| JP7396210B2 (en) * | 2020-06-08 | 2023-12-12 | 井関農機株式会社 | Work vehicle control system |
-
1991
- 1991-10-09 JP JP3290595A patent/JP2715201B2/en not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JPH05127747A (en) | 1993-05-25 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US6313758B1 (en) | Automatic following travel system | |
| US6285929B1 (en) | Processional travel control apparatus | |
| EP3423326B1 (en) | A vehicle with autonomous driving capability | |
| JP2715202B2 (en) | Wireless monitoring communication method and apparatus for unmanned self-propelled body | |
| JP3743582B2 (en) | Fleet control device and control method for unmanned vehicle and manned vehicle mixed running | |
| US6246932B1 (en) | Vehicle monitor for controlling movements of a plurality of vehicles | |
| US6393362B1 (en) | Dynamic safety envelope for autonomous-vehicle collision avoidance system | |
| EP3782000B1 (en) | A method for controlling a string of vehicles | |
| JP2000330637A (en) | Method for detecting obstacle of vehicle | |
| AU700017B2 (en) | Method and apparatus for interlocking entrance of unmanned dump truck into working area | |
| JP2715201B2 (en) | Operation method and device for preventing collision of unmanned self-propelled body | |
| JP7032568B2 (en) | Vehicle driving control method and vehicle driving control device | |
| JP2689113B2 (en) | Obstacle monitoring system for unmanned self-propelled vehicles | |
| JP2001043498A (en) | Traveling device in single file | |
| KR20230042636A (en) | Automated valet parking system, control method for automated valet parking system, and autonomous driving vehicle | |
| JP2866234B2 (en) | Travel control method and device for unmanned self-propelled body | |
| JP7206103B2 (en) | VEHICLE DRIVING CONTROL METHOD AND VEHICLE DRIVING CONTROL DEVICE | |
| JP3206314B2 (en) | Autonomous driving method for automatic guided vehicles | |
| JP2019026066A (en) | Track transportation system, and operation method of track transportation system | |
| JPS62274407A (en) | Running control equipment for moving car | |
| JPS62189511A (en) | Travel control equipment for moving vehicle | |
| JPH0782389B2 (en) | Rear-end collision prevention device for mobile vehicles | |
| WO2024018738A1 (en) | Mobile device management control system and mobile device management control method | |
| EP4183656A1 (en) | A method for planning a driving trajectory defining a travelling path for a vehicle | |
| JP2000348289A (en) | Unit for operation control by inter-vehicle communication |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 19970909 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| LAPS | Cancellation because of no payment of annual fees |