JPS62274313A - 無人者の障害物回避動作指令装置 - Google Patents

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 ３、発明の詳細な説明 〔産業上の利用分野〕 この発明は無人車の障害物回避動作指令装置に係り、特
に、無人で自律移動する車両の障害物との衝突回避を行
なうための無人車の障害物回避動作指令装置に関するも
のである。

〔従来技術〕

従来、無人車用の障害物回避動作指令装置としては、非
接触式障害物感知センサを無人車前部左右方向に複数個
並設し、これらのセンサがら得られる障害物までの測距
値に基づいて、障害物のおおよその存在位置を検出し、
その情報をそのまま用いて、無人車が障害物と衝突しな
いような定められたステアリング操作をするものが提案
されている（特開昭５９−７４９０５号公報）。

この障害物回避動作指令装置は、第１図に示すように、
無人走行可能な走行車両としての芝刈り作業車において
、車体Ｄ１の前部左右方向に非接触式障害物センサとし
ての超音波センサ５Ａ１５Ｂを設けたものである。

この超音波センサ５Ａ、５Ｂは各々同一構成になってお
り、車体前方の所定範囲にわたって超音波を間欠的に送
信し、この間欠送信の間に障害物Ａから反射される反射
波を受信することによって、障害物を感知すると共に、
超音波の送受信に要した時間に基づいて障害物Ａまでの
距離を検出するものである。そして、その障害物感知エ
リアを３分割して検知可能なように、前記超音波センサ
５Ａ、５Ｂの各々の障害物感知エリアＸ＋゛、Ｘｔが部
分的にラップする様に配置しである。従って、２つのセ
ンサ５Ａ、５Ｂの障害物検知結果の組合せによって３つ
の感知エリアＡｌ５Ａ２、Ａ３のいずれの範囲に障害物
Ａが存在するかを判別することができる。即ち、第２図
の感知位置判別テーブルに示すように、センサ５Ａのみ
が障害物を感知した場合には車体左側前方即ち感知エリ
アＡ１に、センサ５Ｂのみが障害物を感知した場合には
車体右側前方即ち感知エリアＡ３に、両センサ５Ａ、５
Ｂが障害物を感知した場合には車体中央前方即ち感知エ
リアＡ２にそれぞれ障害物Ａが存在すると判別するので
ある。そして、このようにして判別された障害物位置そ
のままに基づき、この障害物を回避して走行するための
ステアリング量θ５、θ２、θ、を決定するものである
。

またその他には、障害物の分布状況が全て与えられた上
での回避のための経路の導出法を示しているものや、Ｔ
Ｖカメラや狭指向性の超音波距離計を回転させる等によ
って障害物を検知し、その情報に基づいて、回避走行等
の回避動作を行なわせるものもある。

〔発明が解決しようとする問題点〕

しかし、特開昭５９−７４９０５号公報に示された障害
物回避動作指令装置では、その動作は単なる停止や定ま
った迂回動作のような簡単な回避動作のみで、停止動作
については障害物が存在する毎に停止されるので無人車
の運行を非効率的にし、定まった迂回動作については障
害物の分布が少し複雑になると適用出来ないという欠点
があった。

また上記の障害物の分布状況が全て与えられた時回避の
ための経路を導出する装置は、実用的な障害物の検知手
段と結びついた回避動作指令装置ではなく、上記のＴＶ
カメラや狭指向性の超音波距離計を回転させる等によっ
て障害物を検知しその情報に基づいて回避走行等の回避
動作を行なわせる装置は、装置全体が大がかりになると
共に、実用的な処理速度と色々な障害物の分布状況に柔
軟に対処できる能力を兼ね備えた回避動作指令装置がな
いという問題があった。

すなわち、従来の実用化されている無人車における衝突
回避動作）旨令装置は停止や決まり切った迂回動作のよ
うな単純な動作しかできない、あるいはその他のもので
は障害物回避動作指令装置が実用的な処理速度と色々な
障害物の分布状況に柔軟に対処できる能力を兼ね備えて
いないという欠点があった。

そこで、本発明者等は、上記従来の問題点について研究
を進めたところ、障害物を検知する障害物検知装置と、
障害物と走行コースとの距離を求め回避動作の必要性を
判定する回避必要性判定装置と、障害物と予想される回
避時の無人車との距離を演算する事によって回避動作を
具体化する回避動作決定装置とを用い、実用的な処理速
度と種々の障害物の分布状況に柔軟に対処できる機能を
有する回避動作指令装置を提供することにより、従来技
術の主たる問題点を解決できるという事に到達した。

本発明は、従来技術の問題点を解消し、障害物を検知す
る障害物検知装置と、障害物と走行コースとの距離を求
め回避動作の必要性を判定する回避必要性判定装置と、
障害物と予想される回避時の車との距離を演算する事に
よって回避動作を具体化する回避動作決定装置とを用い
、実用的な処理速度と色々な障害物の分布状況に柔軟に
対処できる能力を有する回避動作指令装置を提供するこ
とを目的とするものである。

（問題点を解決するための手段）（その１）上記目的を
達成するために第１の発明は、第３図に示すように、無
人車の位置方位を検知して検知した位置方位情報を出力
する位置方位計測装置１と、無人車の動作を決定する走
行コースを記憶する記憶装置２と、無人車を移動および
転向させる駆動装置４と、前記記憶装置２に記憶された
走行コースの情報と前記位置方位情報とを比較して前記
駆動装置４を制御するための制御量を演算する走行制御
装置３とを備え、前記走行コースに沿って自律移動する
無人車の障害物回避動作指令装置において、障害物の位
置を検知して検知した障害物位置情報を逐次または記憶
蓄積して出力する障害物検知装置５と、前記記憶装置２
に記憶された走行コースの情報と前記障害物検知装置５
から得られる障害物位置情報とに基づいて、障害物と走
行コースとの間の距離を演算し、演算された距離と所定
値とを比較して障害物回避動作の必要があるか否かを判
定する回避必要性判定装置６と、前記回避必要性判定装
置６によって障害物回避動作の必要ありと判定されたと
き、前記障害物検知装置５から得られる障害物位置情報
と前記位置方位計測装置１から得られる位置方位情報と
に基づいて、障害物回避動作時の障害物と無人車との間
の距離を考慮して無人車が障害物の存在地点を通過しな
い回避動作を決定し、決定された回避動作を無人車に実
行させるように前記記憶手段２に記憶された走行コース
を変更する回避動作決定装置７と、を設けたことを特徴
とする。

（作　用〕 第３図において、障害′＃検知装置５は障害物を検知し
その位置座標を出力するが、−回の検知動作で得られる
障害物位置の数は単数または復数の場合がある。また障
害物検知装置５にはメモリを備えることによって過去に
検知した障害物の位置座標を記憶蓄積する機能が加えら
れており、こうすれば−回の検知動作で得られる障害物
の情報は少ないが、検知動作を操り返すことによってメ
モリ内に詳細な障害物の分布状況を形成させることがで
きる。その結果として、色々な障害物の分布状況に柔軟
に対処できる能力が備えられる。障害物検知装置５から
出力される障害物位置については、この障害物の位置が
無人車の走行予定コース上にあり、回避の必要性がある
のかを判定する必要がある。これを行なうのが、回避必
要性判定装置６である。この回避必要性判定装置６は走
行コース記憶装置２に記憶された走行コースの情報から
走行コースと障害物の距離を求め、その距離値に基づい
て回避の必要性を判断するもので、この処理を省くと、
例えば回避の必要のない障害物に対しても回避動作を行
なってしまうため、運行能率が著しく低下する。

回避動作決定装置７は、障害物検知装置５で検知された
障害物が回避必要性判定装置６で回避必要であると判断
されたとき、その障害物との衝突を回避するための無人
車の動作を障害物と無人車または、回避時の無人車の予
想される位置との距離を考慮し、演算することによって
決定する。この決定にはその次の瞬間の無人車の速度を
与えるという短期的なものから、他の経路への変更とい
った長期的なものまで考えられる。ここで決定された回
避動作は、走行制御装置３で必要な制御量が計算され、
この制御量によって駆動装置４が制御されることにより
実際の動きに実現される。また回避動作が開始された後
も障害物検知装置５で障害物の情報を得て、以前決定さ
れた回避動作は正しかったか、あるいは障害物の状況に
変化がないかを判断することができる。この判断により
、よりよい回避動作が行なえ、状況変化にも対応できる
ようになる。また障害物についてはその複雑な外形情報
まで扱わず、回避動作をするのに必要十分なその位置情
報に限定しているため、回避動作を決定するための処理
が複雑にならず、実用的な処理速度が実現できる。

〔発明の効果〕

以上説明したように第１の発明によれば、障害物回避の
必要性を判断し、回避の必要があるときのみ回避動作を
演算して無人車に回避動作を行なわせることができるの
で、回避動作を決定するための処理が複雑にならず実用
的な処理速度が得られる、という効果がある。

〔問題点を解決するための手段〕　（その２）また、上
記目的を達成するために第２の発明は、第４図に示すよ
うに、無人車の位置方位を検知すると共に無人車の速度
を演算して速度情報を含む位置方位情報を出力する位置
方位計測装置１と、無人車の動作を決定する走行コース
を記憶する記憶装置２と、無人車を移動および転向させ
る駆動装置４と、前記記憶装置２に記憶された走行コー
スの情報と前記位置方位情報とを比較して前記駆９）Ｊ
　４ｊｔ置４を制御するための制御量を演算する走行制
御装置３とを備え、前記走行コースに沿って自律移動す
る無人車の障害物回避動作Ｉ＠令装置において、障害物
の位置を検知して検知した障害物位置情報を逐次または
記憶蓄積して出力する障害物検知装置５と、前記記憶装
置２に記憶された走行コースの情報と前記障害物検知装
置５から得られる障害物位置情報とに基づいて、障害物
と走行コースとの間の距離を演算し、演算された距離と
所定値とを比較して障害物回避動作の必要があるか否か
を判定する回避必要性判定装置６と、前記回避必要性判
定装置６によって障害物回避動作の必要ありと判定され
たとき、前記障害物検知装置５から得られる障害物位置
情報と前記位置方位計測装置１から得られる位置方位情
報とに基づいて、障害物回避動作時の障害物と無人車と
の間の距離を考慮して無人車が障害物の存在地点を通過
しない回避動作を決定し、決定された回避動作を無人車
に実行させるように前記記憶手段２に記憶された走行コ
ースを変更する回避動作決定装置７と、前記障害物検知
装置５から得られる障害物位置情報と前記位置方位計測
装置１から得られる位置方位情報とに基づいて、障害物
と無人車との間の距離を演算すると共に演算された距離
と無人車の速度とに基づいて減速指令または停止指令を
求め、前記決定された回避動作を無人車に実行させる前
に無人車を減速または停止させるように前記走行制御装
置３へ減速指令または停止指令を出力する減速指令装置
８と、を設けたことを特徴とする。

