JP2718033B2 - Autonomous traveling vehicle control device - Google Patents

Autonomous traveling vehicle control device

Info

Publication number
JP2718033B2
JP2718033B2 JP62200999A JP20099987A JP2718033B2 JP 2718033 B2 JP2718033 B2 JP 2718033B2 JP 62200999 A JP62200999 A JP 62200999A JP 20099987 A JP20099987 A JP 20099987A JP 2718033 B2 JP2718033 B2 JP 2718033B2
Authority
JP
Japan
Prior art keywords
vehicle
traveling
information
unit
mode
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
Application number
JP62200999A
Other languages
Japanese (ja)
Other versions
JPS6446111A (en
Inventor
千典 農宗
彰 服部
邦彦 倉見
則政 岸
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nissan Motor Co Ltd
Original Assignee
Nissan Motor Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Priority to JP62200999A priority Critical patent/JP2718033B2/en
Publication of JPS6446111A publication Critical patent/JPS6446111A/en
Application granted granted Critical
Publication of JP2718033B2 publication Critical patent/JP2718033B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Description

【発明の詳細な説明】 [発明の目的] (産業上の利用分野) 本発明は、自律走行モードで予定された走行路を自律
的に走行する自律走行車両の制御装置に関し、特に手動
走行モードにおいても自律走行モードに随時切換可能な
待機状態に維持するようにした自律走行車両の制御装置
に関する。 (従来の技術) 近年、予定された走行路を自律的に走行する自走車両
が種々提案されている。 従来のこのような自律車両では、自律走行モードによ
る走行のみならず、人を搭乗させて人の操作で車両を走
行させる、所謂手動走行モードを設けたものが開発され
ている。 (発明が解決しようとする問題点) しかしながら、手動走行モードにおいては、搭乗者が
全ての走行判断を行なうことから、コンピュータ等を内
蔵した制御部による走行判断及び関連する制御動作を全
て停止させるようにしている。 ところが、例えば自律走行モードによる自律走行の後
に搭乗者の判断による手動走行モードで走行した後、自
律走行モードに設定する場合には、現在位置情報、目的
地及び目的地までの予定走行路情報等の種々の情報を再
度与えなければならず、搭乗者にとっては非常に煩わし
いものであった。 本発明は、上記問題点に鑑みてなされたもので、手動
走行モードから容易な操作によって円滑、且つ確実に自
律走行モードへ移行することのできる自律走行車両制御
装置を提供することを目的とする。 [発明の構成] (問題点を解決するための手段) 上記目的を達成するために本発明が提供する手段は、
自車の走行に係る情報を収集する情報収集手段と、前記
収集した情報に基づいて自律的に走行する自律走行モー
ド及び手動により走行する手動走行モードを有する制御
手段と、ブレーキペダルまたはアクセルペダルが所定量
踏み込まれた場合に、自律走行モードを手動走行モード
に切り換える切換手段と、前記情報収集手段によって収
集された情報に基づいて演算を行ない前記自車の現在位
置を捕捉する捕捉手段とを設けたことを特徴とする。 (作用) 本発明は、ブレーキペダルまたはアクセルペダルが所
定量踏み込まれた場合に、自律走行モードを手動走行モ
ードに切り換え、手動走行モードに設定された場合に、
情報収集手段が情報を収集するとともに、捕捉手段が現
在位置の捕捉を行なう。これにより手動走行モードから
自律走行モードへ容易に移行させることができる。 (実施例) 以下、図面を参照して本発明の実施例を詳細に説明す
る。 第1図は本発明の要部を示したブロック図であり、第
2図は本発明に係る自律走行制御装置の全体構成を示し
たブロック図である。 まず、第2図を用いて全体的構成について説明する
と、第2図に示す自律走行車両制御装置は、カメラやセ
ンサ等で検知した進行方向の道路状況を適宜判断しなが
ら例えば設定された目的地に向かった車両を無人で自律
的に走行させるための制御を行なう装置であって、車両
の進行方向の画像を撮像して画像処理をする画像情報処
理部100と、超音波センサ、レーザレーダ等により車両
の進行方向や側方等の物体、例えば先行車、ガードレー
ル、障害物等を検知するとともに、車輪速等も検知し処
理する検知処理部200と、車両を無人で走行させるため
の車両のステアリング、アクセル、ブレーキ、ウィンカ
等を作動させるアクチュエータを有し、これらを制御す
るアクチュエータ制御部300と、目的地までの地図情報
を記憶している地図情報記憶部400と、各部からの情報
により車両を目的地に向けて障害物等に衝突しないよう
に走行させるべく前記アクチュエータ制御部300等を制
御する走行制御部500と、該走行制御部500に対して目的
地に関する情報を入力するととものに、前記画像情報処
理部100からの画像やその他の情報を表示するマンマシ
ンインタフェース部600と、非常ブレーキをかけたり、
最高速度を制限する等の機能を有する付帯制御部700
と、例えば飛行機のフライトレコーダ等のように衝突時
や非常ブレーキ等の場合の車両の各部の状況を記録する
データ収録部800とから構成されている。 前記画像情報処理部100は、2台からなる1組のカメ
ラ101、103を有する。このカメラ101、103は車両の前部
の例えば左右に設けられ、これにより車輌の進行方向の
ステレオ画像、すなわちステレオ斜視画像を撮像する。
このカメラ101、103で撮像された斜視画像は画像処理用
コンピュータ105に供給されて画像処理を施され、これ
により視差を求めて障害物の有無を判断したり、障害物
までの距離および方向を計測するために使用されたり、
また斜面画像はこの画像処理用コンピュータ105により
平面画像に変換され、すなわち逆斜視変換される。画像
処理用コンピュータ105はこの平面画像から例えば道路
上に描かれている一対の車両案内線である白線または路
側帯、センタライン等を検出して、その位置を計測す
る。 また、更に詳しくは、道路上の白線等を検出すること
により、道路と車両との相対関係、すなわち車両から左
側の白線までの距離、右側の白線までの距離、車両の進
行方向と道路のなす角度等を算出し、これらの値により
道路のカーブの方向や曲率等を求める。また、交差点の
手前においては白線の切れ方等を計測することにより交
差点までの距離を求める。 このように画像処理用コンピュータ105で求められた
距離、角度等は、ローカル自車位置推定部107に供給さ
れ、これにより道路と車両との位置関係、すなわちロー
カル自車位置を推定できるのである。なお、ローカル自
車位置とは、このように画像処理用コンピュータ105に
おける画像処理によって局部的に細く求めた自車位置を
称するものとする。また、ローカル自車位置に対して後
述するようにおおまかに求めた自車位置をグローバル自
車位置と称する。 なお、カメラは、画角を広く取るために、3組程度設
置し、切り替えて使用することにより右前方、左前方、
前方の画像から上記パラメータを得ることができる。 検知処理部200は、超音波センサ、レーザレーダ等を
使用し、車両の進行方向や側方等の物体、例えば先行
車、ガードレール、障害物等を検知するとともに、車輪
速等も検知するものであるが、これは例えば前記画像情
報処理部100による画像情報がない場合にもある程度の
走行を可能にし、これによりフェールセーフ的役割も果
そうとするものである。 検知処理部200は、車両の側方、前後左右の4ケ所に
それぞれ設けている4つの超音波センサ201、203、20
5、207を有し、これらの超音波センサ201の出力はフェ
ールセーフローカル自車位置検出部215に供給され、こ
れらのセンサによって車両と道路のガードレールとの間
隔距離を測定し、これにより前記画像情報処理部100で
求めたと同様なパラメータを計測することができる。 また、検知処理部200は車両前部に設けられ、車両の
前方等に存在する障害物等を検出するレーザレーダ209
および前方超音波センサ210を有し、これらの出力はフ
ェールセーフ障害物判断部217に供給されている。これ
らのレーザレーダ209および前方超音波センサ210は障害
物までの距離も算出し、前記画像情報処理部100のカメ
ラ101、103で認識できない場合にも、このレーザレーダ
209が障害物を検出した場合には車両の走行を一時的に
停止または減速するようになっている。 更に、検知処理部200は後輪の左右に設けられている
一対の車輪速センサ211、213を有し、これらのセンサの
出力は車輪速データ処理部218に供給され、更にこの車
輪速データ処理部218からグローバル車両位置推定部219
に供給されている。この車輪速センサ211、213は車輪の
回転を検出し、この回転に同期して車輪の1回転毎に数
千個(具体的には、1000〜4000)のパルスを左右の車輪
毎に発生する。従って、この左右の車輪毎に発生する両
パルスの数の差を取れば、走行距離の差となり、この差
から車両がカーブして走行しているか否かを判断するこ
とができる。また、左右の車輪の走行距離はそのまま車
両の走行距離となる。従って、これらの情報を時々刻々
計算することにより車両の変位を求めることができる。
具体的には、ある時点の車両の姿勢、すなわち位置を基
準とした相対的な車両の位置情報、すなわち相対的な
X、Y座標における位置およびθ等の情報を求めること
ができ、これにより走行前の車両の位置が既知であるな
らば、車輪速処理を逐次行なうことにより走行中の車両
の現在位置を常に検出することができる。但し、誤差は
累積されるので、走行距離が長くなると、計測誤差が大
きくなる。このように求められるおおよその車両の位置
がグローバル車両位置である。 アクチュエータ制御部300は、車両を無人で走行させ
るために必要な様々なアクチュエータ、すなわちステア
リングを操舵する操舵アクチュエータ301、アクセルに
対応するスロットルアクチュエータ303、ブレーキアク
チュエータ305、ウィンカ駆動部307とからなるアクチュ
エータ部306と、各アクチュエータのリンク機構を自律
走行又は手動走行用に切換えるためのアクチュエータリ
ンク切換手段308とを有し、これらの各アクチュエータ
をアクチュエータ制御部309が走行制御部500からの制御
情報に基づいて制御するようになっている。なお、車両
がAT車で前進走行のみである場合には、上述したアクチ
ュエータのみでよいが、MT車や後進の制御を行なう場合
には、クラッチやシフトレバー等の操作用アクチュエー
タ等も必要となる。アクチュエータ制御部300は走行操
舵制御部505からの加減速指令または目標車速指令を受
け、アクセルやブレーキ等を制御する。操舵制御は同様
に右または左への回転指令または目標操舵角指令を受け
て作動する。 地図情報記憶部400は、目的地に関する地図情報、目
的地までの地図情報、例えば目的地までの道路に存在す
る交差点位置、交差点間距離等の地図情報を記憶してい
る地図データ記憶部401および該地図データ記憶部401に
対して走行制御部500からのアクセスを制御する地図情
報アクセス制御部403から構成されている。 走行制御部500は、前記画像情報処理部100および検知
処理部200で検出した進行方向の道路情報を適宜判断す
るとともに地図情報記憶部400からの地図情報を参照し
ながら、マンマシンインタフェース部600から入力され
る目的地に向けて車両を走行させるべく前記アクチュエ
ータ制御部300を駆動制御するものであり、前記画像情
報処理部100の画像処理用コンピュータ105から障害物デ
ータを供給され、この障害物データに基づいて障害物の
回避方向を決定する障害物回避方向決定部501と、地図
情報記憶部400からの地図情報、検知処理部200のグロー
バル自車位置推定部219からのグローバル自車位置情
報、画像情報処理部100のローカル自車位置推定部107か
らの補正データ、マンマシンインタフェース部600から
の目的地情報等の情報を供給され、これらの情報により
目的地までの経路等を含む大局的な走行戦略情報を立案
し、この情報に従って直進、右左折、減速、加速、停止
等の走行動作に関する情報、交差点までの距離情報等の
制御情報を処理するプランナである走行指令部503と、
該走行指令部503からの制御情報、画像情報処理部100の
ローカル自車位置推定部107からの道路端からの距離、
角度等を含むローカル自車位置情報、障害物回避方向決
定部501からの障害物回避方向情報、検知処理部200の車
輪速データ処理部218からの車両の変位を含む車両姿勢
(位置)情報、検知処理部200のフェールセーフローカ
ル自車位置検出部215からの道路端からの距離、角度等
を含むローカル自車位置情報、フェールセーフ障害物判
断部217からの障害物までの距離情報、付帯制御部700か
らの情報等を供給され、これらの情報に基づいてアクチ
ュエータ制御部300の制御に必要な各種制御信号、例え
ば目標車速、目標操舵角情報等の情報をアクチュエータ
制御部300に供給し、これにより操舵制御等を行なう走
行操舵制御部505とを有する。 更に具体的には、走行指令部503はマンマシンインタ
フェース部600から目的地情報が入力されると、地図情
報記憶部400をアクセスしながら、目的地までの経路を
探索し、最短経路を決定する。そして、この決定した最
短経路の情報と車輪速センサ211、213で検出された情報
に基づいて算出されたグローバル自車位置情報とを比較
しながら走行制御情報を作成する。例えば、交差点に近
付いたときには、およその減速指令を出力したり、「あ
と何メートルで左折する」というような情報を走行操舵
制御部505に出力する。また、走行操舵制御部505におけ
るアクチュエータに対する制御はFuzzy制御等の知能制
御により行なわれる。すなわち、「if…then…」の形式
で記述されたプロダクションルールに従って制御され
る。また、障害物の回避は画像情報処理部100による障
害物までの距離と方向とに基づいてどの方向に進めばよ
いかを決定する。 マンマシンインタフェース部600は、目的地情報等を
入力するキーボード601と、目的地までの地図を表示し
たり、その他種々の情報、例えば交差点までの情報等を
表示するCRTディスプレイ603と自律走行モードと手動走
行モードとを切換える切換スイッチ604と、目的地を変
更するための変更スイッチ606と、目的地情報を入力す
るための目的地入力手段608とを有する。なお、キーボ
ード601は通常のキーボードの他、マウス、イメージス
キャナ、ディジタイザ等を併用するようにしてもよい。
また、マンマシンインタフェース部600はマンマシンイ
ンタフェースとして音声認識や音声合成装置等を有して
もよい。 付帯制御部700は、非常ブレーキアクチュエータ701を
有し、この非常ブレーキアクチュエータ701は通常走行
用のブレーキアクチュエータ305とパラレルに作動し、
安全性を向上している。この非常ブレーキアクチュエー
タ701はアンテナ705で受信した外部非常ブレーキ信号を
受信機707および制御部703を介して供給されたり、また
は車両内部に設けられている非常ブレーキスイッチ709
からの作動信号を制御部703を介して供給されると走行
制御部500の制御に関係なく作動し、車両を停止させ
る。また、付帯制御部700は最高車速リミッタ711、この
最高車速リミッタ711に対して最高車速を設定するため
の速度設定部713および最高車速リミッタ711に車両の実
際の車速情報を供給する車速センサ714を有し、速度設
定部713で設定された走行車速で走行し得るようになっ
ている。この最高車速リミッタ711は車両の乗員がゆっ
くりと走りたい場合に、その最高車速を設定するための
ものであり、この設定された最高車速情報は走行操舵制
御部505に供給され、走行操舵制御部505でこの速度を越
えないように制御される。なお、最高車速は走行指令部
503によって道路毎に設定することも可能である。ま
た、万一、設定された最高車速を越える車速が出た場合
には、車速センサ714が感知し、これにより走行制御部5
00の異常を判断し、非常ブレーキアクチュエータ701を
制御して非常ブレーキを作動させるようになっている。 データ収録部800は、フライトレコーダ等のように衝
突時、非常ブレーキ作動時等に車両の各部の状況を記憶
するためのメモリ等からなるデータ収録部801およびG
センサ803を有する。このデータ収録部801に記憶された
データに基づいて後で原因等を解明するために使用する
ものである。 次に第1図を参照して本発明の要部を説明する。第1
図において、切換スイッチ604はマンマシンインタフェ
ース600に内蔵されており、自律走行モードと手動走行
モードを切換えるための切換手段である。この切換スイ
ッチ604を切換えて自律走行モードに設定すると、情報
収集手段としての画像情報処理部100からの情報に基づ
いて自律的に走行する。また切換スイッチ604を切換え
て手動走行モードに設定すると、搭乗者の操作に基づい
て走行する。ランプ108は捕捉手段即ち、ローカル自車
位置決定部107が現在位置を捕捉したときにこのローカ
ル自車位置決定部107の出力に基づいて点灯する。従っ
てランプ108が点灯した場合は自律走行が可能である旨
を表示する。目的地を変更するための変更スイッチ606
及び目的地情報を入力するための目的地入力手段608は
マンマシンインタフェース600に内蔵されており、変更
スイッチ606が操作されると、スイッチ操作がなされた
時点における現在自車位置から、目的地入力手段608で
入力された新たな目的地へ向けて走行制御が開始され
る。操舵アクチュエータ301、スロットルアクチュエー
タ303、ブレーキアクチュエータ305等を備えたアクチュ
エータ部306及び各アクチュエータのリンク機構を自律
走行用又は手動走行用に切換えるためのアクチュエータ
リンク切換手段308は、アクチュエータ制御部300に内蔵
されており、走行制御部500からの制御指令に基づいて
制御される。 即ち、切換スイッチ604の切換に基づいて自律走行モ
ードに設定されると、走行制御部500からの指令に基づ
いてアクチュエータ部306を制御する。また切換スイッ
チ604が手動走行モード側に切換えられると、アクチュ
エータリンク切換手段308が手動用のリンク機構に切換
わり、搭乗者の操作に応じて作動する。また前述した超
音波センサ201,203,205,207、レーザレーダ209及び前方
超音波センサ210は自車の走行に係る情報を収集するた
めの情報収集手段として機能し、更にフェールセーフロ
ーカル自車位置検出部215は自車の現在位置を捕捉する
ための捕捉手段として機能する。 次に本発明の動作を説明する。 まず、第3図を参照して自律走行が開始されるまでの
処理について説明する。ステップ31で初期設定するとと
もに、切換スイッチ604を操作して自立走行モードに設
定する。ステップ33で目的地が入力されると、ステップ
35では、目的地までの経路、即ち予定走行路が探索され
る。ステップ37では前述の探索した予定走行路に基づい
て自律走行が開始される。 次に第4図を参照して自律走行モードにおける動作を
説明する。ステップ41で自律走行モードに設定される
と、ステップ42へ進み、切換スイッチ604が切換えられ
たかどうか、即ち自律走行モードから手動走行モードへ
切換えられたか否かを判断する。ステップ42で切換スイ
ッチ604が切換えられると、ステップ43へ進み手動走行
モードに設定する。また、ステップ42で切換スイッチ60
4の切換操作がなされない場合にはステップ44へ進み、
捕捉手段を駆動して現在自車位置を計算する。ステップ
45では操舵アクチュエータ301,スロットルアクチュエー
タ303,ブレーキアクチュエータ305等のアクチュエータ
部306を駆動し、予定走行路を自律的に走行する。ステ
ップ46では目的地の変更指令、即ち変更スイッチ606が
操作されたか否かを判別しており、変更スイッチ606が
操作されない場合は再びステップ42へ戻り、最初に設定
された目的地へ向けて自律走行を継続する。ステップ46
で変更スイッチ606の操作による目的地の変更指令がな
された場合にはステップ47へ進む。ステップ47で目的地
入力手段608からの新たな目的地が入力されると、ステ
ップ48へ進み、新な目的地までの経路が探索される。ス
テップ48からステップ42へ戻り、新たな目的地へ向けて
自律走行を継続する。 次に第5図を参照して手動走行モードにおける動作を
説明する。ステップ51では切換スイッチ604を操作する
ことにより、手動走行モードに設定される。このように
手動走行モードに設定されると、搭乗者の操作に基づい
て走行する。ステップ52では前述の自律走行モードに引
き続き情報収集手段及び捕捉手段を駆動して現在自車位
置を算出する。ステップ53では予定走行路、即ち前述の
自律走行時に探索された経路と現在自車位置との最短距
離Rを演算するとともに、自車の進行方向を算出する。
ステップ54では上記演算した最短距離Rが短かく、且つ
算出した進行方向と目的地へ進むべき方向とが一致して
いる場合には予定走行路を走行している旨を判別し、ス
テップ55へ進む。ステップ55ではランプ108を点灯させ
て自律走行が可能である旨を表示する。 従って、この状態で切換スイッチ604が切換えられた
場合、手動走行モードから自律走行モードへ容易に移行
する。また、ステップ54で予定走行路を走行していない
旨を判別すると、ステップ56へ進み、切換スイッチ604
による走行モードの切換操作がなされたか否かを判断す
る。ステップ56で走行モードの切換操作がなされなかっ
た場合には再びステップ52へ戻り、手動走行モードによ
る走行を継続する。ステップ56で走行モードの切換操作
がなされた場合、即ち切換スイッチ604を操作して自律
走行モードに設定された場合は、ステップ57へ進み、経
路探索のやり直しを実行する。即ち、自律走行モードに
設定された時点における位置を現在自車位置とし、この
現在自車位置から予め設定された目的地までの予定走行
路を探索する。ステップ58ではステップ57て探索した予
定走行路を自律的に走行する。 第6図は第5図に示したステップ53における予定走行
路から現在自車位置までの最短距離を演算する場合の詳
細なフローチャートである。 以下、予定走行路から現在自車位置までの最短距離の
演算について説明する。ステップ61では現在自車位置を
二次元座標上で(X0,Y0)として設定する。ステップ65
では第7図に示すように出発点から目的地までの経路を
構成する予定走行路Pjを各走行路別にP1,P2……PNとし
て表示し、各走行路P1,P2,……PNの始点及び終点及び
終点の座標をそれぞれ(Xs,Ys)及び(Xe,Ye)として
表示する。このような予定走行路Pj、即ち各走行路P1
P2……PNについて現在自車位置(X0,X0)との最短距離
Yjを求める。 第8図に示すように、走行路P1を例にとってこの走行
路P1と現在自車位置P0(X0,Y0)との最短距離Y(j=
1)を演算する場合について説明する。走行路P1の始点
Sの座標を(Xs,Ys)とし、終点Eの座標を(Xe,Ye
とすると、始点Sから終点Eまでの距離Dは以下のよう
に求められる。 次に距離Dを所定間隔d毎に分割し、始点Sから間隔
dだけ離れた位置Qdの座標を(Xd,Yd)とすると、Xd
びYdは以下のように求められる。 Xd=(d/D)×(Xe−Xs)+Xs Yd=(d/D)×(Ye−Ys)+Ys 従って、位置Qdと現在自車位置P0との距離Rdは以下の
ように求められる。 このように距離Dを所定間隔d毎に分割した各点Qと
現在自車位置P0とのそれぞれの距離Rdを求め、これらの
各点Qに対応するそれぞれの距離Rdの中で最小のものを
走行路P1と現在自車位置P0との最短距離R(j=1)と
して算出する。 以下、同様に他の走行路について最短距離を演算す
る。即ち、走行路P2,P3,……PNと現在自車位置P0との
最短距離R2,R3……RNをそれぞれ算出する。ステップ67
でこはこのように算出した各最短距離R1,R2,R3……RN
の中から最小のものを予定走行路Pj(j=1,2,…N)と
現在自車位置P0との最短距離Rとして算出する。このよ
うに最短距離Rが算出されると、ステップ69へ進み、演
算動作を停止する。 尚、前述の最短距離Rの演算においては、出発点から
目的地までの経路に存在する全ての走行路を考慮して最
短距離Rを演算するように構成したが、ランプ108が点
灯している場合、即ち自律走行可能状態である場合に
は、捕捉手段が特定の走行路上の現在自車位置を捕捉し
ていることから、現在走行中の走行路のみを考慮して最
短距離Rを演算するようにしてもよい。 また、自律走行モードによる走行中において、ウィン
カを手動で操作した場合に、次の交差点ではウィンカで
指示された方向に自律的に走行させるとともに、この交
差点の位置を現在自車位置として設定し、この新たに設
定した現在自車位置から目的地までの経路を探索して自
律走行を継続させるように構成することができる。 また、ブレーキペタル又はアクセルペタルが所定量踏
み込まれたことを検出する踏量検出手段を設け、この踏
量検出手段を自律走行モードと手動走行モードを切換え
るための切換手段として構成することができる。即ち自
律走行モードにおいて、ブレーキペタル又はアクセルペ
タルが所定量踏み込まれた時に手動操作モードへ切換え
るように構成することができる。このように構成する
と、緊急時における対策を迅速に処理することができ、
安全性の向上を図ることができる。 また、自律走行可能状態を表示するための表示手段を
設けたことにより、現在走行中の走行路が予定された走
行路であり、この予定された走行路上に存在する旨を容
易に認識することができる。 従って、例えば予定走行路を外れて手動走行モードに
より寄道等をした場合に、このような寄道の後に再び予
定走行路へ戻った時に自律走行可能状態である旨を表示
手段が表示すると、手動走行モードから自律走行モード
への切換タイミングを容易に認識することができる。 また、目的地を変更するためのスイッチ606のスイッ
チ操作がなされた時点における位置を現在自車位置とし
て再設定するとともに、この再設定された現在自車位置
から、目的地入力手段608で入力された新たな目的地へ
向けて走行制御を行なようにしたことから、目的地の変
更設定を容易に実行することができる。 [発明の効果] 以上説明してきたように本発明によれば、切換手段の
切換に応じて自律走行モードから手動走行モードへ切換
えられた場合においても、引き続き情報収集手段が自車
の走行に係る情報を収集するとともに、捕捉手段が現在
位置を捕捉することにより、自律走行モードに随時切換
可能な待機状態として維持することができ、従って手動
走行モードから自律走行モードへ容易に移行させること
ができる。
Description: Object of the Invention (Industrial application field) The present invention relates to a control device for an autonomous traveling vehicle that autonomously travels on a planned traveling path in an autonomous traveling mode, and particularly to a manual traveling mode. The present invention also relates to a control device for an autonomous traveling vehicle which is maintained in a standby state which can be switched to an autonomous traveling mode at any time. (Prior Art) In recent years, various types of self-propelled vehicles that autonomously travel on a planned traveling road have been proposed. In such a conventional autonomous vehicle, not only an autonomous traveling mode but also a so-called manual traveling mode in which a person is boarded and the vehicle travels by a human operation is provided. (Problems to be Solved by the Invention) However, in the manual traveling mode, since the occupant makes all traveling judgments, all traveling judgments and related control operations by a control unit incorporating a computer or the like are stopped. I have to. However, for example, after driving in the manual driving mode determined by the passenger after the autonomous driving in the autonomous driving mode, if the autonomous driving mode is set, the current position information, the destination and information on the planned driving route to the destination, etc. This information must be given again, which is very troublesome for the passenger. SUMMARY OF THE INVENTION The present invention has been made in view of the above problems, and has as its object to provide an autonomous traveling vehicle control device capable of smoothly and surely shifting to an autonomous traveling mode by a simple operation from a manual traveling mode. . [Structure of the Invention] (Means for Solving the Problems) Means provided by the present invention to achieve the above object are:
Information collecting means for collecting information related to the travel of the own vehicle, control means having an autonomous driving mode for autonomously driving based on the collected information and a manual driving mode for manually driving, and a brake pedal or an accelerator pedal. Switching means for switching the autonomous traveling mode to the manual traveling mode when the vehicle is depressed by a predetermined amount, and capturing means for performing a calculation based on the information collected by the information collecting means and capturing a current position of the own vehicle are provided. It is characterized by having. (Operation) The present invention switches the autonomous traveling mode to the manual traveling mode when the brake pedal or the accelerator pedal is depressed by a predetermined amount, and sets the autonomous traveling mode to the manual traveling mode.
The information collecting means collects information, and the capturing means captures the current position. Thereby, it is possible to easily shift from the manual traveling mode to the autonomous traveling mode. (Example) Hereinafter, an example of the present invention will be described in detail with reference to the drawings. FIG. 1 is a block diagram showing a main part of the present invention, and FIG. 2 is a block diagram showing an entire configuration of an autonomous traveling control device according to the present invention. First, the overall configuration will be described with reference to FIG. 2. The autonomous traveling vehicle control device shown in FIG. 2 appropriately determines a road condition in a traveling direction detected by a camera, a sensor, or the like, for example, to a set destination. An image processing unit 100 that performs control for autonomously and autonomously traveling a vehicle headed for a vehicle, capturing an image in the traveling direction of the vehicle and performing image processing, an ultrasonic sensor, a laser radar, and the like. By detecting objects such as the traveling direction and the side of the vehicle, such as a preceding vehicle, a guardrail, an obstacle, and the like, and also detecting and processing wheel speeds and the like, and a vehicle for traveling the vehicle unmanned. Actuator control unit 300 that has actuators for operating steering, accelerator, brake, blinker, etc., and controls these, and map information storage that stores map information to the destination 400, a travel control unit 500 that controls the actuator control unit 300 and the like so that the vehicle travels toward the destination so as not to collide with an obstacle or the like based on information from each unit. Along with inputting information about the ground, and a man-machine interface unit 600 that displays images and other information from the image information processing unit 100,
Auxiliary control unit 700 with functions such as limiting the maximum speed
And a data recording unit 800 that records the status of each part of the vehicle in the event of a collision or emergency braking, such as an airplane flight recorder. The image information processing unit 100 has a set of two cameras 101 and 103. The cameras 101 and 103 are provided, for example, on the left and right of the front part of the vehicle, and capture a stereo image in the traveling direction of the vehicle, that is, a stereo perspective image.
The oblique images captured by the cameras 101 and 103 are supplied to an image processing computer 105 and subjected to image processing, whereby parallax is determined to determine the presence or absence of an obstacle, and the distance and direction to the obstacle are determined. Used to measure,
Further, the slope image is converted into a planar image by the image processing computer 105, that is, the image is converted into an inverse perspective. The image processing computer 105 detects, for example, a white line or a roadside zone, a center line, or the like, which is a pair of vehicle guide lines drawn on a road, from the planar image, and measures the position. More specifically, by detecting a white line or the like on the road, the relative relationship between the road and the vehicle, that is, the distance from the vehicle to the left white line, the distance to the right white line, the traveling direction of the vehicle and the connection between the road and the road. The angle and the like are calculated, and the direction and curvature of the curve of the road are obtained from these values. Before the intersection, the distance to the intersection is determined by measuring how the white line is cut. The distance, the angle, and the like obtained by the image processing computer 105 are supplied to the local vehicle position estimating unit 107, whereby the positional relationship between the road and the vehicle, that is, the local vehicle position can be estimated. It should be noted that the local vehicle position refers to the vehicle position locally narrowly obtained by the image processing in the image processing computer 105 as described above. In addition, the host vehicle position roughly determined as described later with respect to the local host vehicle position is referred to as a global host vehicle position. In addition, in order to take a wide angle of view, about three sets of cameras are installed and switched to be used, so that the right front, the left front,
The above parameters can be obtained from the image in front. The detection processing unit 200 uses an ultrasonic sensor, a laser radar, and the like, and detects an object such as a traveling direction or a side, such as a preceding vehicle, a guardrail, and an obstacle, and also detects a wheel speed and the like. However, this makes it possible to run to some extent even when there is no image information from the image information processing unit 100, thereby trying to fulfill a fail-safe role. The detection processing unit 200 includes four ultrasonic sensors 201, 203, and 20 provided at four locations on the side, front, rear, left, and right of the vehicle.
The outputs of these ultrasonic sensors 201 are supplied to a fail-safe local host vehicle position detecting unit 215, which measures the distance between the vehicle and the guardrail on the road, thereby obtaining the image. The same parameters as those obtained by the information processing unit 100 can be measured. The detection processing unit 200 is provided at the front of the vehicle, and detects an obstacle or the like existing in front of the vehicle.
And a forward ultrasonic sensor 210, and the outputs thereof are supplied to a fail-safe obstacle determination unit 217. The laser radar 209 and the front ultrasonic sensor 210 also calculate the distance to the obstacle, and even when the laser information cannot be recognized by the cameras 101 and 103 of the image information processing unit 100, the laser radar
When the 209 detects an obstacle, the running of the vehicle is temporarily stopped or decelerated. Further, the detection processing unit 200 has a pair of wheel speed sensors 211 and 213 provided on the left and right of the rear wheel, and the outputs of these sensors are supplied to a wheel speed data processing unit 218, which further processes the wheel speed data. Unit 218 to Global Vehicle Position Estimation Unit 219
Is supplied to The wheel speed sensors 211 and 213 detect the rotation of the wheel, and generate thousands (specifically, 1000 to 4000) of pulses for each of the right and left wheels every one rotation of the wheel in synchronization with the rotation. . Therefore, if the difference between the numbers of the two pulses generated for each of the left and right wheels is calculated, the difference in the traveling distance is obtained. From this difference, it can be determined whether or not the vehicle is traveling in a curve. The traveling distance of the left and right wheels is the traveling distance of the vehicle as it is. Therefore, the displacement of the vehicle can be obtained by calculating these information every moment.
More specifically, the attitude of the vehicle at a certain point in time, that is, relative position information of the vehicle with reference to the position, that is, information such as relative position in X and Y coordinates and θ can be obtained. If the position of the preceding vehicle is known, the current position of the running vehicle can be always detected by sequentially performing the wheel speed processing. However, since errors are accumulated, the measurement error increases as the traveling distance increases. The approximate vehicle position determined in this way is the global vehicle position. The actuator control unit 300 includes various actuators necessary for running the vehicle unattended, that is, an actuator unit including a steering actuator 301 for steering, a throttle actuator 303 corresponding to an accelerator, a brake actuator 305, and a blinker driving unit 307. 306, and actuator link switching means 308 for switching the link mechanism of each actuator to autonomous traveling or manual traveling, and these actuators are controlled by the actuator control unit 309 based on control information from the traveling control unit 500. Control. When the vehicle is an AT car and only runs forward, only the above-described actuator may be used, but when controlling an MT car or a reverse movement, an actuator for operation such as a clutch or a shift lever is also required. . The actuator control unit 300 receives an acceleration / deceleration command or a target vehicle speed command from the traveling steering control unit 505, and controls an accelerator, a brake, and the like. The steering control is similarly operated upon receiving a rotation command to the right or left or a target steering angle command. The map information storage unit 400 includes a map data storage unit 401 storing map information on the destination, map information to the destination, for example, map information such as an intersection position existing on a road to the destination, an intersection distance, and the like. A map information access control unit 403 controls access to the map data storage unit 401 from the travel control unit 500. The traveling control unit 500 determines the road information of the traveling direction detected by the image information processing unit 100 and the detection processing unit 200 as appropriate and refers to the map information from the map information storage unit 400, and outputs the information from the man-machine interface unit 600. The actuator control unit 300 is driven and controlled to drive the vehicle toward the input destination, and obstacle data is supplied from the image processing computer 105 of the image information processing unit 100. An obstacle avoiding direction determining unit 501 that determines an avoiding direction of an obstacle based on the map information from the map information storage unit 400, the global own vehicle position information from the global own vehicle position estimating unit 219 of the detection processing unit 200, Correction data from the local vehicle position estimating unit 107 of the image information processing unit 100 and information such as destination information from the man-machine interface unit 600 are supplied. Develops global driving strategy information including the route to the destination, etc., and processes control information such as information on driving operations such as straight ahead, right / left turn, deceleration, acceleration, and stop, and distance information to intersections according to this information. A driving command unit 503, which is a planner to
The control information from the travel command unit 503, the distance from the road edge from the local vehicle position estimation unit 107 of the image information processing unit 100,
Local own vehicle position information including an angle and the like; obstacle avoiding direction information from the obstacle avoiding direction determining unit 501; vehicle posture (position) information including vehicle displacement from the wheel speed data processing unit 218 of the detection processing unit 200; Local vehicle position information including the distance and angle from the road edge from the fail-safe local vehicle position detection unit 215 of the detection processing unit 200, distance information to the obstacle from the fail-safe obstacle determination unit 217, incidental control The control section 300 is supplied with information and the like from the section 700, and supplies various control signals necessary for controlling the actuator control section 300 based on the information, for example, information such as target vehicle speed and target steering angle information to the actuator control section 300. And a traveling steering control unit 505 for performing steering control and the like by the control unit. More specifically, when destination information is input from the man-machine interface unit 600, the travel command unit 503 searches for a route to the destination while accessing the map information storage unit 400, and determines the shortest route. . Then, travel control information is created while comparing the determined information on the shortest route with the global vehicle position information calculated based on the information detected by the wheel speed sensors 211 and 213. For example, when approaching an intersection, the vehicle outputs an approximate deceleration command or outputs information such as "how many meters to turn left" to the traveling steering control unit 505. Control of the actuator in the traveling steering control unit 505 is performed by intelligent control such as fuzzy control. That is, it is controlled in accordance with the production rules described in the format of "if ... then ...". In addition, the direction of the obstacle avoidance is determined based on the distance and the direction to the obstacle by the image information processing unit 100. The man-machine interface unit 600 includes a keyboard 601 for inputting destination information and the like, a CRT display 603 for displaying a map to the destination and displaying various other information, for example, information to an intersection, and an autonomous driving mode. It has a changeover switch 604 for switching between a manual driving mode, a changeover switch 606 for changing a destination, and a destination input means 608 for inputting destination information. The keyboard 601 may use a mouse, an image scanner, a digitizer, and the like in addition to a normal keyboard.
Further, the man-machine interface unit 600 may include a speech recognition or speech synthesis device as a man-machine interface. The auxiliary control unit 700 has an emergency brake actuator 701, and the emergency brake actuator 701 operates in parallel with the brake actuator 305 for normal traveling,
Improves safety. The emergency brake actuator 701 is supplied with an external emergency brake signal received by the antenna 705 via the receiver 707 and the control unit 703, or an emergency brake switch 709 provided inside the vehicle.
When the operation signal is supplied from the control unit 703 via the control unit 703, it operates regardless of the control of the travel control unit 500, and stops the vehicle. Further, the auxiliary control unit 700 includes a maximum vehicle speed limiter 711, a speed setting unit 713 for setting the maximum vehicle speed for the maximum vehicle speed limiter 711, and a vehicle speed sensor 714 for supplying the actual vehicle speed information to the maximum vehicle speed limiter 711. And can travel at the traveling vehicle speed set by the speed setting unit 713. This maximum vehicle speed limiter 711 is for setting the maximum vehicle speed when the occupant of the vehicle wants to run slowly, and the set maximum vehicle speed information is supplied to the traveling steering control unit 505, and the traveling steering control unit At 505, control is performed so as not to exceed this speed. The maximum vehicle speed is determined by the driving command section.
503 can be set for each road. If the vehicle speed exceeds the set maximum vehicle speed, the vehicle speed sensor 714 detects the vehicle speed.
The emergency brake actuator 701 is controlled by operating the emergency brake actuator 701 so as to operate the emergency brake. The data recording unit 800 includes a data recording unit 801 and a G that include a memory or the like for storing the status of each part of the vehicle at the time of a collision, emergency braking, etc., such as a flight recorder.
It has a sensor 803. It is used for later elucidating the cause or the like based on the data stored in the data recording unit 801. Next, the essential parts of the present invention will be described with reference to FIG. First
In the figure, a changeover switch 604 is built in the man-machine interface 600 and is a switching means for switching between an autonomous traveling mode and a manual traveling mode. When the changeover switch 604 is switched to set to the autonomous traveling mode, the vehicle travels autonomously based on information from the image information processing unit 100 as information collecting means. When the changeover switch 604 is switched to set to the manual traveling mode, the vehicle travels based on the operation of the passenger. The lamp 108 is turned on based on the output of the local vehicle position determining unit 107 when the capturing means, that is, the local vehicle position determining unit 107 captures the current position. Therefore, when the lamp 108 is turned on, it indicates that autonomous traveling is possible. Change switch 606 to change destination
The destination input means 608 for inputting destination information is incorporated in the man-machine interface 600. When the change switch 606 is operated, the destination input is performed from the current vehicle position at the time when the switch operation is performed. Travel control is started toward the new destination input by means 608. An actuator unit 306 including a steering actuator 301, a throttle actuator 303, a brake actuator 305, and the like, and an actuator link switching unit 308 for switching a link mechanism of each actuator between autonomous traveling and manual traveling are built in the actuator control unit 300. It is controlled based on a control command from the traveling control unit 500. That is, when the autonomous traveling mode is set based on the switching of the changeover switch 604, the actuator unit 306 is controlled based on a command from the traveling control unit 500. When the changeover switch 604 is switched to the manual traveling mode, the actuator link switching means 308 is switched to a manual link mechanism, and operates according to the operation of the occupant. The above-described ultrasonic sensors 201, 203, 205, 207, the laser radar 209, and the front ultrasonic sensor 210 function as information collecting means for collecting information related to the traveling of the own vehicle. Functions as a capturing unit for capturing the current position of the. Next, the operation of the present invention will be described. First, a process until the autonomous traveling is started will be described with reference to FIG. Initial setting is made in step 31, and the changeover switch 604 is operated to set the self-sustained traveling mode. When the destination is entered in step 33, step
At 35, a route to the destination, that is, a planned traveling route is searched. In step 37, autonomous traveling is started based on the above-described planned traveling path. Next, the operation in the autonomous driving mode will be described with reference to FIG. When the autonomous traveling mode is set in step 41, the process proceeds to step 42, where it is determined whether or not the changeover switch 604 has been switched, that is, whether or not the autonomous traveling mode has been switched to the manual traveling mode. When the changeover switch 604 is switched in step 42, the process proceeds to step 43 and the mode is set to the manual traveling mode. In step 42, the changeover switch 60
If the switching operation of step 4 is not performed, proceed to step 44,
The current vehicle position is calculated by driving the capturing means. Steps
At 45, the actuator units 306 such as the steering actuator 301, the throttle actuator 303, and the brake actuator 305 are driven to autonomously travel on the planned traveling path. In step 46, it is determined whether or not the destination change command, that is, the change switch 606 has been operated. If the change switch 606 has not been operated, the process returns to step 42 again, and the autonomous operation is performed toward the initially set destination. Continue running. Step 46
If the destination change command is issued by operating the change switch 606, the process proceeds to step 47. When a new destination is input from the destination input means 608 in step 47, the process proceeds to step 48, where a route to the new destination is searched. Returning from step 48 to step 42, the autonomous driving to the new destination is continued. Next, the operation in the manual traveling mode will be described with reference to FIG. In step 51, by operating the changeover switch 604, the mode is set to the manual traveling mode. When the vehicle is set to the manual traveling mode, the vehicle travels based on the operation of the passenger. In step 52, the information collection means and the capture means are driven following the autonomous driving mode to calculate the current vehicle position. In step 53, the shortest distance R between the planned traveling route, that is, the route searched during the autonomous traveling and the current position of the vehicle is calculated, and the traveling direction of the vehicle is calculated.
In step 54, if the calculated minimum distance R is short and the calculated traveling direction matches the direction to go to the destination, it is determined that the vehicle is traveling on the planned traveling path, and the flow proceeds to step 55. move on. In step 55, the lamp 108 is turned on to display that autonomous traveling is possible. Therefore, when the changeover switch 604 is switched in this state, the mode easily shifts from the manual driving mode to the autonomous driving mode. If it is determined in step 54 that the vehicle is not traveling on the planned traveling route, the process proceeds to step 56, where the changeover switch 604
It is determined whether or not the driving mode switching operation has been performed. If the driving mode switching operation has not been performed in step 56, the process returns to step 52 again, and the traveling in the manual traveling mode is continued. If the driving mode switching operation is performed in step 56, that is, if the autonomous driving mode is set by operating the changeover switch 604, the process proceeds to step 57, and the route search is performed again. That is, the position at the time point when the autonomous driving mode is set is set as the current own vehicle position, and a planned traveling route from the current own vehicle position to a preset destination is searched. In step 58, the vehicle travels autonomously on the planned traveling path searched in step 57. FIG. 6 is a detailed flowchart for calculating the shortest distance from the planned traveling road to the current vehicle position in step 53 shown in FIG. Hereinafter, the calculation of the shortest distance from the planned traveling path to the current vehicle position will be described. In step 61, the current vehicle position is set as (X 0 , Y 0 ) on two-dimensional coordinates. Step 65
Then, as shown in FIG. 7, the planned traveling paths Pj constituting the route from the starting point to the destination are displayed as P 1 , P 2 ... PN for each traveling path, and the respective traveling paths P 1 , P 2 , ...... P N of the start point and the end point and the end point of the coordinates, respectively (X s, Y s) and (X e, Y e) to display as. Such a planned traveling path Pj, that is, each traveling path P 1 ,
P 2 …… P N is the shortest distance from the current vehicle position (X 0 , X 0 )
Find Yj. As shown in FIG. 8, the travel path P 1 the travel path P 1 and the current vehicle position P 0 for example (X 0, Y 0) shortest distance between Y (j =
The case of calculating 1) will be described. Coordinates (X s, Y s) of the starting point S of the traveling path P 1 and the coordinates of the end point E (X e, Y e)
Then, the distance D from the start point S to the end point E is obtained as follows. Then the distance D is divided at predetermined intervals d, the coordinates of the position Q d away from the start point S by a distance d (X d, Y d) When, X d and Y d is determined as follows. X d = (d / D) × (X e −X s ) + X s Y d = (d / D) × (Y e −Y s ) + Y s Therefore, the difference between the position Q d and the current vehicle position P 0 is obtained. The distance Rd is obtained as follows. Minimum in this way the distance D to determine the respective distances R d and a predetermined distance d for each point Q and the current vehicle position P 0 obtained by dividing the respective distances R d where these correspond to the points Q to those with roadway P 1 calculated current as the shortest distance R (j = 1) of the vehicle position P 0. Hereinafter, the shortest distance is similarly calculated for the other traveling paths. That is, the running path P 2, P 3, ...... P N and the current minimum distance R 2 between the vehicle position P 0, R 3 ...... R N to be calculated. Step 67
Each of the shortest distances R 1 , R 2 , R 3 …… R N
Planned traveling path Pj the smallest among the (j = 1,2, ... N) and is calculated as the shortest distance R between the current vehicle position P 0. When the shortest distance R is calculated as described above, the process proceeds to step 69, and the calculation operation is stopped. In the calculation of the shortest distance R described above, the shortest distance R is calculated in consideration of all running paths existing on the route from the starting point to the destination, but the lamp 108 is turned on. In the case, that is, when the vehicle is in the autonomous traveling enabled state, since the capturing means has captured the current position of the vehicle on the specific traveling road, the shortest distance R is calculated in consideration of only the traveling road currently traveling. You may do so. In addition, while driving in the autonomous driving mode, when the blinker is manually operated, at the next intersection, while autonomously traveling in the direction indicated by the blinker, the position of this intersection is set as the current vehicle position, It can be configured to search for a route from the newly set current vehicle position to the destination and continue autonomous traveling. Further, it is possible to provide a tread amount detecting means for detecting that the brake petal or the accelerator petal is depressed by a predetermined amount, and to configure the tread amount detecting means as a switching means for switching between the autonomous traveling mode and the manual traveling mode. That is, in the autonomous traveling mode, it can be configured to switch to the manual operation mode when the brake petal or the accelerator petal is depressed by a predetermined amount. With this configuration, emergency measures can be promptly processed,
Safety can be improved. Further, by providing the display means for displaying the autonomous traveling enabled state, it is possible to easily recognize that the currently traveling traveling path is the planned traveling path and exists on the planned traveling path. Can be. Therefore, for example, when the vehicle deviates from the planned traveling route and makes a detour in the manual traveling mode, when the display means displays the autonomous traveling enabled state when returning to the planned traveling route again after such a detour, The switching timing from the manual driving mode to the autonomous driving mode can be easily recognized. Further, the position at the time when the switch of the switch 606 for changing the destination is operated is reset as the current own vehicle position, and the destination input means 608 inputs the position from the reset current own vehicle position. Since the travel control is performed for the new destination, the change setting of the destination can be easily executed. [Effects of the Invention] As described above, according to the present invention, even when the mode is switched from the autonomous traveling mode to the manual traveling mode in accordance with the switching of the switching unit, the information collecting unit continues to operate according to the traveling of the own vehicle. By collecting the information and capturing the current position by the capturing means, it is possible to maintain a standby state that can be switched to the autonomous driving mode at any time, and therefore, it is possible to easily shift from the manual driving mode to the autonomous driving mode. .

【図面の簡単な説明】 第1図は本発明の要部を示したブロック図、第2図は本
発明に係る自律走行車両制御装置の全体構成を示したブ
ロック図、第3図は自律走行が開始されるまでの処理に
ついて示したフローチャート、第4図は自律走行モード
における制御動作を示したフローチャート、第5図は手
動走行モードにおける制御動作を示したフローチャー
ト、第6図は第5図に示した最短距離を演算する場合の
詳細なフローチャート、第7図は出発点から目的地まで
の経路に存在する予定走行路を各走行路別に示した説明
図、第8図は特定の走行路と現在自車位置との最短距離
を演算する場合の説明図である。 107……ローカル自車位置決定部 108……ランプ 306……アクチュエータ部 308……アクチュエータリンク切換手段 500……走行制御部 604,606……スイッチ 608……目的地入力手段
BRIEF DESCRIPTION OF THE DRAWINGS FIG. 1 is a block diagram showing a main part of the present invention, FIG. 2 is a block diagram showing an entire configuration of an autonomous traveling vehicle control device according to the present invention, and FIG. FIG. 4 is a flowchart showing a control operation in an autonomous driving mode, FIG. 5 is a flowchart showing a control operation in a manual driving mode, and FIG. 6 is a flowchart showing a control operation in a manual driving mode. FIG. 7 is a detailed flowchart for calculating the indicated shortest distance, FIG. 7 is an explanatory diagram showing the planned traveling routes existing on the route from the starting point to the destination for each traveling route, and FIG. FIG. 7 is an explanatory diagram in a case where a shortest distance from a current vehicle position is calculated. 107 Local vehicle position determination unit 108 Lamp 306 Actuator unit 308 Actuator link switching unit 500 Travel control units 604, 606 Switch 608 Destination input unit

───────────────────────────────────────────────────── フロントページの続き (72)発明者 岸 則政 神奈川県横浜市神奈川区宝町2番地 日 産自動車株式会社内 (56)参考文献 特開 昭62−131309(JP,A) 特開 昭63−7705(JP,A) 特開 昭55−102730(JP,A)   ────────────────────────────────────────────────── ─── Continuation of front page    (72) Inventor Norimishi Kishi               2 Takaracho, Kanagawa-ku, Yokohama-shi, Kanagawa Sun               Industrial Motor Co., Ltd.                (56) References JP-A-62-131309 (JP, A)                 JP-A-63-7705 (JP, A)                 JP-A-55-102730 (JP, A)

Claims (1)

(57)【特許請求の範囲】 1.自車の走行に係る情報を収集する情報収集手段と、 前記収集した情報に基づいて自律的に走行する自律走行
モード及び手動により走行する手動走行モードを有する
制御手段と、 ブレーキペダルまたはアクセルペダルが所定量踏み込ま
れた場合に、自律走行モードを手動走行モードに切換え
る切換手段と、 前記情報収集手段によって収集された情報に基づいて演
算を行ない前記自車の現在位置を捕捉する捕捉手段とを
有することを特徴とする自律走行車両制御装置。 2.前記捕捉手段は、自車の現在位置を捕捉したときに
自律走行可能状態を表示する表示手段を備えたことを特
徴とする特許請求の範囲第1項記載の自律走行車両制御
装置。
(57) [Claims] Information collecting means for collecting information relating to the travel of the vehicle, control means having an autonomous driving mode for autonomously driving based on the collected information and a manual driving mode for manually driving, and a brake pedal or an accelerator pedal. A switching unit that switches the autonomous traveling mode to the manual traveling mode when the vehicle is depressed by a predetermined amount; and a capturing unit that performs a calculation based on the information collected by the information collecting unit and captures a current position of the vehicle. An autonomous traveling vehicle control device, characterized in that: 2. 2. The autonomous traveling vehicle control device according to claim 1, wherein the acquisition unit includes a display unit that displays an autonomous traveling enabled state when the current position of the own vehicle is acquired.
JP62200999A 1987-08-13 1987-08-13 Autonomous traveling vehicle control device Expired - Fee Related JP2718033B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP62200999A JP2718033B2 (en) 1987-08-13 1987-08-13 Autonomous traveling vehicle control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP62200999A JP2718033B2 (en) 1987-08-13 1987-08-13 Autonomous traveling vehicle control device

Publications (2)

Publication Number Publication Date
JPS6446111A JPS6446111A (en) 1989-02-20
JP2718033B2 true JP2718033B2 (en) 1998-02-25

Family

ID=16433822

Family Applications (1)

Application Number Title Priority Date Filing Date
JP62200999A Expired - Fee Related JP2718033B2 (en) 1987-08-13 1987-08-13 Autonomous traveling vehicle control device

Country Status (1)

Country Link
JP (1) JP2718033B2 (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20150133291A (en) * 2013-04-05 2015-11-27 구글 인코포레이티드 Systems and methods for transitioning control of an autonomous vehicle to a driver
KR20160127492A (en) * 2015-04-27 2016-11-04 엘지전자 주식회사 Display apparatus and method for controlling the same
KR20220138892A (en) * 2021-04-06 2022-10-14 주식회사 영동농기계 Autonomous driving type electric convenience work machine

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FI64813C (en) * 1980-12-31 1984-01-10 Ilkka Antero Palva FOERFARANDE FOER PRODUCERING AV ETT UTVALT AEGGVITEAEMNE OCH VID FOERFARANDET ANVAENDA REKOMBINANTPLASMIDVEKTORER
JP3263407B2 (en) * 1991-06-12 2002-03-04 ヤンマーディーゼル株式会社 Cart speed control mechanism
JP3239727B2 (en) * 1995-12-05 2001-12-17 トヨタ自動車株式会社 Automatic driving control device for vehicles
JP4178577B2 (en) * 1998-02-17 2008-11-12 株式会社明電舎 Automatic vehicle and automatic vehicle navigation system
JP3928537B2 (en) * 2002-10-07 2007-06-13 株式会社デンソー Car navigation system
US8078338B2 (en) 2004-10-22 2011-12-13 Irobot Corporation System and method for behavior based control of an autonomous vehicle
US7499776B2 (en) 2004-10-22 2009-03-03 Irobot Corporation Systems and methods for control of an unmanned ground vehicle
DE102005050310A1 (en) * 2004-10-22 2006-06-08 Irobot Corp., Burlington Systems and methods for controlling a vehicle
US10178740B2 (en) * 2015-02-05 2019-01-08 Philips Lighting Holding B.V. Road lighting
JP7108814B2 (en) 2017-06-13 2022-07-29 パナソニックIpマネジメント株式会社 DRIVING ASSIST METHOD, DRIVING ASSISTANCE PROGRAM, AND VEHICLE CONTROL DEVICE
EP3726329A4 (en) * 2017-12-12 2021-01-27 Sony Corporation Information processing device, moving body, control system, information processing method, and program
WO2020142717A1 (en) * 2019-01-04 2020-07-09 Cerence Operating Company Methods and systems for increasing autonomous vehicle safety and flexibility using voice interaction

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5657102A (en) * 1979-10-17 1981-05-19 Iseki & Co Ltd Automatic control system of farming machine
JPS62131309A (en) * 1985-12-03 1987-06-13 Shinko Electric Co Ltd Travel control method for autonomous traveling robot

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20150133291A (en) * 2013-04-05 2015-11-27 구글 인코포레이티드 Systems and methods for transitioning control of an autonomous vehicle to a driver
CN105264450A (en) * 2013-04-05 2016-01-20 谷歌公司 Systems and methods for transitioning control of an autonomous vehicle to a driver
KR101688762B1 (en) * 2013-04-05 2016-12-21 구글 인코포레이티드 Systems and methods for transitioning control of an autonomous vehicle to a driver
KR20160127492A (en) * 2015-04-27 2016-11-04 엘지전자 주식회사 Display apparatus and method for controlling the same
CN106080389A (en) * 2015-04-27 2016-11-09 Lg电子株式会社 Display device and control method thereof
KR101687543B1 (en) * 2015-04-27 2016-12-19 엘지전자 주식회사 Display apparatus and method for controlling the same
CN106080389B (en) * 2015-04-27 2018-12-04 Lg电子株式会社 Show equipment and its control method
US10144289B2 (en) 2015-04-27 2018-12-04 Lg Electronics Inc. Display apparatus and method for controlling the same
KR20220138892A (en) * 2021-04-06 2022-10-14 주식회사 영동농기계 Autonomous driving type electric convenience work machine
KR102569580B1 (en) * 2021-04-06 2023-08-24 주식회사 영동농기계 Autonomous driving type electric convenience work machine

Also Published As

Publication number Publication date
JPS6446111A (en) 1989-02-20

Similar Documents

Publication Publication Date Title
US11845473B2 (en) Autonomous driving apparatus including a driving state switcher
US11809194B2 (en) Target abnormality determination device
JP2718033B2 (en) Autonomous traveling vehicle control device
CN109426260B (en) Automatic driving device
US8170739B2 (en) Path generation algorithm for automated lane centering and lane changing control system
JPS63314618A (en) Controller for self-traveling vehicle
US11433897B2 (en) Method and apparatus for determination of optimal cruising lane in an assisted driving system
US11285957B2 (en) Traveling control apparatus, traveling control method, and non-transitory computer-readable storage medium storing program
JP2021151815A (en) Parking support device, parking support system, and parking support method
JP2020056733A (en) Vehicle control device
WO2021033632A1 (en) Vehicle control method and vehicle control device
JP6772940B2 (en) Autonomous driving system
JP2658056B2 (en) Autonomous traveling vehicle control device
JP2819551B2 (en) Autonomous traveling vehicle control device
JP2668882B2 (en) Autonomous traveling vehicle control device
JP2578120B2 (en) Road shape recognition device
JP2578119B2 (en) Road shape recognition device
JP2549661B2 (en) Autonomous vehicle control device
JP2511851Y2 (en) Autonomous vehicle
Taniguchi et al. The development of autonomously controlled vehicle, PVS
JPH087446Y2 (en) Autonomous vehicle
JPS63314622A (en) Controller for self-traveling vehicle
WO2023058344A1 (en) Vehicle control device
JP7429111B2 (en) Traffic control equipment and vehicle control equipment
US20220315050A1 (en) Vehicle control device, route generation device, vehicle control method, route generation method, and storage medium

Legal Events

Date Code Title Description
LAPS Cancellation because of no payment of annual fees