JP3869108B2

JP3869108B2 - 無人車両の干渉予測装置および無人車両の誘導走行方法

Info

Publication number: JP3869108B2
Application number: JP04058698A
Authority: JP
Inventors: 雅人影山; 幸男大川; 和憲黒本
Original assignee: Komatsu Ltd
Current assignee: Komatsu Ltd
Priority date: 1998-02-23
Filing date: 1998-02-23
Publication date: 2007-01-17
Anticipated expiration: 2018-02-23
Also published as: US6253128B1; JPH11237916A

Description

【０００１】
【発明の属する技術分野】
本発明は、無人移動体の干渉予測装置および誘導走行方法に関するものである。
【０００２】
【従来の技術】
鉱山においては、苦渋労働からの解放、生産コストの引き下げ、燃費の低減などを図るため、無人オフロードダンプトラック（以下、無人ダンプと略称する）が広く実用化されつつある。
【０００３】
上記無人ダンプは、推測航法やＧＰＳなどを用いてその走行位置を計測する位置計測装置と、コースデータを記憶する記憶装置と、上記走行位置およびコースデータに基づいて無人ダンプの走行を制御する制御装置とを搭載して走行の自動化を図ったものである。
【０００４】
コースデータを生成する手法としては、例えば、無人ダンプを実際に走行させて、その走行位置を記録するティーチング方式が広く利用されている。
【０００５】
上記コースデータは、実際に無人ダンプを走行させながら時々刻々の該ダンプの位置を記録するティーチング方式によって形成するのが一般的である。
【０００６】
上記ティーチング方式によって作成されたコースデータは、実際の車両が走行した状態を示している。したがって、その内容には、その場のコースの状態に応じ車両が実際に走行可能な走行速度、加減速度、横加速度を満足した位置データが含まれている。さらには、進行方向のカーブを予想した適切な減速や、上り坂を予想した加速など、自動的な計算では求めることの困難な要素も加味されている。加えて、単に車両を走行させるだけで良いため、オペレータの理解の容易さもある。
【０００７】
このような理由から、ティーチング方式によってコースデータを作成する手法は広く使われている。
【０００８】
一方、コースの複雑さに応じて、コンピュータ上でコースを作成するオフライン方式と、ティーチング方式とを組み合わせた技術も提案されている（特開平８−１０１７１２号）。
【０００９】
これは、直線部分などの単純な部分はオフラインでティーチングし、干渉の可能性の高い複雑な部分は実写でティーチングするものである。
【００１０】
【発明が解決しようとする課題】
上記ティーチングによって作成されたコースデータは、実際に無人ダンプが走行できた経路を示している。
【００１１】
しかしながら、実際に走行す車両は、位置計測の誤差と、その計測された位置を用いて車両を制御するときの誤差により、必ずしもティーチングされたコースと同一のコースを走行しない。
【００１２】
このため、ティーチングのために走行したときには、コースエリア内を走行していたものが、実際の走行を繰り返す内にコースエリア外を走行して、事故につながる虞れがある。
【００１３】
そこで、ティーチングするとき、オペレータは上記誤差を見込んで車両を走行させるが、万全とは言えなかった。更に、対向車とすれ違う場合や走行エリアが狭い場合などに、走行時の誤差を見込んでコースエリア外や対向車との干渉を避け得るティーチングを行うのは困難な作業であった。
【００１４】
本発明の課題は、かかる状況に鑑み、ティーチング等によって作成されたコースデータによって無人車両を走行させた場合の該車両の干渉を予測することができる無人車両の干渉予測装置を提供することにある。
【００１５】
【課題を解決するための手段および作用・効果】
第１の発明は、計測された走行位置と教示された各走行位置からなるコースデータとに基づいてコースエリア内で無人車両を誘導走行させる場合に適用され、
前記コースエリアの形状を入力する入力手段と、
無人車両を走行させることによってコースデータを教示するコースデータ教示手段と、
教示されたコースデータに従って無人車両が走行したときの走行位置の誤差を推定する誤差推定手段と、
前記推定された誤差、前記コースデータおよび前記無人車両の車幅に基づいて前記無人車両の存在範囲を推定し、この存在範囲内に前記コースエリアの縁が存在することを判定することで、前記無人車両と前記コースエリア外との干渉を予測する干渉予測手段と、
干渉が予測された場合には、コースデータの再構成処理を実行する処理手段と、
干渉を生じないと予測された場合には、教示されたコースデータを用いて、あるいは、干渉が予測された場合には、再構成されたコースデータを用いて、無人車両を誘導走行させる手段と
を備えることを特徴とする。
【００１６】
この第１の発明によれば、コースデータに従って無人車両が走行したときの走行位置の誤差を推定し、この誤差に基づいて、前記無人車両と前記コースエリア外との干渉を予測する。
また、無人車両の存在範囲を推定し、この存在範囲を基準にして干渉の判断がなされる。
【００１７】
したがって、作成されたコースデータに従って実際に無人車両を走行させる前に、無人車両とコースエリア外との干渉を予測することができ、これによって、無人車両の実際の干渉を回避する処置、例えば、コースデータの変更や再ティーチングなどの処置を講ずることが可能になる。
【００１８】
第２の発明は、計測された走行位置と教示された各走行位置からなるコースデータとに基づいてコースエリア内の異なる車線で無人車両をそれぞれ誘導走行させる場合に適用され、
前記コースエリアの形状を入力する入力手段と、
無人車両を走行させることによってコースデータを教示するコースデータ教示手段と、
教示された自車両のコースデータに従って該自車両が走行したときの走行位置の誤差を推定するとともに、教示された他車両のコースデータに従って該他車両が走行したときの走行位置の誤差を推定する誤差推定手段と、
前記推定された各誤差、前記自車両および他車両のコースデータおよび前記自車両および他車両の車幅に基づいて、前記自車両および他車両の存在範囲をそれぞれ推定し、自車両の存在範囲内に前記コースエリアの縁が存在することを判定し、かつ前記各存在範囲相互の干渉を判定することで、前記自車両と前記コースエリア外との干渉および前記自車両と他車両との干渉を予測する干渉予測手段と、
干渉が予測された場合には、コースデータの再構成処理を実行する処理手段と、
干渉を生じないと予測された場合には、教示されたコースデータを用いて、あるいは、干渉が予測された場合には、再構成されたコースデータを用いて、無人車両を誘導走行させる手段と
を備えることを特徴とする。
【００１９】
この第２の発明によれば、コースエリア内で複数の無人車両が同時に走行する場合に、自車両と前記コースエリア外との干渉だけでなく該自車両と他車両との干渉をも予測可能である。
また、自車両と他車両の存在範囲がそれぞれ推定され、自車両の存在範囲に基づいてコースエリアの縁と自車両との干渉が予測されるとともに、上記各存在範囲に基づいて自車両と他車両の干渉が予測される。
【００２０】
第３の発明は、計測された走行位置と教示された各走行位置からなるコースデータとに基づいてコースエリア内で無人車両を誘導走行させる場合に適用され、
前記コースエリアの形状を入力する入力手段と、
無人車両を走行させることによってコースデータを教示するコースデータ教示手段と、
教示されたコースデータに従って無人車両が走行したときの走行位置の誤差を推定する誤差推定手段と、
前記推定された誤差、前記コースエリアおよび前記無人車両の車幅に基づいて、前記コースエリア内に前記コースデータ上の位置が存在してはならない範囲を設定し、この範囲内に前記コースデータ上の位置が存在することを判定することで、前記無人車両と前記コースエリア外との干渉を予測する干渉予測手段と、
干渉が予測された場合には、コースデータの再構成処理を実行する処理手段と、
干渉を生じないと予測された場合には、教示されたコースデータを用いて、あるいは、干渉が予測された場合には、再構成されたコースデータを用いて、無人車両を誘導走行させる手段と
を備えることを特徴とする。
【００２１】
この第３発明によれば、コースデータに従って無人車両が走行したときの走行位置の誤差を推定し、この誤差に基づいて、前記無人車両と前記コースエリア外との干渉を予測する。
また、前記自車両の存在範囲に代えて、コースエリア内に前記コースデータ上の位置が存在してはならない範囲が設定され、この範囲内に前記コースデータ情の位置が存在する場合にコースエリアの縁と自車両との干渉を予測する。
したがって、作成されたコースデータに従って実際に無人車両を走行させる前に、無人車両とコースエリア外との干渉を予測することができ、これによって、無人車両の実際の干渉を回避する処置、例えば、コースデータの変更や再ティーチングなどの処置を講ずることが可能になる。
【００２２】
第４の発明は、計測された走行位置と教示された各走行位置からなるコースデータとに基づいてコースエリア内の異なる車線で無人車両をそれぞれ誘導走行させる場合に適用され、
前記コースエリアの形状を入力する入力手段と、
無人車両を走行させることによってコースデータを教示するコースデータ教示手段と、
教示された自車両のコースデータに従って該自車両が走行したときの走行位置の誤差を推定するとともに、教示された他車両のコースデータに従って該他車両が走行したときの走行位置の誤差を推定する誤差推定手段と、
前記推定された各誤差、前記コースエリア、該コースエリアの中心位置、前記自車両および他車両の車幅に基づいて、前記コースエリア内に前記自車両のコースデータ上の位置が存在してはならない範囲および他車両のコースデータ上の位置が存在してはならない範囲をそれぞれ設定し、これらの範囲内に対応するコースデータ上の位置が存在することを判定することで、前記自車両と前記コースエリア外との干渉および前記自車両と他車両との干渉を予測する干渉予測手段と、
干渉が予測された場合には、コースデータの再構成処理を実行する処理手段と、
干渉を生じないと予測された場合には、教示されたコースデータを用いて、あるいは、干渉が予測された場合には、再構成されたコースデータを用いて、無人車両を誘導走行させる手段と
を備えることを特徴とする。
【００２３】
この第４の発明によれば、コースエリア内で複数の無人車両が同時に走行する場合に、自車両と前記コースエリア外との干渉だけでなく該自車両と他車両との干渉をも予測可能である。
また、コースエリア内に自車両および他車両のコースデータ上の位置が存在してはならない範囲が設定され、これらの範囲内に対応するコースデータ上の位置が存在した場合に干渉が予測される。
【００２４】
第５発明は、第１発明または第２発明または第３発明または第４発明において、前記干渉予測手段によって干渉が予測されたときに、前記コースデータを干渉を回避することができるコースデータに変更する手段を付加したことを特徴とする。
【００２５】
この第５発明によれば、作成されたコースデータが無人車両の干渉を予測させるものであった場合に、このコースデータが干渉を回避することができるコースデータに変更される。
【００２６】
第６の発明は、第１発明または第２発明または第３発明または第４発明において、前記コースデータ教示手段は、前記無人車両をオペレータが実際に走行させた際の該車両の位置を記録するティーチング式の手段であることを特徴とする。
【００２７】
ティーチング方式によって作成されたコースデータは、実際の車両が走行した状態を示している。したがって、その内容には、その場のコースの状態に応じ車両が実際に走行可能な走行速度、加減速度、増加速度を満足した位置データが含まれ、さらには、進行方向のカーブを予想した適切な減速や、上り坂を予想した加速など、自動的な計算では求めることの困難な要素が加味されている。
【００２８】
それゆえ、このティーチング方式によって作成されたコースデータを用いれば、第１または第２または第３または第４の発明における誤差の推定を行う上で有利となる。
【００２９】
第７の発明は、計測された走行位置と教示された各走行位置からなるコースデータとに基づいてコースエリア内で無人車両を誘導走行させる場合に適用され、
無人車両を走行させることによってコースデータを教示する行程と、
教示されたコースデータに従って無人車両が走行したときの走行位置の誤差を推定する行程と、
前記推定された誤差、前記コースデータおよび前記無人車両の車幅に基づいて前記無人車両の存在範囲を推定し、この存在範囲内に前記コースエリアの縁が存在することを判定することで、前記無人車両と前記コースエリア外との干渉を予測する行程と、
干渉が予測された場合には、コースデータの再構成処理を実行する行程と、
干渉を生じないと予測された場合には、教示されたコースデータを用いて、あるいは、干渉が予測された場合には、再構成されたコースデータを用いて、無人車両を誘導走行させる行程と
を含むことを特徴とする。
この第７の発明は、第１の発明に対応する方法の発明である。
【００３０】
第８の発明は、計測された走行位置と教示された各走行位置からなるコースデータとに基づいてコースエリア内の異なる車線で無人車両をそれぞれ誘導走行させる場合に適用され、無人車両を走行させることによってコースデータを教示する行程と、
教示された自車両のコースデータに従って該自車両が走行したときの走行位置の誤差を推定するとともに、教示された他車両のコースデータに従って該他車両が走行したときの走行位置の誤差を推定する行程と、
前記推定された各誤差、前記自車両および他車両のコースデータおよび前記自車両および他車両の車幅に基づいて、前記自車両および他車両の存在範囲をそれぞれ推定し、自車両の存在範囲内に前記コースエリアの縁が存在することを判定し、かつ前記各存在範囲相互の干渉を判定することで、前記自車両と前記コースエリア外との干渉および前記自車両と他車両との干渉を予測する行程と、
干渉が予測された場合には、コースデータの再構成処理を実行する行程と、
干渉を生じないと予測された場合には、教示されたコースデータを用いて、あるいは、干渉が予測された場合には、再構成されたコースデータを用いて、無人車両を誘導走行させる行程と
を備えることを特徴とする。
この第８発明は、第２の発明に対応する方法の発明である。
【００３１】
第９の発明は、計測された走行位置と教示された各走行位置からなるコースデータとに基づいてコースエリア内で無人車両を誘導走行させる場合に適用され、
無人車両を走行させることによってコースデータを教示する行程と、
教示されたコースデータに従って無人車両が走行したときの走行位置の誤差を推定する行程と、
前記推定された誤差、前記コースエリアおよび前記無人車両の車幅に基づいて、前記コースエリア内に前記コースデータ上の位置が存在してはならない範囲を設定し、この範囲内に前記コースデータ上の位置が存在することを判定することで、前記無人車両と前記コースエリア外との干渉を予測する行程と、
干渉が予測された場合には、コースデータの再構成処理を実行する行程と、
干渉を生じないと予測された場合には、教示されたコースデータを用いて、あるいは、干渉が予測された場合には、再構成されたコースデータを用いて、無人車両を誘導走行させる行程と
を含むことを特徴とする。
第９発明は、第３の発明に対応する方法の発明である。
【００３２】
第１０発明は、計測された走行位置と教示された各走行位置からなるコースデータとに基づいてコースエリア内の異なる車線で無人車両をそれぞれ誘導走行させる場合に適用され、
無人車両を走行させることによってコースデータを教示する行程と、
教示された自車両のコースデータに従って該自車両が走行したときの走行位置の誤差を推定するとともに、教示された他車両のコースデータに従って該他車両が走行したときの走行位置の誤差を推定する行程と、
前記推定された各誤差、前記コースエリア、該コースエリアの中心位置、前記自車両および他車両の車幅に基づいて、前記コースエリア内に前記自車両のコースデータ上の位置が存在してはならない範囲および他車両のコースデータ上の位置が存在してはならない範囲をそれぞれ設定し、これらの範囲内に対応するコースデータ上の位置が存在することを判定することで、前記自車両と前記コースエリア外との干渉および前記自車両と他車両との干渉を予測する行程と、
干渉が予測された場合には、コースデータの再構成処理を実行する行程と、
干渉を生じないと予測された場合には、教示されたコースデータを用いて、あるいは、干渉が予測された場合には、再構成されたコースデータを用いて、無人車両を誘導走行させる行程と
を備えることを特徴とする。
第１０の発明は、第４の発明に対応する方法の発明である。
【００３３】
【発明の実施の形態】
以下、図面を参照しながら本発明の実施形態について説明する。
【００３４】
図３に示す無人オフロードダンプトラック１０（以下、無人車両という）は、鉱山における積み込みエリアと排土エリアとの間で鉱石を運搬するものであり、図１に示すように、位置計測部１１、後述のコースデータを記憶する記憶部１２、後述のコースエリアの形状を記憶させる記憶部１３、コースデータと自己位置とに基づいて無人車両１０の走行を制御する走行制御部１４、および、障害物センサ１５等を備えている。
【００３５】
上記位置計測部１１は、図示していないが、ＧＰＳ（Global positioning system ）、走行距離を計測するためのタイヤ回転量検出センサ、および、方位検出のための光ファイバジャイロを備え、これらによって無人車両１０の位置を計測する。
【００３６】
無人車両１０は、走行した位置を記憶するティーチングモードを有し、このモードでは、オペレータが手動で車両を運転して、その走行軌跡を記憶する。
【００３７】
すなわち、図３に例示した誘導コース路２０において、オペレータが実際に車両１０を運転し、その走行軌跡を点列の位置のデータ（コースデータ）として上記記憶部１２に記憶する。
【００３８】
一方、無人車両１０は、作業モードを有し、この作業モードでは、コースデータとして記憶されたＸＹＺの座標と速度に現在の無人車両１０の座標軸が一致するように、上記走行制御部１４がステアリング角度とアクセル、ブレーキをコントロールする。
【００３９】
〔無人車両の位置計測誤差、走行制御誤差の発生要因〕
本実施例では、ＧＰＳを利用した絶対位置計測と、タイヤの回転量と光ファイバジャイロによって位置を推定する推測航法とを組み合わせて位置計測を行っている。
【００４０】
ＧＰＳは、原子時計を搭載したＧＰＳ衛星から送信される電波の到着時間差をもって、空間上の絶対位置を計測するものである。
【００４１】
このＧＰＳによれば、地球上の受信機が衛星と同等の原子時計を保持しているとき、ｘｙｚの自由度を求める３つの衛星があれば位置の計測が可能である。しかし、実際は受信機が精密な時間を計測する時計を保持していないので、ｘｙｚと時間ｔの４つの自由度を求める４つ以上の衛星からの電波を受信することによって位置を求めている。
【００４２】
なお、米軍の利用が計画されているＧＰＳ衛星からの信号には、その精度を故意に悪化させる誤差信号が含まれている（選択利用性）。また、ＧＰＳ衛星から送信される電波の速度は、電離層や対流圏の状態によって変化し、したがって、その到達時間も変動する。
【００４３】
そこで、これらの影響を防ぐために、位置の確定している地上に固定局と呼ばれるＧＰＳ地上局を設け、この固定局で計測されたデータを移動局へ伝達するＤ−Ｇps（Differential-GPS）と呼ばれる方式が用いられている。
【００４４】
位置計測精度を向上するためには、より多くの衛星を捕らえるべく、衛星信号受信用のＧＰＳアンテナの設置位置を高く設定すれば良いが、このアンテナの設置位置が高いほど車体が傾いたときの受信位置の変化量が大きくなる。そこで、重力の方向を利用して車体の傾きを検出するセンサを設け、このセンサの出力を用いて上記車体の傾きに起因した計測誤差を補正するようにしている。
【００４５】
ＧＰＳによる位置計測の誤差の要因としては、上記固定局から移動局への信号の伝達に遅れがあること、捕えられる衛星の数が少ないこと、衛星の位置が一個所にまとまっていること、地上の構造物やその他の物体などによる衛星からの電波のマルチパスが発生すること、などがある。また、上記センサによる車両の傾き計測の誤差もある。
【００４６】
ＧＰＳの計測精度は、計測に使用する衛星数や、その衛星の配置が悪いときに悪化する。衛星数や、衛星の位置などは、その精度を評価する指数として位置情報とともにＧＰＳ装置から出力される。
【００４７】
なお、ＧＰＳは、一定周期で位置計測を行なうので、ＧＰＳが計測を行っていない間は上記推測航法によって位置を計測する。
【００４８】
推測航法におけるタイヤの回転量は、車両の進行方向の移動量を求めるために使用される。タイヤと地面との間には、スリップがあり、そのスリップは誤差の要因になる。加減速時、とくに、ブレーキを動作させたときスリップ量は増加する
推測航法に用いられる光ファイバジャイロは、多重に巻いた光ファイバの両端からレーザ光を照射し、この光ファイバから出力される左右回転の光の位相差を計測することによって、回転角速度を計測するものである。
【００４９】
車両の回転角度は、上記角速度を時間積分することによって求められる。この角度には、位相差を計測する光学および電子回路の誤差や回転角度を計測するための積分誤差がある。
【００５０】
一方、走行制御時には、ティーチングされた予定コースと位置計測部１１で計測される現走行位置との偏差か少なくなるように車両のステアリングが制御されるが、このとき、路面の傾き、ステアリングのガタなどの外乱、コースのカーブなどにおいて生じる制御指令値の大きな変化に対するステアリングの追従遅れなどによる制御誤差を生じる。
【００５１】
〔無人車両の位置検出誤差、走行制御誤差の計測〕
上記走行制御の誤差は、走行時の位置計測データと、コースデータとを比較することによって容易にわかる。
【００５２】
位置計測の誤差を判定するためには、別の高精度かつ高速な位置計測システムが必要になる。
【００５３】
走行中の横方向の位置ずれが他の物体との干渉、つまり、衝突事故につながるため、横方向の精度を判定できれば良い。そこで、本実施例では、車両に反射リフレクタを取り付けるとともに、図３に示すように、誘導コース２０に沿ってレーザ距離計測装置３０を等間隔で並べ、これらにによって、全体としての走行時の横方向のずれを計測している。
【００５４】
上記距離計測装置は、細いビーム幅のレーザーパルスを照射し、その照射時点からレーザーパルスの反射波が受波される時点までの時間に基づいて対象物までの距離を計測するものである。
【００５５】
位置計測の誤差は、距離計測装置による計測結果から該計測器の計測地点と同一の地点における走行制御誤差を引くことによって知られる。
【００５６】
そして、以上のような誤差計測を、上り／下り坂、カーブ、積載量、および、走行速度の水準をを変えながら繰り返し実施する。
【００５７】
〔無人車両の位置検出誤差、走行制御誤差の推定〕
上記誤差計測によって得られるデータに基づき、エラーの水準は次のように推定できる。
【００５８】
err level =f(tilt,R,weight,v) …（１）
ここで、tilt: 坂の角度
R : カーブにおける車両の旋回半径
weight: 車両の重量（車体重量＋積載量）
v: 車両の走行速度
f: ４つの引数と計測結果の表に基づき
誤差量を求める関数
なお、err level は、推定される誤差量の標準偏差の３倍に余裕の為の距離を足したものとして設定される。
【００５９】
図３は、コースデータの作成手順を例示している。
【００６０】
この手順では、まず、コースエリアの形状が入力される（ステップ１００）。無人車両１０は、コースエリア形状入力モードを持ち、上記コースエリアの形状の入力は、このモードが設定されている状態でティーチングモード時と同様に車両を走行させながら実行する。
【００６１】
すなわち、車両の走行中に位置計側部１１で計測される現在位置を記憶する。ただし、その場合に記憶させる位置は、無人車両１０を図３に示したコース２０のエリアの縁２０ａに沿って走行させたときの車両前部の右端位置であり、またエリアの縁２０ｂに沿って走行させたときの車両前部の左端位置である。
【００６２】
なお、上記左端および右端の位置を計測するためには、ＧＰＳの計測位置を上記左端および右端の位置に置き換える演算を実行するか、ＧＰＳアンテナの取り付け位置を上記左端および右端の位置にマニュアルまたは自動で変更し得るようにしておけば良い。
【００６３】
また、コースエリア内に走行できない領域（例えば、大きな岩石が存在する領域）がある場合には、車両１０をその領域まで移動させ、その位置からの相対的な範囲をマニュアル操作で入力する。
【００６４】
図１に示した処理部１６は、上記入力されたコースエリアの形状を該エリアを示すライン上の点列の位置データ（コースエリアデータ）として図１に示した記憶部１３に記憶させる。
【００６５】
上記コースエリア形状の入力が終了すると、前記ティーチングモードが設定されて、誘導コースがティーチングされる。つまり、誘導コース２０上で実際に車両を走行させ、その時々刻々の走行位置を座標点列からなるコースデータとして記憶部１２に記憶させる（ステップ１０１）。
【００６６】
次に、処理部１６は、ティーチングによって得られたコースデータの各点における無人車両１０の位置計測誤差、走行制御誤差を前記（１）式に基づいて推定する（ステップ１０２）。
【００６７】
すなわち、坂の角度および旋回半径を、上記コースデータから算出するとともに（坂の角度は、ＧＰＳのＺ方向情報から算出可能）、車重を油圧式サスペンジョンの油圧を検出することによって得るか、あるいは、車両の進行方向に基づいて推定し、さらに、車速をコースデータに含まれた車速データから得る。
【００６８】
そして、これらと前記（１）とに基づいて誤差量の推定値を得る。なお、図３に示した誘導コース２０は、鉱山における積み込みエリアと排土エリアとを結ぶものであるから、車両１０は空荷状態で積み込みエリアに向かい、鉱石を満載した状態で排土エリアに向かうことになる。それゆえ、上記車重は、車両１０の進行方向に基づいて推定することが可能である。
【００６９】
次ぎに処理部１６は、上記コースデータに上記誤差量の推定値（err revel ）と（車幅／２）を足して、このコースデータで規定される位置を基準とした無人車両１０の車幅方向の存在範囲を定め（ステップ１０３）、その範囲内にコースエリアの縁が入るか否かを、つまり、無人車両１０とコースエリアの縁とが干渉するか否かを判断する（ステップ１０４）。
【００７０】
ところで、図４に示すように、コースエリア内において無人車両１０Ａ，１０Ｂがすれ違い走行するようなコースの場合、つまり、コースエリア内において複数の無人車両１０Ａ，１０Ｂが同時に走行するようなコースの場合には、自車１０Ａのみならず他車１０Ｂのコースデータに対しても、該コースデータの位置を基準とする無人車両１０Ｂの車幅方向の存在範囲を推定する。
【００７１】
つまり、この場合、図示していない通信装置等を介して他車のコースデータを入手するとともに、ステップ１０４で他車１０Ｂの車幅方向の存在範囲も推定する。
【００７２】
そして、自車１０Ａと他車１０Ｂの存在範囲が干渉するか否か、つまり、双方の車両１０Ａ，１０Ｂが干渉するか否かをステップ１０４で判断する。
【００７３】
なお、図４は、無人車両１０Ａ，１０Ｂの干渉がない例を、また、図５は、双方の無人車両１０の干渉がある例をそれぞれ示している。
【００７４】
もし、ステップ１０４で上記存在範囲内にコースエリアの縁が入ると判断された場合には、あるいは、図５の例に示すように、相手車両の存在範囲が自車の存在範囲内に入ると判断された場合には、以下に示すコースデータの再構成処理を実行する（ステップ１０５）。
【００７５】
ａ）一定周期で記憶されたコースデータに基づき、コース上での干渉が予想される点をコースの進行方向に直交する方向に干渉した量だけ干渉回避側にシフトさせる。
【００７６】
ｂ）そして、上記コースデータに基づき、上記干渉が予想される点から所定距離前後に離れた各点を決定し、それらの点と上記シフトした点との間をそれぞれスプライン曲線で結ぶ。
【００７７】
ｃ）前記所定距離前後に離れた各点間での元の教示点を前記スプライン曲線上に投影し、その投影点を元の教示点に代わる新たな教示点とする。そして、この新たな教示点に基づいて、上記コースデータを再度構成する。このとき、上記新たな教示点における車両の角度は、スプライン曲線におけるそれらの教示点での接線の傾きから設定する。
【００７８】
ステップ１０４で干渉を生じないと判断されたコースデータ、あるいは、ステップ１０５で再構成されたコースデータは、実際の誘導走行に供される。すなわち、車両１０は、このコースデータと位置計測部１１で計測された該車両１０の走行位置とに基づき、該コースデータで規定される誘導コース上を走行するように操舵される。そして、その際、車両１０とコースエリア外との干渉は確実に回避される。
【００７９】
なお、図２には示していないが、上記シフト量が大きすぎる場合には、つまり干渉量が大き過ぎる場合には、元のコースデータが不良であると考えらる。そこで、この場合には、再度ティーチング操作を行い、それによって得られたコースデータに対して上記の干渉チェックを実行する。
【００８０】
上記実施例においては、車両の存在する範囲をコースデータから算定し、この範囲に基づいて該車両とコースエリアの干渉を判定している。しかし、逆に、コースエリアデータに基づき、路肩であるこのコースエリアの各縁から〔前記誤差の推定値＋（車幅／２）〕分だけ内側に寄った干渉判定ラインをそれぞれ設定し、これらの判定ラインによって挾まれた範囲にコースデータに基づく走行位置が存在する場合に車両とコースエリアが干渉すると判定しても良い。
【００８１】
もちろん、この手法は、車両がすれ違い走行する図６に示すようなコースにも適用可能である。
【００８２】
この場合には、路肩であるコースエリアの一方の縁２２および他方の縁２３から〔前記誤差の推定値＋（車幅／２）〕分だけそれぞれ内側に寄った干渉判定ライン２４および２５をそれぞれ設定するとともに、コースの中心ライン２６から〔誤差の推定値＋（車幅／２）〕分だけ一側および他側に寄った干渉判定ライン２７，２７を設定する。
【００８３】
そして、一方の車両１０Ａのコースデータで規定される誘導コースがライン２２，２４で挾まれた範囲Ｅ１内に存在する場合に、該車両１０Ａがコースエリアの一方の縁２２と干渉すると判定し、双方の車両１０Ａ，１０Ｂのコースデータに基づく誘導コースがライン２７，２８で挾まれた範囲Ｅ２内に存在する場合に、両車両１０Ａ，１０Ｂが干渉すると判定する。
【００８４】
さらに、他方の車両１０Ｂのコースデータで規定される誘導コースがライン２３，２５で挾まれた範囲Ｅ３内に存在する場合に、該車両１０Ｂがコースエリアの他方の縁２３と干渉すると判定する。
【００８５】
一方、上記実施例では、（１）式で示したように、誤差量を推定するための要素としてコースデータで規定された誘導コースの坂の角度、カーブの旋回半径を採用しているが、コースエリアの縁がコースの路肩である場合には、このコースエリアの縁の坂の角度とカーブを上記要素として採用しても良い。
【図面の簡単な説明】
【図１】無人車両の干渉予測機能を有した誘導制御装置のブロック図。
【図２】車両の干渉を予測するための手順を例示したフローチャート。
【図３】誘導コースの一例を示した概念図。
【図４】誘導コースの他の例を示した概念図。
【図５】図５は、干渉がある場合の誘導コースの設定態様を示した概念図。
【図６】干渉チェックの他の実施態様を示した概念図。
【符号の説明】
１０，１０Ａ，１０Ｂ無人車両
１１走行位置計測部
１２記憶部
１３記憶部
１４走行制御部
１６処理部
１７ステアリング制御部
１８速度制御部
２０誘導コース
４１往路の車線
４２復路の車線
５０監視局