〔作　用〕

第１の発明において、回避動作決定装置７が回避動作を
決定してしまうまでの期間は、無人車にどのような動作
をさせればよいのが不明なので、車はそのままの走行を
続ける。このことは、回避動作決定処理に時間がかかる
場合には障害物と衝突する危険をはらんでいる。そこで
第２の発明では、第４図における減速指令装置８が回避
動作決定装置７が作動する前に走行制御装置３に対して
減速指令を与え、この間に車が減速し、最悪の場合にも
停止し、この衝突を回避するようにした。

この処理は障害物検知装置５から得られる障害物位置と
、現在の無人車の距離を算出し、その距離と位置方位計
測装置ｌから得られる無人車の速度と無人車の停止性能
に基づいて、走行制御装置３に減速又は停止Ｉ旨令を出
力することによって行なう、またここで減速を行なえば
、迂回走行による回避動作が決定された時、車の向きを
変えるのが容易になる。

〔効　果〕

以上説明したように第２の発明によれば、回避動作決定
に時間がかかる場合に、無人車を減速または停止させる
ようにしているため、障害物への衝突回避を確実に行な
うことができる、という効果が得られる。

〔態様の説明〕

上記第１および第２の発明は実施するにあたって以下の
態様を採り得る。

第１の態様は、第５図に示すように、前記回避動作決定
装置７を、前記回避必要性判定装置６によって障害物回
避動作の必要ありと判定されたとき前記障害物検知装置
５から得られる障害物位置情報と前記位置方位計測装置
１から得られる位置方位情報とに基づいて、障害物回避
動作時の障害物と無人車との間の距離を考慮して無人車
が障害物の存在地点を通過しない回′避路を作成する回
避路作成手段９と、前記回避路作成手段９で作成された
回避路の情報を既に記憶されている走行コースに代えて
前記記憶装置２に一時的に記憶させて、前記回避路を一
時的に次に走行すべき走行コースとする回避路組み込み
手段１０と、で構成したものである。

第１の態様を示す第５図において、回避路作成手段９は
、回避動作決定の一つの具体的な方法を示すもので、障
害物との衝突を避ける回避路の作成を行なうものである
０回避路の作成は障害物検知装置５からの障害物位置情
報、走行コース記憶装置２に記憶された走行コースの情
報等に基づいて、障害物と回避路の距離を予め求め、障
害物の存在地点を通過しないような新たな走行コース（
回避路）を作り上げることによって行なう。回避路組み
込み手段ｌＯは、回避路作成手段９で作成した回避路を
、無人車が実際に走行する走行コースを記憶する走行コ
ース記憶語Ｔｔ２に、次に走行する走行コースとして組
み入れ、回避路に沿った走行を可能にする０回避路を作
成し、そこに沿った走行を行なわせる方法は、その場そ
の場で必要な制御量を計算し、その繰り返しによって、
回避動作を得る方法と比べると、前もってどこを走行す
るのか予測でき、一度回避路を作ってしまえば、その後
は走行コースに沿うという通常の走行が行なえるという
利点を持つ。

第２−の７Ｌｉ様は、第６図に示すように、前記回避路
作成手段９を、前記回避路の始点を仮定して無人車が仮
定された始点に到達するまでの予測時間と前記位置方位
計測装置１から得られる位置方位情報とに基づいて前記
始点の位置座標を演算する回避の始点演算手段１）と、
前記回避路の終点を仮定して無人車が仮定された終点に
到達するまでの予測時間と前記位置方位計測装置１から
得られる位置方位情報とに基づいて前記終点の位置座標
を演算する回避の終点演算手段１２と、前記始点の位１
座標、前記終点の位置座標および前記障害物検知装置５
から得られる障害物の位置情報に基づいて、障害物の位
置を中心とする円を仮定して前記始点、前記終点または
他の障害物位置を中心とする円から前記仮定された円に
引いた接線または円弧で構成される回避路を演算する回
避路演算手段１３と、で構成したものである。

第６図に示すように、本発明の第２の態様は、回避路作
成手段９で行なわれる具体的な回避路作成法を示したも
のである０回避の始点演算手段ｌｌは、予め定められた
走行コースを離れ、回避走行を始める点、すなわち回避
路の始点となる回避の始点を仮定し、この点を車が回避
路決定処理を終えた時点に到達している点として、位置
方位計測装置ｌからの無人車の位置方位の情報等に基づ
いて予測演算する０回避の終点演算手段１２は、回避走
行を終え、元の走行コースに戻る点すなわち回避路の終
点になる回避の終点を仮定し、この点を障害物検知装置
５からの障害物位置情報、走行コース記憶装置２に記憶
された走行コースの情報等に基づいて障害物位置からこ
の点までの距離を考慮し演算することによって求める０
回避路演算手段１３は、回避の始点演算手段１）からの
回避の始点と１）１回避終点演算手段１２からの回避の
終点と、障害物検知装置５からの障害物位置情報等に基
づいて、障害物の位置を中心とした円を仮定し、回避の
始点、回避の終点または他の障害物を中心とした円から
この円に引いた接線または円弧で構成される回避路を演
算する。

回避の始点、終点を予め演算することによって、回避路
作成はその２点間をつなぐ障害物と干渉しない走行コー
ス（回避路）を作る問題に帰着できる。こうすれば、回
避路を作成するとき、元の走行路の形状等に左右されな
いので、この処理の手数を省くことができる。

また、第３の態様は、第７図に示すように、前記回避動
作決定装置７に、評価関数を用いて前記回避路演算手段
で演算された回避路の中から最適な１つの回避路を選択
する比較選択手段１４を設けたものである。

本発明の第３のＬｉ様では、第７図に示すように、比較
選択手段１４を備えたものである。これは回避路演算手
段１３で演算出力される回避路が一般的に複数個あるた
め、その中から最適な一つを選択するために評価関数を
導入し、その評価関数を演算し、最適な回避路に相当す
る関数値を有するような回避路を選択するものである。

この機能によって、最適な回避路を選ぶことが可能にな
り、色々な障害物の分布状況に最も通した回避動作が可
能になる。

第４の態様は、第８図に示すように、前記回避動作決定
装置７を、回避路の始点を仮定して無人車が仮定された
始点に到達するまでの予測時間と前記位置方位計測装置
から得られる位置方位情報とに基づいて前記始点の位置
座標を演算する回避の始点演算手段１）と、回避路の終
点を仮定して無人車が仮定された終点に到達するまでの
予測時間と前記位置方位計測装置から得られる位置方位
情報とに基づいて前記終点の位置座標を演算する回避の
終点演算手段１２と、前記障害物検知装置５に記憶蓄積
されている障害物位置情報と現在の走行コースとの距離
または前記障害物位置情報と演算中の回避路との距離を
演算すると共に該距離と所定のしきい値とを比較し、該
距離が所定のしきい値より小さい障害物を回避対象の障
害物として選択する回避対象の障害物選択手段１５と、
前記回避対象の障害物選択手段１５で選択された回避対
象の障害物の障害物位置情報を記憶する回避対象の障害
物記憶手段１６と、前記始点の位置座標、前記終点の位
置座標および前記回避対象の障害物記憶手段１６に記憶
された回避対象の障害物位置情報に基づいて、回避対象
の障害物の位置を中心とする円を仮定して前記始点、前
記終点または他の障害物位置を中心とする円から前記仮
定された円に引いた接線または円弧で構成される回避路
を演算する回避路演算手段１３と、で構成したものであ
る。

本発明の第４の！Ｌｉ様では、第８図に示すように回避
対象の障害物選択手段１５と、回避対象の障害物記憶手
段１６と、回避対象の障害物に対する回避路演算手段１
７とを備えた。これらの手段は、回避対象の障害物を選
択記憶しその障害物について回避路を演算することによ
って、演算し選択の対象とする回避路の、数、演算順を
制御し、回避路演算手段１３の処理速度を高める。これ
によって、障害物の分布状況がｙＪ雑な場合でも実用的
な速度で回避動作決定処理を行なうことができる。

そして、第５のＬＡＸは、第９図に示すように、回避走
行する前の元の走行コースを記憶する元の走行コース記
憶手段１８を設け、回避走行中に新たに回避走行変更の
必要性が生じたとき、元の走行コースを回避路作成の指
標とし、より適合した回避動作を可能にしたものである
。

本発明の第５態様では第９図に示すように、元の走行コ
ース記憶手段１８を設けた。これは、回避走行する前の
元の走行コースを記憶するもので、回避走行中に新らた
に回避走行変更の必要性が生じた時、ここで記憶された
元の走行コースを回避路作成の指標とすることによって
、より最適な回避路を得ることができる。

〔実施例〕

ｌｌ■二ｌ基 以下図面を参照して本発明の実施例を詳細に説明する。

本実施例の無人車の障害物回避動作指令装置は、本発明
を誘導線を用いずに自律移動する無人車の衝突回避装置
に適用したものである。第１Ｏ図は本発明の実施例の衝
突回避装置の構成を示すブロック図である。

本実施例装置は、走行するコースの情報を予め記憶した
走行コース記憶手段Ｉｔ　と、無人車の現在の位置方位
を計測する位置方位計測手段ｎ１　と、位置方位計測手
段■１から得られた無人車の位置方位と走行コース記憶
手段１）に記憶された目標コースおよび目標速度とに基
づき、無人車を走行させるのに必要な制御量を演算する
走行制御手段■１　と、走行制御手段■、の出力する制
御量に基づき、実際に無人車を駆動する駆動手段■１　
と、障害物の位置を検知すると共に検知された障害物の
位置から得られた障害物の情報を処理して障害物の分布
状態を示す位置情報を記憶すると共に、その障害物の回
避必要性を判定し、回避すべき障害物が検知されたとき
、走行制御手段■１に減速を指示すると共に、障害物と
の衝突を回避する迂回路を演算してその迂回路を今後走
行するコースとして走行コース記憶手段■１に一時的に
記憶させる回避動作決定手段■、とから構成されている
。

回避動作決定手段■１は、障害物の位置を検知して検知
された障害物の位置から得られる障害物の情報を処理し
、障害物の分布状態を示す位置情報を記憶する障害物検
知装置５と、障害物検知装置５の出力する障害物位置と
走行コース記憶装置１）に記憶された走行コースとの距
離値を求め、その距離値を所定のしきい値と比較して、
距離値がしきい値より小さい場合は障害物が無人車と衝
突するコース上に存在し、その障害物は回避の必要があ
ると判定する回避必要性判定装置６と、回避必要性判定
装置６がその障害物を回避の必要ありと判断したとき、
障害物検知装置５からの障害物の位置情報に基づいて、
障害物の存在地点を通過しないような停止、迂回走行等
の回避動作を、回避時の障害物と無人車の距離を考慮す
ること等によって決定し、走行制御系に回避動作を実行
させる回避路決定装置７と、停止、回避走行等の回避動
作を決定する回避路決定装置７の処理動作中に無人車が
走行し続け、障害物に衝突するのを防止するために、回
避路決定装置７の処理を行う前に障害物検知装置５から
得られる障害物位置と現在の無人車との距離を算出し、
その距離と位置方位計測装面■１から得られる無人車の
速度と無人車の停止性能とに基づいて走行制御手段■１
に減速または停止指令を出力する減速指令装置８とから
構成されている。

また、上記の回避動作決定装置７は、障害物と回避路と
の距離を考慮する等によって障害物の存在地点を通過し
ないような回避路を作成する回避路作成手段９と、回避
路作成手段９で演算されて出力される回避路は一般的に
複数個あるため、その中から最適な一つの回避路を選択
するために評価関数を導入し、その評価関数を演算し、
最適な回避路に相当する関数値を有するような回避路を
選択する比較選択手段１４と、比較選択手段１４で選択
された回避路に沿って無人車を走行させるために、この
回避路を、予め定められた走行コースの代わりに一時的
に次に走行すべき走行コースとして走行コース記憶装置
！、にそのコースのデータを記憶する回避路組み込み手
段ｌＯとからなる。

上記の回避路作成手段９は、予め定められた走行コース
を離れ、回避走行を始める点すなわち回避路の始点とな
る回避の始点を仮定し、この始点を位置方位計測装置■
１がら入力される無人車の位置方位の情報に基づいて無
人車が回避路決定処理を終えた時点に到達している点と
して予測演算して始点の位置座標を求める回避の始点演
算手段１）と、回避走行を終え、元の走行コースに戻る
点すなわち回避路の終点になる回避の終点を仮定し、こ
の点を障害物検知装置３からの障害物位置情報及び走行
コース記憶装置■１に記憶された走行コースの情報等に
基づいて障害物位置からこの点までの距離を演算するこ
とによって終点の位置座標を求める回避の終点演算手段
１２と、回避の始点演算手段１）からの回避の始点の位
置座標と、回避の終点演算手段１２からの回避の終点の
位置座標と障害物検知装置５からの障害物位置情報とに
基づいて、障害物の位１を中心とした円を想定し、回避
の始点、回避の終点または他の障害物を中心とした円か
らこの円に引いた接線を連結して構成される回避路を演
算する回避路演算手段１３と、回避路演算手段１３の処
理速度を高めるために、演算し選択の対象とする回避路
の、数、演算順を制御することを目的として障害物検知
装置５に記憶されている障害物の中から、その障害物と
現在の走行コースとの距離、あるいは演算中の候補とな
る回避路との距離を算出することによって現在の回避動
作と関わりの少ない離れた障害物を除き、回避対象の障
害物を選択する回避対象の障害物選択手段１５と、回避
対象の障害物選択手段１５で選択された回避対象の障害
物の位置情報を記憶する回避対象の障害物記憶手段１６
とからなる。この場合、回避路演算手段１３は、回避対
象の障害物記憶手段１６に記憶されたその回避対象の障
害物の位置情報について回避路演算手段１３と同様に回
避対象の障害物に対する回避路を演算する回避路演算手
段１７によって構成されることになる。その他には、既
にある障害物に対する回避動作を行なった後の回避走行
中に新たに回避走行変更の必要性が生じたときに、回避
路作成の上棟とするために、回避走行する前の元の走行
コースを記憶する元の走行コース記憶手段１８が構成要
素となる。

障害物検知装置５は、走行時に障害物検知の必要となる
無人車前方の領域に対して取り付けられた障害物との距
離を測る超音波センサ等の複数個の距離測定手段５１と
、距離計測手段５１の出力する測距値に基づいて、障害
物の無人車に最も近い１点の座標を演算出力する位置座
標演算手段５２と、これまでに検知した障害物位置情報
を記憶する障害物位置記憶装置５３と、障害物位置記憶
装置５３に位置情報が記憶されている障害物の位置と新
たに検知された障害物の位置との位置関係を比較する比
較手段５４と、比較手段５４の比較結果に応じて、障害
物位置記憶装置５３に記憶されている障害物位置情報、
又は新たに検知された障害物位置情報に基づいて、検知
動作を繰り返す毎により正確な障害物位置情報が障害物
位置記憶装置５３に記憶されるように障害物位置記憶装
置５３に記ｊＱされる障害物の位置情報を演算出力する
記憶障害物位置演算手段５５とからなる。

障害物検知装置５は障害物位置記憶装置５３に記憶する
位置座標で表わされた障害物の位置情報（○□（１）、
Ｏｙａ［ｌｌ）　　（ただし、ｉ＝ｌ、・・−ｎ）を出
力する８回避必要性判定装置６は、障害物検知装置５が
出力する障害物位置情報（０８−１）、０、、［ｌｌ）
を入力し、その障害物が走行コースに接近していて、無
人車と衝突する可能性が高く、回避する必要があるか否
かを判定する。この判定は判定対象の障害物位置情報と
今後走行予定の走行コースデータとを入力し、ある長さ
のコース（線分又は円弧）に対し障害物がその領域に含
まれるか否かを判別する走行コースへの射影判別回路６
１と、走行コースを直線又は円とみなしたとき、障害物
と走行コースとの距離を演算し、その距離が所定のしき
い（ｉ　Ｄい以内かを判別する走行コースとの距離判定
回路６２とによって行われる。射影判定回路６１は、直
線型の走行コースとの演算を行なう直線コース射影判別
回路６１）と円弧型の走行コースとの演算を行なう円弧
コース射影判別回路６１２とからなる。直線コース射影
判別回路６１）と円弧コース射影判別回路６１２は入力
した走行コースが直線型か円弧型かにより選択される。

そして、直線コース射影判別回路６１）は次の＋１）式
に示す演算および（２）式に示す判別を行う。

＋Ｔｚｈ＋　　　、、、、＋２１ 但し、（Ｘ、、Ｙ、）、（Ｘ、、Ｙ、）　　は直線型の
走行コースの始点、終点の座標値、Ｔｔ□は所定の判別
のしきい値を示し、ｔは演算され判別の対象となる射影
値を示す。

そして、上記（２）式の判別式が成立するときは障害物
がこの線分の領域内に存在することになる。

その時は射影判別回路６１の出力論理信号Ｔを１とし、
判別式が成立しないとき出力論理信号ＴをＯにする。

円弧コース射影判別回路６１２は次の（３）式に示す演
算及び（４）式に示す判別を行なう。

（ただし、ａ　ｔａｎはｊａｎの逆関数である。）Ａ、
≦ｔ≦Ａ　ｍ　＋　Ｔ　ｔｂｃ　　　　　　　　　、　
、　、　、　１４１（Ｘ、、Ｙ、）は円弧型の走行コー
スの始点の座標値、 （Ｘ、、Ｙ、）は円弧型の走行コースの終点の座標値、 （Ｘ、、Ｙ、）４．を円弧ノ中心点ノ座！１）４Ｉｉ、
Ｔｔ口は所定の判別しきい値、 （は演算され判別の対象となる射影値を表す。

そして、上記（４）式の判別式が成立するときは障害物
がこの円弧の領域内に存在することになる。

射影判別回路６１は判別式が成立するとき出力論理記号
Ｔを１とし、判別式が成立しないとき出力論理記号Ｔを
Ｏとする。

出力論理信号Ｔが１の時は距離判別回路６２が起動され
る。出力論理信号Ｔが０の時は回避必要性判別装置６は
次の走行コースを読み込み、読み込んだ走行コースを対
象として射影判別回路６１を起動し、上記と同様の処理
を行なう、射影判別回路６１の出力論理信号Ｔの０状態
が継続し、読み込む走行コースのデータが無くなったと
きは、上記処理を中断し、障害物は無人車の走行予定の
走行コース上に存在しないと判断し、回避必要性判定袋
５！６の出力論理信号Ｕを０とする。

距離判別回路６２は、射影判別回路６１の出力論理信号
Ｔが１となったとき、すなわち、障害物がこの走行コー
スの領域内に存在するとき起動され、対象となる走行コ
ースが直線型のときに演算を行う直線コース距離判別回
路６２１と走行コースが円弧型の時に演算を行なう円弧
コース距離判別回路６２２とからなる。直線コース距離
判別回路６２１と円弧コース距離判別回路６２２とは入
力した走行コースが直線型か円弧型かにより選択されて
起動される。

直線コース距離判別回路６２１は次の（５）式に示す演
算および（６１式に示す判別を行なう。

・・・・・・・・・（５） ｄ≦Ｄ　Ｌｋｌ　　　　　　　　　　　　　　・・・・
・・・・・（６）但し、Ｉ）ｔｔｈｔ　は所定の判別の
しきい値を表し、ｄは演算され判別の対象となる距離値
を表す。

そして、上記（６）式の判別式が成立するときは障害物
がこの直線の近傍に存在することになる。判別式が成立
するときはその障害物は無人車と衝突する可能性が高い
記憶しておくのに値する有意な障害物であると判断でき
るので、回避必要性判定装置６の出力論理信号Ｕを１と
し、判別式が成立しないときは出力論理信号Ｕを０にす
る。

円弧コース距離判別回路６２２は次の（７）式に示す演
算および（８）式に示す判別を行なう。

但し、Ｄい。は所定の判別のしきい値を表し、ｄは演算
され判別の対象となる距離値を表す。

そして、上記（８）式の判別式が成立するときは障害物
がこの円弧の近傍に存在することになる０判別式が成立
するときはその障害物は無人車と衝突する可能性が高い
記憶しておくのに値する有意な障害物であると判断でき
るので、回避必要性判定装置６の出力論理信号Ｕを１と
し、判別式が成立しないときは出力論理信号Ｕを０にす
る。回避必要性判定装置６の出力論理信号Ｕは回避動作
決定装置７および減速指令装置８へ送出され、出力輪ｌ
信号Ｕが１のとき、回避の必要性があるので、回避動作
決定装置７および減速指令装置８が起動される。

減速指令装置８は、停止および回避走行等の回避動作を
決定する回避動作決定装置７の作動中に、無人車が走行
し続けて、障害物に衝突するのを防止するために、回避
動作決定装置７が起動されたとき、同時に起動される。