Claims

計測された走行位置と教示された各走行位置からなるコースデータとに基づいてコースエリア内で無人車両を誘導走行させる場合に適用され、
前記コースエリアの形状を入力する入力手段と、
無人車両を走行させることによってコースデータを教示するコースデータ教示手段と、
教示されたコースデータに従って無人車両が走行したときの走行位置の誤差を推定する誤差推定手段と、
前記推定された誤差、前記コースデータおよび前記無人車両の車幅に基づいて前記無人車両の存在範囲を推定し、この存在範囲内に前記コースエリアの縁が存在することを判定することで、前記無人車両と前記コースエリア外との干渉を予測する干渉予測手段と、
干渉が予測された場合には、コースデータの再構成処理を実行する処理手段と、
干渉を生じないと予測された場合には、教示されたコースデータを用いて、あるいは、干渉が予測された場合には、再構成されたコースデータを用いて、無人車両を誘導走行させる手段と
を備えることを特徴とする無人車両の干渉予測装置。
計測された走行位置と教示された各走行位置からなるコースデータとに基づいてコースエリア内の異なる車線で無人車両をそれぞれ誘導走行させる場合に適用され、
前記コースエリアの形状を入力する入力手段と、
無人車両を走行させることによってコースデータを教示するコースデータ教示手段と、
教示された自車両のコースデータに従って該自車両が走行したときの走行位置の誤差を推定するとともに、教示された他車両のコースデータに従って該他車両が走行したときの走行位置の誤差を推定する誤差推定手段と、
前記推定された各誤差、前記自車両および他車両のコースデータおよび前記自車両および他車両の車幅に基づいて、前記自車両および他車両の存在範囲をそれぞれ推定し、自車両の存在範囲内に前記コースエリアの縁が存在することを判定し、かつ前記各存在範囲相互の干渉を判定することで、前記自車両と前記コースエリア外との干渉および前記自車両と他車両との干渉を予測する干渉予測手段と、
干渉が予測された場合には、コースデータの再構成処理を実行する処理手段と、
干渉を生じないと予測された場合には、教示されたコースデータを用いて、あるいは、干渉が予測された場合には、再構成されたコースデータを用いて、無人車両を誘導走行させる手段と
を備えることを特徴とする無人車両の干渉予測装置。
計測された走行位置と教示された各走行位置からなるコースデータとに基づいてコースエリア内で無人車両を誘導走行させる場合に適用され、
前記コースエリアの形状を入力する入力手段と、
無人車両を走行させることによってコースデータを教示するコースデータ教示手段と、
教示されたコースデータに従って無人車両が走行したときの走行位置の誤差を推定する誤差推定手段と、
前記推定された誤差、前記コースエリアおよび前記無人車両の車幅に基づいて、前記コースエリア内に前記コースデータ上の位置が存在してはならない範囲を設定し、この範囲内に前記コースデータ上の位置が存在することを判定することで、前記無人車両と前記コースエリア外との干渉を予測する干渉予測手段と、
干渉が予測された場合には、コースデータの再構成処理を実行する処理手段と、
干渉を生じないと予測された場合には、教示されたコースデータを用いて、あるいは、干渉が予測された場合には、再構成されたコースデータを用いて、無人車両を誘導走行させる手段と
を備えることを特徴とする無人車両の干渉予測装置。
計測された走行位置と教示された各走行位置からなるコースデータとに基づいてコースエリア内の異なる車線で無人車両をそれぞれ誘導走行させる場合に適用され、
前記コースエリアの形状を入力する入力手段と、
無人車両を走行させることによってコースデータを教示するコースデータ教示手段と、
教示された自車両のコースデータに従って該自車両が走行したときの走行位置の誤差を推定するとともに、教示された他車両のコースデータに従って該他車両が走行したときの走行位置の誤差を推定する誤差推定手段と、
前記推定された各誤差、前記コースエリア、該コースエリアの中心位置、前記自車両および他車両の車幅に基づいて、前記コースエリア内に前記自車両のコースデータ上の位置が存在してはならない範囲および他車両のコースデータ上の位置が存在してはならない範囲をそれぞれ設定し、これらの範囲内に対応するコースデータ上の位置が存在することを判定することで、前記自車両と前記コースエリア外との干渉および前記自車両と他車両との干渉を予測する干渉予測手段と、
干渉が予測された場合には、コースデータの再構成処理を実行する処理手段と、
干渉を生じないと予測された場合には、教示されたコースデータを用いて、あるいは、干渉が予測された場合には、再構成されたコースデータを用いて、無人車両を誘導走行させる手段と
を備えることを特徴とする無人車両の干渉予測装置。
前記干渉予測手段によって干渉が予測されたときに、前記コースデータを干渉を回避することができるコースデータに変更する手段を付加したことを特徴とする請求項１または２または３または４記載の無人車両の干渉予測装置。
前記コースデータ教示手段は、前記無人車両をオペレータが実際に走行させた際の該車両の位置を記録するティーチング式の手段である請求項１または２または３または４記載の無人車両の干渉予測装置。
計測された走行位置と教示された各走行位置からなるコースデータとに基づいてコースエリア内で無人車両を誘導走行させる場合に適用され、
無人車両を走行させることによってコースデータを教示する行程と、
教示されたコースデータに従って無人車両が走行したときの走行位置の誤差を推定する行程と、
前記推定された誤差、前記コースデータおよび前記無人車両の車幅に基づいて前記無人車両の存在範囲を推定し、この存在範囲内に前記コースエリアの縁が存在することを判定することで、前記無人車両と前記コースエリア外との干渉を予測する行程と、
干渉が予測された場合には、コースデータの再構成処理を実行する行程と、
干渉を生じないと予測された場合には、教示されたコースデータを用いて、あるいは、干渉が予測された場合には、再構成されたコースデータを用いて、無人車両を誘導走行させる行程と
を含むことを特徴とする無人車両の誘導走行方法。
計測された走行位置と教示された各走行位置からなるコースデータとに基づいてコースエリア内の異なる車線で無人車両をそれぞれ誘導走行させる場合に適用され、無人車両を走行させることによってコースデータを教示する行程と、
教示された自車両のコースデータに従って該自車両が走行したときの走行位置の誤差を推定するとともに、教示された他車両のコースデータに従って該他車両が走行したときの走行位置の誤差を推定する行程と、
前記推定された各誤差、前記自車両および他車両のコースデータおよび前記自車両および他車両の車幅に基づいて、前記自車両および他車両の存在範囲をそれぞれ推定し、自車両の存在範囲内に前記コースエリアの縁が存在することを判定し、かつ前記各存在範囲相互の干渉を判定することで、前記自車両と前記コースエリア外との干渉および前記自車両と他車両との干渉を予測する行程と、
干渉が予測された場合には、コースデータの再構成処理を実行する行程と、
干渉を生じないと予測された場合には、教示されたコースデータを用いて、あるいは、干渉が予測された場合には、再構成されたコースデータを用いて、無人車両を誘導走行させる行程と
を備えることを特徴とする無人車両の誘導走行方法。
計測された走行位置と教示された各走行位置からなるコースデータとに基づいてコースエリア内で無人車両を誘導走行させる場合に適用され、
無人車両を走行させることによってコースデータを教示する行程と、
教示されたコースデータに従って無人車両が走行したときの走行位置の誤差を推定する行程と、
前記推定された誤差、前記コースエリアおよび前記無人車両の車幅に基づいて、前記コースエリア内に前記コースデータ上の位置が存在してはならない範囲を設定し、この範囲内に前記コースデータ上の位置が存在することを判定することで、前記無人車両と前記コースエリア外との干渉を予測する行程と、
干渉が予測された場合には、コースデータの再構成処理を実行する行程と、
干渉を生じないと予測された場合には、教示されたコースデータを用いて、あるいは、干渉が予測された場合には、再構成されたコースデータを用いて、無人車両を誘導走行させる行程と
を含むことを特徴とする無人車両の誘導走行方法。
計測された走行位置と教示された各走行位置からなるコースデータとに基づいてコースエリア内の異なる車線で無人車両をそれぞれ誘導走行させる場合に適用され、
無人車両を走行させることによってコースデータを教示する行程と、
教示された自車両のコースデータに従って該自車両が走行したときの走行位置の誤差を推定するとともに、教示された他車両のコースデータに従って該他車両が走行したときの走行位置の誤差を推定する行程と、
前記推定された各誤差、前記コースエリア、該コースエリアの中心位置、前記自車両および他車両の車幅に基づいて、前記コースエリア内に前記自車両のコースデータ上の位置が存在してはならない範囲および他車両のコースデータ上の位置が存在してはならない範囲をそれぞれ設定し、これらの範囲内に対応するコースデータ上の位置が存在することを判定することで、前記自車両と前記コースエリア外との干渉および前記自車両と他車両との干渉を予測する行程と、
干渉が予測された場合には、コースデータの再構成処理を実行する行程と、
干渉を生じないと予測された場合には、教示されたコースデータを用いて、あるいは、干渉が予測された場合には、再構成されたコースデータを用いて、無人車両を誘導走行させる行程と
を備えることを特徴とする無人車両の誘導走行方法。