減速指令装置８は、障害物検知装置５から得られる障害
物位置情報と現在の無人車の位置情報との距離を算出す
る距離算出回路８１と、距離算出回路８１の出力する距
離と位置方位計測装置■１から得られる無人車の速度と
無人車の停止性能とに基づいて走行制御装置■、に出力
する減速度を演算する減速度演算回路８２とからなる。

距離算出回路８１は、障害物検知装置５から障害物位置
座標（０え、（１），０，，１ｌｌ）を入力すると共に
、位置方位計測装置ｎ、から現在の車の位置（Ｘ、Ｙ＞
を入力し、次式に示す演算を行なうことによって、障害
物位置と現在の無人車間の距離ｄを演算する。

ｄ　−（Ｏｘｍｆｌｌ　−ｘ）　”　＋　（０，、＋１
）−ｙ　）　”　・・・・・’（９１減速度演算回路８
２は、距離算出回路８１が出力する距離ｄと位置方位計
測装置■８から得られる無人車の速度Ｖとに基づいて、
次式に示す演算を行い走行制御装置■、に出力する減速
度ｄｅを求める。

ｄ　ｅ　＝　ｖ／　（ｄ　−ｄｌ）　　　　　−・＝＝
（１０）但し、ｄｌは停止時の無人車と障害物との安全
距離である。

減速指令装置８は最終的に減速度演算回路８２の演算す
る減速度ｄｅを走行制御装置■１に出力する。

回避の始点演算手段１）は、位置方位計測装置■１から
得られる無人車の現在位ｉ！（ｘ、ｙ）、方位θ、速度
Ｖに基づいて、車が回避路決定処理を終えた時点に到達
していると予測される点（Ｘ。

、Ｙ、）を演算し、この点を回避の始点位置として出力
する。この演算は次に示す式に基づいて行われる。

Ｘ！＝Ｘ＋Ｖ、　　−ｃｏｓ　θ・τ−ｏ、ｓ・Ｖｌ・
ｖｌ　・ｓｉｎ　θ・τ２　　　・・・・・・（１））
Ｙａ　＝　３’　”　Ｖ　＊　　’　Ｓｉｎ　θ・τ−
０，５・Ｖ。

・ｖｌ　・ｃｏｓ　θ・τ２．　　　　・・・・・・（
１２）但し、　τ：予測時間 ■、；無人車の線速度 Ｖユ　：無人車の角速度 である。

この式は、速度変化が小さい時にτ時間後の車の位置を
近似的に演算するものである０回避の始点演算手段１）
の出力する回避の始点の位置座標は、回避路演算手段１
３に送出される。

回避の終点演算手段１２は、後述の回避対象の障害物記
憶手段１６に記憶された障害物の位置座標（０，、（１
）、０ｙａｌｌｌ）　　（ただしｉ−１，・＝ｍ）全て
に対してその座標値を入力し、それに対する回避の終点
の座標値を演算出力す゛る。この座標の算出法として、
走行コースと障害物の位置との位置関係によって、３種
の回避の終点の演算手段を使い分ける。この手段は、３
種の回避の終点の演算手段（以下では（１）、（２）、
（３）を付して区別する）と、これらを選択する回路と
によって以下のように構成される。まず、後述の元の走
行コース記憶装置１８から回避動作前に走行していた走
行コースの情報を入力し、障害物（０，、＋１）．０．
。（１））とその走行コースの終点位置の距ＨＤを演算
する障害物と終点間の距離演算回路１２１を備え、次式
に示す演算を行い、Ｄを求め出力する。

Ｄ　　−（Ｏｘｏ（１）−Ｘｓ　　）　　”　　＋（Ｏ
ｙｏｔｌｌ　−Ｙｂ　　）　　”・・・αｌ また、回避の終点演算手段１２は、この出力値りと所定
のしきい値ｒ２とを比較し、出力値りがしきい値ｒ２よ
り大きいときは１）そうでないときは０となる論理信号
Ｂ、を出力する比較器１２２を備えている。論理信号Ｂ
１が１のときは、回避の終点の演算手段［１）　１２６
を起動し、論理信号Ｂ１が０のときは、元の走行コース
記憶装置■１から人力する走行コースを現在対象として
いる走行コースの次の走行コースとし、走行コース型判
定回路１２３を起動する。走行コース型判定回路１２３
は走行コースの情報を入力し、走行コースの型が直線型
か円弧型かを判定する。走行コースの型が直線の場合に
は障害物と終点間の距離演算回路１２１を起動し、同様
の処理を繰り返す、走行コースの型が円弧の場合は障害
物と終点間の距離演算回路１２４を起動し、障害物と終
点間の距離演算回路１２４と同様に距離値りを演算出力
する。比較器１２５はこの出力値りと所定のしきい（Ｉ
　ｒ　ｚ　とを比較し、Ｄ値ｒ、より大きいときは１、
そうでないときはＯとなる論理信号Ｂ２を出力する。論
理信号Ｂ！が１のときは、回避の終点の演算手段＋２１
）２７を起動し、論理信号Ｂ２が１のときは、回避の終
点の演算手段＋３１）２８を起動する。

回避の終点の演算手段ｆｉ＋　１２６は走行コースと障
害物の位置関係が第１）図に示す場合に回避の終点の座
標（Ｘ、、Ｙ、）を計算する演算手段で、走行コースが
直線型の時に起動される直線型演算手段と、走行コース
が円弧型の時に起動される円弧型演算手段とからなる。

直線型演算手段は直線コースの方程式 ％式％ と、障害物の位置座標（０，。＋１）．０．。（１））
を中点とする半径「２の円の方程式 ％式％ の交点を次式に示すように演算し、回避の終点の座標（
Ｘｂ　、　Ｙｂ　）を出力する。

ａ　　２　　　＋ｂｔ ・・・　・・・０１０′ ただし、ａ、ｂは定数である。

円弧型演算手段は円弧型コースの方程式％式％ （但し、（Ｘｃ、Ｙｃ）は円弧の中心点座標、Ｒｏは半
径） と、障害物の位置座標（０８゜＋１）．０．、（１））
を中心とする半径ｒ２の円の方程式 （ｘ−０１）０（１））　”　＋　（ｙ−Ｏｙｏ（１）
）　”　−ｒｔ　”・・・　・・・Ｏｌ の交点を同様に演算し、回避の終点の座標（ｘｂ２　Ｙ
、）を出力する。

回避の終点の演算手段＋２１）２７は走行コースと障害
物の位置関係が第１２図に示す場合に回避の終点の座標
（Ｘｂ　、　Ｙｈ　）を計算する演算手段である。この
回避の終点の演算手段（２）は障害物位置−（０，、ｆ
ｌｌ、　ｏ、、＋１））を中点とした半径ｒ２の円内で
、かつ障害物位置（０，。（１）１ｏ、。（１））を中
心とした半径ｒ３の円外の領域に、走行コース上の無人
車の停止などの動作が行われる点や、直線型のコースか
ら円弧型のコースに切り替わる点が存在するとき、その
点をそのまま回避の終点とする演算を行うものである。

この演算は次式に示すものであり、回避の終点の演算手
段（２）はこの演算によって回避の終点の座標（ｘｂ　
、　ｙｂ　）を出力する。

Ｋｂ−Ｘ−・・・・・・（２０） Ｘ　ｂ　”　Ｙ−・・・・・・（２１）但し、（Ｘ、、
Ｙ、）は走行コースの終点座標である。

回避の終点の演算手段Ｔ３１）２８は走行コースと障害
物の位置関係が第１３図に示す場合に回避の終点の座１
　（Ｘｂ　、　　Ｙ、　）を計算する演算手段である。

この演算手段（３）は障害物位置（０８゜ｆｌｌ、０、
。（１））を中点とした半径ｒ、の円内の領域に、走行
コース上の無人車の停止などの動作が行われる点や、直
線型のコースから円弧型のコースに切り替わる点が存在
するとき、走行コースと障害物位置を中心とした半径ｒ
、の円の交点を演算し、回避の終点とするものである。

そして、この演算手段（３）は、走行コースが直線型の
時に起動される直線型演算手段と、走行コースが円弧型
の時に起動される円弧型演算手段とからなる。直線型演
算手段は直線コースの方程式 ％式％（２２） と、障害物の位置座標（０，。ｔｏ、ｏｙ。（１））を
中点とする半径「、の円の方程式 ％式％ の交点を次式に示すように演算し、回避の終点の座標（
Ｘ＝　、Ｙｂ　）を出力する。

ａ　　！　　４　　ｂ　ｚ ・・・・・・（２４） ａ　赤　Ｘ、＋Ｃ Ｙ、−一□　・・・・・・（２５） 円弧型演算手段は円弧型コースの方程式％式％ （但し、（Ｘｃ、Ｙｃ）は円弧の中心点座標、Ｒｏは半
径） と、障害物の位置座標（０，。ｉｌｌ　、　Ｏ、、（１
）’）を中点とする半径「、の円の方程式 ％式％ との交点を上記と同様に演算し、回避の終点の座標（Ｘ
５．Ｙｂ　）を出力する。

回避対象の障害物選択１５は、障害物検知装置５に記憶
されている障害物位置情報の中から、まず新たに検知し
、回避必要性判定装置６において回避必要と判定された
障害物の情報を選択し回避対象の障害物記憶手段１６に
出力する。そして、この障害物に対して回避路演算手段
１７を動作させ、回避路を演算したとき、障害物検知装
置５に記憶されている障害物の中でこの回避路に干渉す
る障害物が存在するときは、その障害物を選択し回避対
象の障害物記憶手段１６に出力する。

回避対象の障害物記憶手段１６は、回避対象の障害物選
択手段１５で選択された障害物に関する位置情報を入力
し、記憶するメモリからなる。このメモリに位置情報が
記憶された１つ１つの障害物に対して順次それを対象と
した回避路演算手段１７の回避路作成処理が行われる。

回避路演算手段１３は回避対象の障害物に対して回避路
の演算を行う回避路演算手段１７によって構成される０
回避路演算手段１７は複数個の２点間回避路演算回路か
らなる。２点間回避路演算回路はｐ＋　、ｐｚ　２地点
間で障害物Ｏを回避する回避路を演算選択し出力するも
ので、り＋点、２２点、０点の座標値を入力し起動する
。２点間回避路演算回路１７１は９３点から障害物Ｏの
右側を通り９２点に至る回避路を演算する右側回避終演
算回路１７１）と、２１点から障害物０の左側を通りｐ
！点に至る回避路を演算する左側回避路演算回路１７１
２と、右側回避終演算回路１７１）と左側回避路演算回
路１７１２との出力する２つの回避路を比較し、選択出
力する回避路比較選択回路１７１３からなる。右側回避
終演算回路１７１）、左側回避路演算回路１７１２は略
同様の処理であるので、以下にその構成をまとめて説明
する（右と左の違いは演算式の上で復号同順で区別する
）。

この回路では次の値を演算し出力する。すなわち、地点
１）＋　から障害物０を中心とし半径ｒ、の円の左側へ
引いた接線の方程式ａ１　・ｘ＋ｂ、　　・ｙ＋Ｃ＋　
＝０の定数ａ、　、ｌ）Ｉ　ｓ　Ｃ１とこの接線の上記
円で切取られる線分の始点（ＸＩ　、ｙ＋　”）、終点
（Ｘｓ　、　Ｙ２　）を演算して出力する。

この演算を行なうには、まず地点ｐ１の座標値を入力し
、地点ｐ１が回避路の始点であるか否かを判別する。地
点ｐ１が回避路の始点（ｘ。

、Ｙ、）のときは、上記線分の始点（ＸＩ　、Ｙ＋　）
が回避路の始点と等しくなるので、次の演算が行なわれ
る。

ＸＩ−Ｘ−・・・・・・（２８） Ｙ　＋　　−Ｙ　−・・・・・・（２９）次に障害１）
５ｏの位置座標（０，１、Ｏ，、）を入力し、ａ、−ｘ
＋ｂ、　　°）”Ｃ＋　　”Ｏの定数ａｌｓｂ１、Ｃ１
を次式に示すように演算する。

ｂ＋　　＝　（Ｏｌｌ−ＸＩ）”　−ｒ　＋　”　　　
　＝、−（３１）ｃｌ　　＝　　ａｔ　　・ＸＩ　　　
ｂ＋　　・Ｙ＋　　　　・・・”・（３２）（ａＣｔ！
：点ｐｌが回避の始点でなくある障害物の左又は右側に
存在するときは、障害物０の位置座Ｌ　（Ｏｘ　＊、ｏ
、１）を入力し、；１．−ｘ＋ｂ、　　・ｙ＋ｃ＋＝ｏ
の定数ａ、　、ｂ、　、ｃ、を次式に示すように演算す
る。

２つの円の６し、の丑゛　キの６人 ａ　＋　＝　　（０ｙａ−（）ｙａ＊　）　　　　　　
・・・・・・（３３）ｂ、＝　（０，、−０，、、）　
　　　　　　・・・・・・（３４）ｃ＋　　＝ａ＋　　
’　Ｏ，、＋ｂ、　　・Ｏｙｍ＋・１　・ＦＴ丁ｒ７マ
コ璽−・・・・・・（３５）但し、（０−−−，０−ａ
−）は地点ｐ１にある障害物の位置座標である。

２つの円の　る、の丑゛　　の−人 す、＝　Ｃｏｗｓ　　Ｘｔ　）”　　　ｒ＋　”　　　
・・・・・・（３７）ｃ＋　−ａｔ　　ＨＸｔ　　　ｂ
＋　　・Ｙ＊　　　・・”・（３８）但し、（Ｘｔ　、
　　ＹＬ　）は両日の中点である。

この場合は、線分の始点（ｘ＋　、Ｙｌ　＞は回避の始
点と等しくないので、今演算している回避路に連結する
既に作成した回避路の直線 ３゜−Ｘ　＋　ｂｏ−ｙ　＋　Ｃ，−０−（３９）の情
報を入力し、前の処理で演算した直線ａ＋　　’Ｘ　”
ｂ＋　　・ｙ＋、’−１−０−・＝（４０）との交点を
次式のように演算し線分の始点（Ｘ。

、Ｙｌ）を求める。

この処理は、次に地点ｐ２の値を入力し、地点ｐ２が回
避の終点であるか否かを判別するものである。地点ｐ２
が回避の始点＜Ｘｓ　、　Ｙｈ　）の時は、障害物から
地点ｐｔに至る線分の終点（Ｘｚ、Ｙｇ）が回避の終点
と等しくなるので、次の演算が行われる。

ＸＺ−Ｘ、　　　　　・・・・・・（４３）Ｙｚ−Ｙｈ
　　　　　・・・・・・（４４）そして、ａ、−ｘ＋ｂ
、−ｙ＋ｃｔ　＝Ｏの定数ａｚ　、ｂｚ　、Ｃ２を次式
に示すように演算する。

ｔｚ　＝　（０，、−Ｘｚ　）　”　−ｒ、　”　　　
””・・（４６）ｃ、　＝　−ａｘ　　’　Ｘｚ　−ｂ
ｚ　　・Ｙ、　　　”””（４７）（ｂ）地点ｐｔが回
避の始点でなくある障害物の左又は右側に存在するとき
は、障害物０の位置座！！Ｉ（０，、，０７，）を入力
し、ａｔ　　・ｘ＋ｂｚ　　・ｙ＋ｃ、＝ｏの定数ａｔ
　、ｂｔ　、Ｃ２を次式に示すように演算する。

２つの円の６じ、の北゛　線の”人 ａｘ　−（Ｏｙａ　　Ｏ＊ａｍ　）　　　　　・＝−（
４８）ｂｔ　＝　Ｃｏｍａ　　Ｏｙｍ＊　）　　　　　
　−−（４９）Ｃ！　　＝ａｔ　　・　Ｏｘａ”ｂｚ　
　・　Ｏｙ＠＋　　ｒ＋但し、（０，、、、Ｏ，ｌｌ、
　）は地点ｐ１がある障害物の位置座標である。

ｂ２＝（ｏ、、−ｘｔ）”−ｒ、”　　　・・・・−（
５２）ｃ２＝　　ａｘ　　＋　ｘＬ　　　ｂｚ　　・Ｙ
ｔ　　　−−（５３）但し、（ｘｔ、Ｙ、）　は両日の
中点である。

線分の終点（Ｘｘ　、　Ｙｔ　）はこの場合は、回避の
始点と等しくないので、今演算している回避路に連結す
る既に作成した回避路の直線 ａ２　　・ｘ＋ｂ、＋　ｙ＋ｃ３−０−−　（５４）の
情報を入力し、前の処理で演算した直線ａ、　　・ｘ＋
ｂ、　　・ｙ＋ｃ、＝Ｏ・−・−（５５）との交点を次
式のように演算し線分の始点（Ｘ　ｚ、Ｙ２）を求める
。

次に、これまで求めた直線ａ、・ｘ＋ｂ、　　・ｙ＋ｃ
＋＝ｏと直線ａｘ　　・ｘ＋ｂｚ　　−ｙ＋ｃ２　＝０
の交点を次式に示すように演算しくＸ３　、　　Ｙｘ　
）を求める。

上記で回避路を構成する２つの線分（Ｘ、、Ｙ、）−（
Ｘ３　、　Ｙｌ　）、（Ｘ３　、Ｙｌ　）　　　（Ｘｔ
、Ｙｔ）・が演算されたので、次にこの回避路に干渉す
る障害物が障害物検知装置５に記憶されている障害物の
中に存在するかを障害物の位置情報（０８゜（１）。

０．。（１））を順次入力し、判別する。線分（Ｘ、。

Ｙｌ）　　（Ｘｓ　、Ｙｘ　）に障害物が存在するかを
判別する処理は、まず次の（６０）式に示す判別演算処
理を行い、障害物がその領域に含まれるかを次の（６１
）式に基づいて判別する。

、、０．、　（６０） ０≦ｔ≦（Ｘｓ　　Ｘ＋　）”　＋　（Ｙｊ　　Ｙｌ　
）”＋Ｔｔｂ＋　　　・・・・・（６１） 但し、Ｔい、は所定の判別のしきい値を示し、ｔは演算
され判別の対象となる距離値を示す。

そして、上記（６１）式の判別式が成立するときは障害
物がこの線分の領域に存在することになり次の距離判別
処理に進む０判別式が成立しないときは障害物がこの線
分の領域に存在しないことになり、その障害物は線分に
干渉しないと判断される。

距離判別処理は、次の（６２）式に示す演算、次の（６
３）式に示す判別によって行なわれる。

・・・・・（６２） ｄ≦Ｄ　ｔ、、　　　　　・・・・・（６３）但し、Ｄ
Ｌｋ＋　は所定の判別のしきい値を示し、ｄは演算され
判別の対象となる距離値を示す。

そして、上記（６３）式の判別式が成立するときは障害
物がこの直線の近傍に存在することになる。

その時はその障害物はこの線分に干渉すると判断される
。またこの判別式が成立しない時はその障害物はこの線
分に干渉しないと判断される。

線分に干渉する障害物が存在すると判断された場°合は
、その線分上を走行できないので、その間にその障害物
を回避する回避路を作成する処理が必要になる。この回
避路はある２点間で障害物を回避する回避路を演算する
処理なので、複数個の２点間回避路演算回路１７１の他
の１つを次の値を入力し、起動させることによって回避
路を演算できる。

１）’ｌ−１）１ ｐ’ｔ＝０ ０　′　−干渉する障害物 但し、　　′は新たに起動する２点間回避路演算回路１
７１の入力値である。

すな−わち、回避路の線分に干渉する障害物の存在が判
別されたとき、２点間回避路演算回路の処理を一時中止
し、その小区間での回避路演算を行うために、他の２点
間回避路演算回路を起動し、この演算回路で演算された
回避路を入力し、再び処理を中止していた元の２点間回
避路演算回路を起動し、回避路の中の障害物が干渉して
いた区間を、他の２点間回避路演算回路から人力した回
避路で置き換え、次の処理に進む、また、全ての障害物
について干渉するか否かの判断を行ない、干渉する障害
物が存在しなかったときは、そのまま次の処理に進む、
ここで、回避路に干渉するか否かの判別は、障害物記ｔ
９装置５に記載されている障害物の中から、回避対象の
障害物を選択する場合にも使用し、ここで干渉すると判
断された障害物は、回避対象の障害物選択手段１５によ
って選択され、回避対象の障害物の位置座標が回避対象
の障害物記憶手段１６に出力される。

次の線分（Ｘｓ　、Ｙｊ　）−（Ｘ、、Ｙｚ　）に障害
物が存在するかを判別する処理は、上記で説明した線分
（Ｘ＋　、Ｙｌ）−（Ｘ３　、ｙ、）に障害物が存在す
るかを判別する場合と同様、まず次の（６４）式に示す
判別演算処理を行ない、障害物がその領域に含まれるか
を（６５）式によって判別する。

・・・・・・（６４） ０ｕｓｔ≦　（Ｘｚ　　−Ｘ３　）”　　＋　　ＣＹｚ
　　−Ｙｓ　）”＋　Ｔ１）　　　　　・・・・・・（
６５）但し、Ｔい、は所定の判別のしきい値を示し、ｔ
は演算され判別の対象となる射影値を示す。

そして、上記（６５）式かの判別式が成立するときは障
害物がこの線分の領域内に存在することになり次の距離
判別処理に進む。判別式が成立しないときは障害物がこ
の線分の領域に存在しないことになり、その障害物は線
分に干渉しないと判断される。

距離判別処理は、次の（６６）式に示す演算および（６
７）式に示す判別によって行なわれる。

・・・・・・（６６） ｄ≦ＤＬｈ＋　　　　　　　・・・・・・（６７）但し
、Ｄい、は所定の判別のしきい値を示し、１ｄは演算さ
れ判別の対象となる距離値を示す。

そして、この（６７）式の判別式が成立するときは障害
物がこの直線の近傍に存在することになる。

その時はその障害物はこの線分に干渉すると判断される
。またこの判別式が成立しない時はその障害物はこの線
分に干渉しないと判断される。

線分に干渉する障害物が存在すると判断された場合には
、その線分上は走行できないので、その間にその障害物
を回避する回避路を作成する処理が必要になる。この回
避路は、ある２点間で障害物を回避する回避路を演算す
る処理なので、複数個の２点間回避路演算回路１７の他
の１つに次の値を入力して起動させることによって演算
することができる。

ｐ’ｌ−。

ｐ’ｚ−ｐｚ ｒ　　＝干渉する障害物 但し、′は新たに起動する２点間回避路演算回路１７１
の入力値である。

すなわち、回避路の線分に干渉する障害物の処理を一時
中止し、その小区間での回避路演算を行なうために、他
の２点間回避路演算回路を起動し、この演算回路で演算
された回避路を入力し、再び処理を中止していた元の２
点間回避路演算回路を起動し、回避路の中の障害物が干
渉していた区間を、他の２点間回避路演算回路から入力
した回避路で置き換える。これにより、９１点からｐｚ
点に至る幾つかの線分を連結した回避路が完成する。

また、全ての障害物について干渉するか否かの判断を行
ない、干渉する障害物が存在しなかったときは、そのま
まその線分を用いることにより、９１点から９２点に至
る幾つかの線分を連結した回避路が完成する。またここ
で回避路に干渉するか否かの判別も、障害物記憶装置５
に記載されている障害物の中から回避対象の障害物を選
択する場合にも使用し、ここで干渉すると判断された障
害物は、回避対象の障害物選択手段１５によって選択さ
れ、回避対象の障害物の位置座標が回避対象の障害物記
憶手段１６に出力される。

右側回避路演算回路１７１）、左側回避路演算回路１７
１２は以上の処理によって対象とした障害物の左右を通
る回避路をそれぞれ出力する。障害物の分布状況によっ
て、回避路が演算できないときは、回避路を出力しない
。演算回路１７１）゜から出力された回避路は、回避路
比較選択回路１７１３に送出される。

回避路比較選択回路１７１３は右側回避路演算回路１７
１）と左側回避路演算回路１７１２とが出力する２つの
回避路を比較し、選択出力する。

この処理のフローチャートを第１４図に示す、この処理
は２つの回避路の有無、と３つの評価関数値、すなわち
総回避路長Ｌｒ、Ｌ／、元の走行コース記憶手段１８に
記憶された元の走行コースとの最大距１ｉｄｌＤｒ、Ｄ
Ｊ！、現在の車の状態からその回避路を走行するのに必
要な回転角度Ａｒ、Ａ６という量を演算比較することに
よって行なう。

すなわち、第１４図のステップ１００で右側回避路が存
在するか否かを判断し、右側回避路がない場合はステッ
プ１０２で左側回避路が存在するか否かを判断する。ス
テップ１０２で左側回避路がないと判断された場合、す
なわち右側回避路と左側回避路とのいずれも存在しない
場合は、ステップ１２６で回避路は存在しないと判断さ
れ、回避路は選択されない、一方、ステップ１０２で左
側回避路が存在すると判断された場合、すなわち左側回
避路のみが存在する場合には、ステップ１３０で左側回
避路が選択される。

ステップ１００で右側回避路が存在すると判断されたと
きは、ステップ１０４で左側回避路が存在するか否かを
判断し、否定の場合すなわち右側回避路のみが存在する
場合はステップ１２８で右側回避路を選択し、ステップ
１０４の判断が肯定のときはステップ１０６へ進む。ス
テップ１０６では、右側回避路の総回避路長Ｌｒ　と左
側回避路の聡回避路長Ｌ１とを比較し、Ｌｒ＞Ｌｔ＋な
らばステップ１）０でＬｒ／Ｌｊ！が所定値Ｌｓを越え
ているか否かを判断する。ステップ１）０の判断が否定
のときはステップ１）２へ進み、ステップ１）０の判断
が肯定のとき、すなわち右側回避路の総回避路長Ｌ「が
左側回避路の総回避路長ＬＩＬより十分長いときは、ス
テップ１３０で左側回避路を選択する。一方、ステップ
１０６でＬｒ：５Ｌｊ！と判断されたときは、ステップ
１０８でＬｎ／Ｌｒが所定値Ｌｓを越えているか否かを
判断する。ステップ１０８の判断が否定のときはステッ
プ１）２へ進み、ステップ１０８の判断が肯定のとき、
すなわち左側回避路の総回避路長ＬＩｌが右側回避路の
総回避路長Ｌｒより十分長いときは、ステップ１２８で
右側回避路を選択する。

次のステップ１）２では、左右の回避路と元の走行コー
スとの最大距離Ｄｌ、Ｄｒを比較し、Ｄｒ　１０１とき
はステップ１）４でＤ　Ｉ　−Ｄｒと所定値Ｄｓ　とを
比較する。ステップ１）４でＤＪ−Ｄｒ　＞Ｄｓ　と判
断されたときは、左右方向の最大距離が略等しく右側回
避路の方がかなり元の走行コースに近いのでステップ１
２８で右側回避路を選択する。ステップ１）４でＤＩ−
Ｄｒ：！ａＤｓ　と判断されたときは、ステップ１）６
で回避路を走行するのに必要な左右方向の回転角度Ａ１
．Ａｒを比較する。右方向回転角度Ａ「が左方向回転角
度Ａ／より小さいときは、ステップ１２８で右側回避路
を選択し、ＡＩ≦Ａｒのときはステップ１）８でＡｒ　
−Ａｊ＋とＡｓ　とを比較しＡｒ　−ＡＩが所定値Ａｓ
より小さいときはステップ１２８で右側回避路を選択し
、Ａｒ−Ａｌ＞Ａｓのときはステップ１３０で左側回避
路を選択する０以上の結、　果、右側回避路の最大距離
Ｄｒが左側回避路の最大距離より十分大きいときは右側
回避路が選択され、右側回避路の最大路ＭＤｒが左側回
避路の最大距離より小さくかつその差が小さいときには
、回転角度も考慮して回避路が選択される。

また、ステップ１）２においてＤｒ＞Ｄｉと判断された
ときには、ステップ１２０〜ステツプ１２４においてス
テップ１）４〜ステツプ１）６と同様に右側回避路また
は左側回避路が選択される。

そして最終的に左側、右側回避路をｉ！訳し出力するか
、または回避路が無いことを示す信号を出力する。以上
の処理によって２点間回避路演算回路１７１は、与えら
れたり＋、Ｉ）ｚ２地点間で与えられた障害物Ｏを回避
する回避路を演算選択し出力する。

回避路演算手段１７は回避対象の障害物記憶手段１６に
位置が記憶された障害物の１つ１つに対して起動され、
その障害物を障害物０とし、回避の始点をＩ）ｌ、回避
の終点をｐ２として２点間回避路演算回路１つを動作さ
せる。２点間回避路演算回路で演算された回避路は比較
選択手段１４に送出される。

比較選択手段１４は、回避路演算手段１７が回避対象の
障害物記憶手段１６に位置が記憶されたそれぞれの回避
対象の障害物に対して演算した回避路の中から、最適な
一つを選択するために評価関数を演算し、最適な回避路
に相当する関数値を有するような回避路を選択する。こ
の処理は回避路比較選択回路１７１３とほぼ同様の第１
４図のフローチャートに示した処理で、回避路の比較を
行い、最終的に１つの回避路を選択する。

回避路組み込み手段１０は比較選択手段１４で選択され
た回避路のコースのデータを、予め定められた現在走行
中の走行コースの代わりに、次に走行すべき走行コース
として走行コース記憶装置！１に一時的に記憶する。こ
の操作は、走行コース記憶装Ｗ　■＋　内のメモリの内
容の書き換えまたは、走行コースのデータを指し示すポ
インタの値を書き換えることによって行なわれる。走行
コース記憶装置■１の゛走行コースを書き換えた後は、
走行制御手段■１は走行コース記憶装置Ｉｔ　に記憶さ
れた走行コースデータに基づいて、車を走行させるので
、回避のための特別な走行制御装置は必要ない。

元の走行コース記憶手段１８は、回避走行する前の元の
走行コースのデータを記憶するメモリからなる０回避走
行中に新たに回避走行変更の必要性が生じた時、ここで
記憶された元の走行コースデータを回避の終点演算手段
１２、比較選択手段１４、回避路演算手段１７の処理に
用いることによって、より最適な回避路を得ることがで
きる。

走行コース記憶手段１）は、定められたコースを走らせ
るのに必要なパラメータを予め記憶したメモリ１０１か
ら成る。コースを走るのに必要なパラメータには動作の
種類、コースの形状値、走行速度等が含まれる。メモリ
１０１へのデータの書き込みは走行させる前に予め人手
によって行なってお（。

位置方位計測手段■、は、左右独立の計測輪２ＩＲ１２
１Ｌと、それぞれの計測輪２１Ｒ１２１Ｌの一定時間内
の回転数を計数する独立のカウンタ回路２２Ｒ，２２Ｌ
と、このカウンタ回路２２Ｒ１２２Ｌの計数値から、車
の現在位置方位を演算する演算回路２３からなる。

走行制御手段■１は、位置方位計測手段■、から得られ
た車の位置方位と、走行コース記憶手段１、に記憶され
たコースのパラメータ値に基づき、現在の車の状態から
与えられた走行コースを与えられた速度でより忠実に走
行するために必要となる左右駆動輪の加速度値を求める
加速度演算回路３１と、その加速度値を積分して左右駆
動輪の実際の駆動量である回転速度を求める積分回路３
２とからなる。

駆動手段■１は走行制御手段■１から与えられる駆動量
に従って、モータ４１の回転を制御するサーボ増幅１４
２と、モータ４１．クラツチ４３、ギヤ４４、駆動輪４
５等の駆動部分からなる。

ス」Ｌ別１８１」− 無人車走行中は、位置方位計測手段■１においては、２
つの独立のカウンタ回路２２Ｒ，２２Ｌが左右独立の計
測輪２１Ｒ，２１Ｌの一定時間内の回転数を計数し、演
算回路２３がこのカウンタ回路２２Ｒ，２２Ｌの計数値
から、車の現在位置方位を演算する。

走行制御手段■１においては、加速度演算回路３１が位
置方位計測手段■１から得られた車の位置方位と走行コ
ース記憶手段■１に記憶されたコースのパラメータ値と
に基づき、現在の車の状態から与えられた走行コースを
与えられた速度でより忠実に走行するために必要となる
左右駆動輪の加速度値を求め、積分回路３２がその加速
度値を積分して左右駆動輪の実際の駆動量である回転速
度を出力する。

駆動手段■１においてはサーボ増幅器４２が走行制御手
段■、から与えられる駆動量に従ってモータ４１の回転
を制御し、モータ４１の回転は、クラッチ４３、ギヤ４
４を介して、駆動輪４５に伝えられ無人車を駆動する。

回避動作指令手段ｖ１は次の作用を有する。

障害物検知装置５は、複数個の距離測定手段５１を動作
させ、位置座標演算手段５２は、障害物検知装置５から
出力された障害物の無人車に最も近い１点の座標を演算
出力する。ここで得られた障害物位置情報は、比較手段
５４で、既に障害物位置記憶装置５３に記憶されている
障害物位置と比較され、その比較結果に応じて、障害物
位置記憶装置５３は障害物位置記憶装置５３に記憶され
ている障害物位置、または新たに検知された障害物位置
に店づいて、検知動作を繰り返す毎により正確な障害物
情報が障害物位置記憶装置５３に記憶されるように演算
、メモリ操作を行なう、１回または数回の検知動作を行
なった結果、障害物位置記憶装置５３の記憶する障害物
の位置情報に変更があった場合、その障害物に対応する
車の動作が必要かを判断するために、回避必要性判定装
置６を起動し、判定される障害物の位置情報を送出する
。ここで、障害物検知装置５に記憶されている障害物位
置合てについて回避必要性判定を行なうことも考えられ
るが、既に記憶されていて、その位置情報に変更のない
障害物は、それを記憶または位置変更した時点でその障
害物に対する回避動作を行なっており、回避必要性は無
いので判定する必要はない。

回避必要性判定装置６は、障害物検知装置５の出力する
障害物位置座標（０１８（１），０ｙｉ（Ｉｔ）を入力
し、その障害物が走行コースに近く、無人車と衝突する
可能性が高く、回避する必要があるか否かを判定する。

ここでいう走行コースは無人車が既に回避状態に入って
いる場合には元の走行コースではなく走行コースとして
組み込んだ回避路となる。この処理は判定対象の障害物
位置と、今後走行予定の走行コースデータを入力し、走
行コースへの射影判別回路６１が、ある長さのコース（
線分又は円弧）に対し障害物がその領域に含まれるかを
判別し、その領域にあると判定された時、走行コースと
の距離判別回路６２が障害物と走行コースとの距離を演
算し、その距離が所定のしきい値りい以内かを判別する
ことにより行なわれる。

距離がしきい値以内の場合は回避必要性があると判断さ
れ、論理出力信号Ｓを回避動作決定装置７、減速指示装
置８へ送出し、これらを起動する。

減速指示装置８は距離算出回路８１が障害物検知装置５
から得られる障害物位置と現在の無人車の距離とを算出
し、減速度演算回路８２が距離算出回路８１の出力する
距離との位置方位計測装置■１から得られる無人車の速
度と無人車の停止性能とに基づいて走行制御装置■１に
出力する減速度を演算し、減速度ｄｅを走行制御装置■
１に出力することによって、停止、回避走行等の回避動
作を決定する回避動作決定装置７の作動中に無人車がそ
のまま走行し続け、障害物に衝突するのを防止する。

回避動作決定装置７は次の作用を存する。

回避動作決定装置７が起動されると、最初に回避の始点
演算手段１）、回避対象の障害物選択手段１５、元の走
行コース記憶手段１８が起動される。

回避の始点演算手段１）は、位置方位計測装置口、から
の無人車の現在位置（ｘ、ｙ）、方位θ、速度Ｖを入力
して、車が回避路決定処理を終えた時点に到達している
と予測される点（Ｘ、、Ｙｂ）を演算し、この点を回避
の始点位置として出力する。

回避対象の障害物選択手段１５は、障害物検知装ｒ１）
５に記憶されている障害物位置情報の中から、まず新た
に検知し、回避必要性判定装置６において回避必要と判
定された障害物の情報を選択し、回避対象の障害物記憶
手段１６に出力する。回避対象の障害物記憶手段１６は
、回避対象の障害物選択手段１５で選択された障害物を
人力し、記憶する。

次に、回避対象の障害物記憶手段１６に記憶された回避
対象の障害物に対して、回避路演算手段９、回避の終点
演算手段１２が起動される。

回避の終点演算手段１２は、後述の回避対象の障害物記
憶手段１６に記憶された障害物位置座標、元の走行コー
ス記憶装置１日に記憶された回避動作前に走行していた
走行コースを入力し、走行コースと障害物の位置関係が
第１）図に示す場合は回避の終点の演算手段（１）１２
６が、走行コースと障害物の位置関係が第１２図に示す
場合に回避の終点の演算手段（２）１２７が、走行コー
スと障害物の位置関係が第１３図に示す場合は回避の終
点の演算手段（３）１２８がそれぞれ動作し、円滑な回
避動作が行なえるような回避の終点の座標値（Ｘｉ　、
　Ｙｂ　）を演算出力する。

回避路演算手段９は回避対象の障害物（ｏｌ）に対して
回避路の演算を行なう回避路演算手段１７を起動する。

回避路演算手段１７は複数個設置された２点間回避路演
算回路の一つを次の値を入力値として与え起動する。

ｐｌ　＝回避の始点（Ｐ、） 〇　−回避対象の障害物（ＯＩ） ｐｚ　＝回避の終点（Ｐ、） 例えば第１５図に示すように回避路に干渉する障害物が
存在しない場合は、障害物の左右の回避路を演算し、適
した方が選択され出力される。この場合は、回避路演算
手段１３が出力するのは１つの回避対象の障害物に対し
て演算された１つの回避路のみなので、比較選択手段１
４は、その回避路をそのまま選択出力し、回避路組み込
み手段ｌＯはその回避路のコースデータを、走行コース
記憶装置■１に記憶させ、その回避路に沿った走行が行
なわれる。

一方、例えば第１６図に示すように回避路に干渉する障
害物（０２）が存在する場合は、まず、回避対象の障害
物選択手段１５が、その干渉した障害物を回避対象の障
害物として選択し、回避対象の障害物記憶手段１６に出
力され記憶される。

また同時に２点間回避路演算回路の処理を一旦中断し、
その干渉する障害物の存在する回避路線分の小区間での
回避路を算出するために、他の１つの２点間回避路演算
回路を次の値を入力値として与え起動する。

ｐＩ　＝干渉した区間の回避路線分の始点（Ｐｌ）〇　
−干渉した障害物（０２） ｐｔ　＝干渉した区間の回避路線分の終点（Ｐ、）ここ
で出力されたその区間での最適回避路を、中断していた
２点間回避路演算回路が入力し、全体の区間での最適回
避路を選択し出力する（第１７図参照）、これで１つの
回避対象の障害物に対する回避路演算手段１７の処理は
終了したが、この時点で、先程干渉した障害物が回避対
象の障害物として追加記憶されているため、今度はその
障害物に対して同様に回避路演算手段１７の処理が行な
われ、１つの回避路が出力される（第１８図参照）、こ
の結果、回避路演算手段１３からは２つの回避路が出力
される。比較選択手段１４は、この２つの回避路の中か
ら、最適な一つを選択するために評価関数を演算し、最
適な回避路に相当する関数値を有するような回避路を選
択する。回避路組み込み手段１０はこの回避路のコース
データを走行コース記憶装置■、に記憶させ、その回避
路に沿った走行が行われる。他の色′々な障害物の分布
状況に対しても、同様な処理によって、最適な回避路を
演算でき、これに沿った走行を射せる事ができる。

一実ｉ四漫」九皿− 上述の作用を有する本実施例装置は、障害物検知装置５
を備えることにより、過去に検知した障害物の情報を記
憶することができ、単なる一回の検知結果に比べると、
正確広範な障害物の情報を得ることができる。また、障
害物検知装置として実施例に示した前車な構造の一回の
動作で得る障害物の情報が少ない装置を用いた場合でも
、記憶装置を備えることにより、検知動作を繰り返すこ
とによって、広範な障害物の情報を得ることができる。

これにより、回避動作を行なうのに必要十分な障害物の
分布状況を得ることができる。

本実施例装置は次の装置で構成される回避動作決定装置
７を備えることによって、障害物検知装置５から入力さ
れる障害物の分布に対して、小規模な！ｊｉ置で、実用
的な処理速度で、十分な回避動作を行なわせる事ができ
る。各々の装置は以下に示す効果を存する。すなわち、
回避の始点演算手段１）、回避の終点演算手段１２、回
避路演算手段１３は、線分の連結によって構成される回
避路の１つの実用的な作成手法を実現する装置で、回避
の始点演算手段１）、回避の終点演算手段１２は回避路
の出発点と帰着点を与え、回避路演算手段１３は、この
間で障害物の位置を中心とした円を仮定し、回避の始点
、回避の終点または他の障害物を中心とした円からこの
円に引いた接線を連結して構成される回避路を演算する
。

回避対象の障害物選択手段１５、回避対象の障害物記憶
手段１６、回避路演算手段１７は実現した線分の連結に
よって構成される回避路の１つの実用的な作成手法にお
いて、障害物検知装置５に記憶されている障害物の中か
ら、その障害物との現在の走行コースとの距離、あるい
は演算中の回避路の候補との距離を算出することによっ
て回避動作を行なうのに関係する障害物だけを選択し、
回避路の無駄な演算処理を省き、実用的な処理速度を実
現する。

比較選択手段１４と、回避路演算手段１７の２点間回避
路演算回路１７１の回避路比較選択回路１７１３は、演
算出力される回避路が複数個であるため、評価関数を導
入し、その評価関数を演算し、最適な回避路に相当する
関数値を有するような回避路を選択することによって、
その中から最適な一つの回避路を選択する。この処理に
よって、ただ単に回避動作を行なうだけでなく、その場
に最も適応した回避動作を行なうことができる。

元の走行コース記憶手段１８は、回避走行する前の元の
走行コースを記憶し、既にある障害物に対する回避動作
を行なった後の回避走行中に新たに回避走行変更の必要
性が生じた時、この元の走行コースに基づいて回避の終
点を演算し、回避路作成範囲を定め、また回避路の選択
を行なうことによって、その場に最も適応した回避動作
を行なうことができる。

回避必要性判定装置６は障害物検知装置５の出力する障
害物が回避必要があるかを判定し、回避動作決定装置７
を起動する。これは前方のある領域での障害物の検知を
回避動作の起動信号とする場合に比べると次の利点を有
する０例えば、右折コースを走行時に前方に障害物が存
在しこの障害物が右折地点の先にあり回避の必要がない
場合を想定すると、障害物の検知のみを回避動作の起動
信号とする場合は、その障害物を検知すれば、無駄な回
避動作を行なってしまうか、回避必要性判定装置６を有
する場合は、走行コースに対する障害物の位置関係を判
定するため、この障害物が回避の必要のない障害物であ
ると判定でき、無駄な回避動作を防止できる。

減速指令装置８は回避動作決定装置７が作動する前に走
行制御装置３に対して減速指令を与え、回避動作決定装
ｆｆ１７が回避動作を決定してしまうまでの期間に車を
減速させ、最悪の場合にも停止し、障害物との衝突を回
避する。またここで減速を行なえば、迂回走行による回
避動作が決定された時、車の向きを変えるのが容易にな
るという利点も有する。

なお、実施例では本回避動作指令装置の構成として専用
の演算回路によるハード構成を示したが、マイクロコン
ピュータを用い、そのためのプログラムによって行なう
ことも可能であり、またプログラムの変更も容易である
こと等から、マイクロコンピュータを用いた方が実用的
に優れている。

【図面の簡単な説明】

第１図、第２図は従来技術を示す説明図、第３図は第１
の発明の概念を示す概略構成図、第４図は第２の発明を
示す概略構成図、第５図は本発明の第１の態様を示す概
略構成図、第６図は本発明の第２のｃ、様を示す概略構
成図、第７図は本発明の第３の態様を示す概略構成図、
第８図は本発明の第４のａ様を示す概略構成図、第９図
は本発明の第５の態様を示す概略構成図、第１０図は本
発明の実施例の全体を示すシステム図、第１）図、第１
２図、第１３図は回避の終点の演算手段の動作を示す平
面図、第１４図は回避路比較選択回路１７１３、比較選
択手段１４で行なわれる比較選択処理のフローチャート
、第１５図、第１６図、第１７図、第１８図は回避動作
決定装置７の動作を示す平面図である。 １・・・位置方位計測手段 ２・・・走行コース記憶装置 ３・・・走行制御装置 ４・・・駆動装置 ５・・・障害物検知装置 ６・・・回避必要性判定装置 ７・・・回避動作決定装置 ８・・・減速指示装置 ９・・・回避路作成手段 １０・・・回避路組み込み手段 １）・・・回避の始点演算手段 １２・・・回避の終点演算手段 １３・・・・回避路演算手段 １４・・・比較選択手段 １５・・・回避対象の障害物選択手段 １６・・・回避対象の障害物記憶手段 １７・・・回避対象の障害物に対する回避路演算手段１
日・・・元の走行コース記憶手段。

Claims (7)

【特許請求の範囲】
1. （１）無人車の位置方位を検知して検知した位置方位情
   報を出力する位置方位計測装置と、無人車の動作を決定
   する走行コースを記憶する記憶装置と、無人車を移動お
   よび転向させる駆動装置と、前記記憶装置に記憶された
   走行コースの情報と前記位置方位情報とを比較して前記
   駆動装置を制御するための制御量を演算する走行制御装
   置とを備え、前記走行コースに沿って自律移動する無人
   車の障害物回避動作指令装置において、 障害物の位置を検知して検知した障害物位置情報を逐次
   または記憶蓄積して出力する障害物検知装置と、 前記記憶装置に記憶された走行コースの情報と前記障害
   物検知装置から得られる障害物位置情報とに基づいて、
   障害物と走行コースとの間の距離を演算し、演算された
   距離と所定値とを比較して障害物回避動作の必要がある
   か否かを判定する回避必要性判定装置と、 前記回避必要性判定装置によって障害物回避動作の必要
   ありと判定されたとき、前記障害物検知装置から得られ
   る障害物位置情報と前記位置方位計測装置から得られる
   位置方位情報とに基づいて、障害物回避動作時の障害物
   と無人車との間の距離を考慮して無人車が障害物の存在
   地点を通過しない回避動作を決定し、決定された回避動
   作を無人車に実行させるように前記記憶手段に記憶され
   た走行コースを変更する回避動作決定装置と、を設けた
   ことを特徴とする無人車の障害物回避動作指令装置。
2. （２）無人車の位置方位を検知すると共に無人車の速度
   を演算して速度情報を含む位置方位情報を出力する位置
   方位計測装置と、無人車の動作を決定する走行コースを
   記憶する記憶装置と、無人車を移動および転向させる駆
   動装置と、前記記憶装置に記憶された走行コースの情報
   と前記位置方位情報とを比較して前記駆動装置を制御す
   るための制御量を演算する走行制御装置とを備え、前記
   走行コースに沿って自律移動する無人車の障害物回避動
   作指令装置において、 障害物の位置を検知して検知した障害物位置情報を逐次
   または記憶蓄積して出力する障害物検知装置と、 前記記憶装置に記憶された走行コースの情報と前記障害
   物検知装置から得られる障害物位置情報とに基づいて、
   障害物と走行コースとの間の距離を演算し、演算された
   距離と所定値とを比較して障害物回避動作の必要がある
   か否かを判定する回避必要性判定装置と、 前記回避必要性判定装置によって障害物回避動作の必要
   ありと判定されたとき、前記障害物検知装置から得られ
   る障害物位置情報と前記位置方位計測装置から得られる
   位置方位情報とに基づいて、障害物回避動作時の障害物
   と無人車との間の距離を考慮して無人車が障害物の存在
   地点を通過しない回避動作を決定し、決定された回避動
   作を無人車に実行させるように前記記憶手段に記憶され
   た走行コースを変更する回避動作決定装置と、前記障害
   物検知装置から得られる障害物位置情報と前記位置方位
   計測装置から得られる位置方位情報とに基づいて、障害
   物と無人車との間の距離を演算すると共に演算された距
   離と無人車の速度とに基づいて減速指令または停止指令
   を求め、前記決定された回避動作を無人車に実行させる
   前に無人車を減速または停止させるように前記走行制御
   装置へ減速指令または停止指令を出力する減速指令装置
   と、 を設けたことを特徴とする無人車の障害物回避動作指令
   装置。
3. （３）前記回避動作決定装置を、 前記回避必要性判定装置によって障害物回避動作の必要
   ありと判定されたとき前記障害物検知装置から得られる
   障害物位置情報と前記位置方位計測装置から得られる位
   置方位情報とに基づいて、障害物回避動作時の障害物と
   無人車との間の距離を考慮して無人車が障害物の存在地
   点を通過しない回避路を作成する回避路作成手段と、 前記回避路作成手段で作成された回避路の情報を既に記
   憶されている走行コースに代えて前記記憶装置に一時的
   に記憶させて、前記回避路を一時的に次に走行すべき走
   行コースとする回避路組み込み手段と、 で構成した特許請求の範囲第（１）項または第（２）項
   記載の無人車の障害物回避動作指令装置。
4. （４）前記回避路作成手段を、 前記回避路の始点を仮定して無人車が仮定された始点に
   到達するまでの予測時間と前記位置方位計測装置から得
   られる位置方位情報とに基づいて前記始点の位置座標を
   演算する回避の始点演算手段と、 前記回避路の終点を仮定して無人車が仮定された終点に
   到達するまでの予測時間と前記位置方位計測装置から得
   られる位置方位情報とに基づいて前記終点の位置座標を
   演算する回避の終点演算手段と、 前記始点の位置座標、前記終点の位置座標および前記障
   害物検知装置から得られる障害物位置情報に基づいて、
   障害物の位置を中心とする円を仮定して前記始点、前記
   終点または他の障害物の位置を中心とする円から前記仮
   定された円に引いた接線または円弧で構成される回避路
   を演算する回避路演算手段と、 で構成した特許請求の範囲第（３）項記載の無人車の障
   害物回避動作指令装置。
5. （５）前記回避動作決定装置に、評価関数を用いて前記
   回避路演算手段で演算された回避路の中から最適な１つ
   の回避路を選択する比較選択手段を設けた特許請求の範
   囲第（４）項記載の無人車の障害物回避動作指令装置。
6. （６）前記回避動作決定装置を、 回避路の始点を仮定して無人車が仮定された始点に到達
   するまでの予測時間と前記位置方位計測装置から得られ
   る位置方位情報とに基づいて前記始点の位置座標を演算
   する回避の始点演算手段と、回避路の終点を仮定して無
   人車が仮定された終点に到達するまでの予測時間と前記
   位置方位計測装置から得られる位置方位情報とに基づい
   て前記終点の位置座標を演算する回避の終点演算手段と
   、前記障害物検知装置に記憶蓄積されている障害物位置
   情報と現在の走行コースとの距離または前記障害物位置
   情報と演算中の回避路との距離を演算すると共に該距離
   と所定のしきい値とを比較し、該距離が所定のしきい値
   より小さい障害物を回避対象の障害物として選択する回
   避対象の障害物選択手段と、 前記回避対象の障害物選択手段で選択された回避対象の
   障害物の障害物位置情報を記憶する回避対象の障害物記
   憶手段と、 前記始点の位置座標、前記終点の位置座標および前記回
   避対象の障害物記憶手段に記憶された回避対象の障害物
   位置情報に基づいて、回避対象の障害物の位置を中心と
   する円を仮定して前記始点、前記終点または他の障害物
   位置を中心とする円から前記仮定された円に引いた接線
   または円弧で構成される回避路を演算する回避路演算手
   段と、で構成された特許請求の範囲第（１）項または（
   ２）項記載の無人車の障害物回避動作指令装置。
7. （７）回避走行する前の元の走行コースを記憶する元の
   走行コース記憶手段を設け、回避走行中に新たに回避走
   行変更の必要性が生じたとき、元の走行コースを回避路
   作成の指標とし、より適合した回避動作を可能にしたこ
   とを特徴とする特許請求の範囲第（１）乃至第（６）項
   記載の無人車の障害物回避動作指令装置。