JP3770975B2

JP3770975B2 - Self-driving car

Info

Publication number: JP3770975B2
Application number: JP25156996A
Authority: JP
Inventors: 功植松
Original assignee: Honda Motor Co Ltd
Current assignee: Honda Motor Co Ltd
Priority date: 1995-10-31
Filing date: 1996-09-24
Publication date: 2006-04-26
Anticipated expiration: 2016-09-24
Also published as: JPH09183319A

Description

【０００１】
【発明の属する技術分野】
本発明は自動走行車、特に前走車との車間距離を制御しつつ該前走車を自動追従走行する自動走行車に関するものである。
【０００２】
【従来の技術】
従来、レーダ、CCD カメラ及び、それらの組合せにより、障害物を検出しながら前方障害物や前方の道路状況等を認識し、自動運転する技術の開発が進められている。しかしながら未だ全ての道路において適正に前方障害物や前方の道路状況等を判断する技術は見いだされていない。
【０００３】
これに対し、一定の条件下での自動走行は、既に例えば工場内の自動搬送車等で行われている。
【０００４】
この自動搬送車では、該搬送車を走行させるべき走行経路上に一定間隔で配列された磁気マーカを検出しながら該走行経路上を一定の低速度で走行するものである。
【０００５】
しかしながら、目的の走行経路上を正確に走行させることは困難であり、前記搬送車の実際の走行位置は走行に従い目的の走行経路に対して変位誤差を生じる。
【０００６】
このため、従来の自動搬送車では、該搬送車の現在の走行位置と目的の走行経路との変位誤差を検出し、フィードバック制御によりその誤差を補正しながら走行するようにしていた。
【０００７】
しかしながら、このような走行手法では、特に高速走行において誤差を修正するための変動が続き、安定性が悪かった。
【０００８】
従って、このような自動搬送車を、一般道路上でしかも速度制御を行いながら走行させることは、困難であった。
【０００９】
また、前走車を検出し、その速度に比例した関数にて車間距離を制御し前走車を自動追従走行する自動走行車が考えられている。
【００１０】
この従来の自動追従システムに依れば、図４（ａ）に示すように、前走車の発進によりその速度Ｖを検出すると、この前走車の速度Ｖに比例した車間距離Ｌが次式により算出され、これが車間距離の指令値として出力される。
【００１１】
Ｌ＝ｓ・Ｖ
尚、ここでの係数ｓは時間の単位を有するものである。
【００１２】
この車間距離Ｌを保つための自車（追従車）の加減速度が求められ、自車の速度制御が行われる。
【００１３】
加速期間が終了し、前走車が一定速度になると、自車もその速度に対応した車間距離を一定に保ちつつ、前走車と同一の一定速度となる。
【００１４】
この後、何らかの要因で前走車が急激な減速を行った場合や、渋滞や故障等で停車している車両を前走車として認識した場合、前記車間距離の指令値も急激に減少するため、それに合わせて、自車（追従車）側では、前走車との車間距離を急激に減少させるように車速制御が行われる。
【００１５】
このため、自車側では前走車の減速率よりも小さな減速率で減速して、前走車に急激に接近していくこととなってしまう。
【００１６】
これを解決するためには、例えば図４（ｂ）に示すように、発進の際（加速時）と停車の際（減速時）とでそれぞれ次式により車間距離の指令値を設定し、前走車の車速Ｖ＝０の時にＬｓ、Ｌｅ（＞０）の車間距離指令値が出されるようにすることが考えられる。
【００１７】
Ｌ＝Ｌｓ＋ｓ・Ｖ ……（発進側）
Ｌ＝Ｌｅ＋ｓ・Ｖ ……（停車側）
このようにすると、車間距離Ｌの指令値は常に、ＬｓあるいはＬｅ以上となるため、例えば前述のように前走車が急激に減速しても自車が前走車に接近し過ぎることはなくなる。
【００１８】
しかるに、この場合、車速がある程度大きくなった状態でも、ＬｓあるいはＬｅの距離分、余分に車間距離をとってしまい、必要以上に大きな車間距離が確保されてしまう。
【００１９】
また、上記のように、車速Ｖ＝０のときの車間距離Ｌｓ，Ｌｅを発進側と停車側とで異なるものとして、各別の関数により車間距離の指令値を設定すると、走行中のある適当な車速（例えば図４（ｂ）の車速Ｖｃ）で、車間距離の指令値を設定するための関数を切り換えなければならず、このとき、車間距離の指令値が不連続に変化して、自車の車速が急変してしまう虞がある。
【００２０】
【発明が解決しようとする課題】
本発明は、かかる背景に鑑み、一定の条件下の道路、例えば、車線毎に磁気情報源が設けられた自動走行専用道路上等において、前走車との車間距離を適切にとりつつ自動追従走行を安定に行うことを目的とするものであり、特に発進・加速の際や減速・停車の際の車間距離制御をよりスムーズに、より安定に行うことを目的とするものである。
【００２１】
【課題を解決するたの手段】
本発明の第１の態様の自動走行車はかかる目的を達成するために、前走車との車間距離を制御しつつ該前走車を自動追従走行する自動走行車において、自車速度を把握する手段と、前走車速度を把握する手段と、前記自車速度及び前走車速度の速度差をあらかじめ定めた所定値と比較し、その比較結果に基づき前記自車速度又は前走車速度に応じて自車と前走車との車間距離を調整するための自車の加減速度修正データを生成する手段と、該加減速度修正データに応じて自車の加減速度を制御する制御手段とを具備し、前記加減速度修正データを生成する手段は、前記速度差が前記所定値以下であるとき、前記前走車速度に応じて前記加減速度修正データを生成し、前記速度差が前記所定値以上であるとき、前記自車速度に応じて前記加減速度修正データを生成することを特徴とするものである。
【００２２】
かかる本発明の第１の態様によれば、前記自車速度と前走車速度との速度差が前記所定値以下であるとき、すなわち、該速度差が小さいときには前走車速度に応じて自車と前走車との車間距離を調整するための加減速度修正データが生成され、その加減速度修正データに応じて前記制御手段により自車（追従車）の加減速度が制御される。このため、例えば前走車と自車とがほぼ一定の速度で走行する定常的な走行時には、それらの速度に適合した車間距離が保持されるように自車速度が制御される。
【００２３】
一方、前記速度差が前記所定値以下であるとき、すなわち、該速度差が大きいときには自車速度に応じて自車と前走車との車間距離を調整するための加減速度修正データが生成され、その加減速度修正データに応じて前記制御手段により自車の加減速度が制御される。換言すれば、自車の加減速度は、自車速度に応じて前走車との車間距離が調整されるよう制御される。従って、例えば前走車と自車との停車状態において、前走車が発進・加速して自車との速度差が大きくなると、この状態では自車の速度が低いため、前走車との車間距離がその低い自車速度に応じた短めの車間距離に調整されるよう自車の発進・加速が行われることとなる。このため、自車はスムーズに前走車に追従して走行していく。また、例えば前走車と自車との定常的な走行中に、前走車が減速・停車しようとして自車との速度差が大きくなると、この状態では自車の速度が高いため、前走車との車間距離がその高い自車速度に応じた長めの車間距離に調整されるよう自車の減速が行われることとなる。このため、自車は前走車の減速に合わせた減速率で減速していくこととなり、自車が急激に前走車に接近してしまうような事態が回避される。
【００２４】
よって、本発明の第１の態様によれば、前走車との車間距離を適切にとりつつ自動追従走行を安定に行うことができ、発進・加速の際や減速・停車の際の車間距離制御をよりスムーズに、より安定に行うことができる。
【００２５】
かかる本発明の第１の態様では、より詳しくは、前記加減速度修正データを生成する手段は、前記自車と前走車との車間距離を把握する手段と、前記速度差と前記所定値との比較結果に基づき、前記自車速度又は前走車速度に応じて自車と前走車との車間距離の指示データを生成する手段と、前記把握された車間距離と該車間距離の前記指示データとの偏差に応じて前記加減速度修正データを生成する手段とから成り、前記車間距離の指示データを生成する手段は、前記速度差が前記所定値以下であるとき、前記前走車速度に応じて前記車間距離の指示データを生成し、前記速度差が前記所定値以上であるとき、前記自車速度に応じて前記車間距離の指示データを生成する。
【００２６】
これによれば、自車と前走車との車間距離を調整するための前記加減速度修正データは、把握された車間距離と、その車間距離の指示データ（目標車間距離）との偏差に応じて生成されるので、自車の加減速度は実際の車間距離がその指示データに従うように制御される。そして、このとき、車間距離の指示データは、自車と前走車との速度差が前記所定値以下であるときには、前記前走車速度に応じて生成され、該速度差が前記所定値以上であるときには、前記自車速度に応じて生成されるので、前述の通り、自車の追従走行が行われる。
【００２７】
このように、車間距離を把握しつつ、自車速度又は前走車速度に応じて生成される車間距離の指示データとの偏差に応じて自車の加減速度を制御することで、確実に適正な車間距離を確保することができる。
【００２８】
また、本発明の第２の態様は、前走車との車間距離を制御しつつ該前走車を自動追従走行する自動走行車において、少なくとも自車速度及び自車加速度を含む自車の現在の走行状態を把握する手段と、少なくとも自車に対する前走車の位置、前走車速度及び前走車加速度を含む前走車の現在の走行状態を把握する手段と、前記自車の現在の走行状態及び前記前走車の現在の走行状態に基づき、所定時間後の自車と前走車との予想車間距離を求める手段と、前記自車速度及び前走車速度の速度差をあらかじめ定めた所定値と比較し、その比較結果に基づき前記自車速度又は前走車速度に応じて自車と前走車との車間距離の指示データを生成する手段と、前記予想車間距離と前記車間距離の指示データとの偏差に応じて自車の加減速度修正データを生成する手段と、該加減速度修正データに応じて自車の加減速度を制御する制御手段とを具備し、前記車間距離の指示データを生成する手段は、前記速度差が前記所定値以下であるとき、前記前走車速度に応じて前記車間距離の指示データを生成し、前記速度差が前記所定値以上であるとき、前記自車速度に応じて前記車間距離の指示データを生成することを特徴とするものである。
【００２９】
かかる本発明の第２の態様によれば、前記自車の現在の走行状態（自車速度や自車加速度）と前記前走車の現在の走行状態（自車に対する前走車の位置や前走車速度、前走車加速度）とに基づき所定時間後の自車と前走車との予想車間距離（車間距離の予想値）が求められる。この場合、自車の現在の走行状態は、自車速度と自車加速度とを含むので、それらのデータによって、自車の現在位置から所定時間後の走行位置を予測することができる。また、前走車の現在の走行状態は、自車に対する前走車の位置と前走車速度と前走車加速度とを含むので、それらのデータによって、自車に対する前走車の現在位置から所定時間後の走行位置を予測することができる。従って、所定時間後の自車と前走車との予想車間距離を求めることができる。
【００３０】
そして、本発明の第２の態様では、前記第１の態様と同様に、前走車と自車ととの速度差の前記所定値に対する大小関係の比較に基づく自車速度又は前走車速度に応じて車間距離の指示データが生成され、その指示データと前記予想車間距離との偏差に応じて、車間距離を調整するための加減速度修正データが生成される。さらに、その加減速度修正データに応じて自車の加減速度が制御される。
【００３１】
従って、本発明の第２の態様では、所定時間後の将来的な車間距離が自車速度又は前走車速度に応じた車間距離の指示データに従うように自車の加減速度が制御されることとなる。
【００３２】
これにより本発明の第２の態様によれば、自車の加減速度の制御の遅れ等によらずに、前記第１の態様で説明したような適切な車間距離を確保しつつ追従走行を行う作動をより確実且つ円滑に行うことができる。
【００３３】
これらの本発明の第１及び第２の態様においては、前記車間距離の指示データは、例えば前記自車速度又は前走車速度の大きさに比例した大きさのデータとする。このようにすることで、前走車速度に応じて車間距離を調整する場合と、自車速度に応じて車間距離を調整する場合とのいずれの場合においても、その速度の大きさに比例した車間距離の指示データが生成されるので、最適な車間距離を確保することができる。
【００３４】
さらに、本発明の第１の態様では、前記自車速度と前走車速度との速度差に応じて自車の第２の加減速度修正データを生成する手段を具備し、前記制御手段は、前記加減速度修正データと前記第２の加減速度修正データとの両者に応じて自車の加減速度を制御する。これと同様に本発明の第２の態様では、前記自車の現在の走行状態及び前記前走車の現在の走行状態に基づき、所定時間後の自車と前走車との予想車間速度差を求める手段と、該予想車間速度差に応じて自車の第２の加減速度修正データを生成する手段とを具備し、前記制御手段は、前記加減速度修正データと前記第２の加減速度修正データとの両者に応じて自車の加減速度を制御する。
【００３５】
このように、前記加減速度修正データに応じた加減速度の制御に加えて、自車と前走車との速度差（第２の態様では所定時間後の予想車間速度差）に応じて第２の加減速度修正データを生成し、この第２の加減速度修正データによっても、自車の加減速度を制御することによって、自車と前走車との速度差が大きい程、前走車への追従が速やかに行われるように自車の加減速度が増減されることとなる。従って、自車の前走車への追従を迅速に行うことができる。
【００３６】
そして、このとき、本発明の第２の態様にあっては、所定時間後の将来的に予想される速度差（予想車間速度差）に応じて第２の加減速度修正データを生成するので、前走車への追従をより迅速に行うことができる。
【００３７】
また、本発明の第１の態様では、少なくとも前走車と自車との間で各車両の速度を示す情報を相互に送受信する車々間通信手段を具備し、前記前走車速度を把握する手段は、該車々間通信手段により前走車から受信された情報により該前走車速度を把握する。同様に、本発明の第２の態様では、少なくとも前走車と自車との間で前記走行状態を示す情報を相互に送受信する車々間通信手段を具備し、前記前走車の走行状態を把握する手段は、該車々間通信手段により前走車から受信された情報により該前走車の走行状態を把握する。
【００３８】
このように、前記車々間通信によって、車両の速度等の走行状態の情報を相互に送受信することによって、自車側（追従車側）では、前走車の速度等の走行状態を容易に把握することができる。
【００３９】
尚、前走車の速度等の走行状態は、レーダ等を用いて把握することも可能である。
【００４０】
【発明の実施の形態】
本発明の自動走行車の一実施形態を図を用いて説明する。
【００４１】
まず、本実施形態のシステムの概要を説明する。図２を参照して、本実施形態の自動走行車Ａは、道路（走行路）の中央の走行経路Ｂ上に、例えば１m 間隔で磁気情報源（磁気ネイル）Ｃが埋め込まれた自動走行用道路上を、該磁気情報源Ｃを検出しながら自動走行を行うものである。そして、自車Ａの前方に前走車（図２では図示せず）が在る場合（自車Ａが追従車である場合）には、その前走車との間に所要の車間距離を維持しつつ追従自動走行を行うものである。この場合、路側には漏洩同軸ケーブル（ＬＣＸケーブル）Ｄが設置され、この漏洩同軸ケーブルＤと自動走行車Ａとの間で自動走行に必要な情報が送受信されるようになっている。また、前走車と追従車との間で自車の走行状態を示す情報が相互に送受信（車々間通信）されるようになっている。
【００４２】
このような自動走行を行う本実施形態の自動走行車のシステム構成を図１に示す。
【００４３】
同図１を参照して、本実施形態では、通信信号処理装置１と、制御計画処理装置２と、車両の横方向（操舵方向）制御装置３と、車速制御装置４とがそれぞれに信号処理装置（ＣＰＵ）を具備したモジュールとして各車両に搭載されている。また、各車両には、車両の横方向（操舵方向）の角速度を検出するヨーレートセンサー５と、前記磁気情報源Ｃを検出する磁気センサ６と、車輪の一回転毎に（車輪の一回転に相当する走行距離毎に）パルスを出力する車輪パルスセンサ８と、車両の前後方向の加速度を検出する前後加速度センサ９と、前走車や前方障害物の検出すると共にそれらの物体までの距離を検出するレーザレーダ１０とが備えられ、それらの検出データが適宜、前記装置１〜４に与えられる。
【００４４】
この場合、前記磁気センサ６は、図２に示すように車両の前側バンパ下部と後側バンパ下部とにそれぞれ設けられている。そして、それらの各磁気センサ６は、単にその下方の磁気情報源Ｃを検出するだけでなく、この磁気情報源Ｃの中心から左右約４５ｃｍの範囲で該磁気情報源Ｃに対する磁気センサ６の横方向（車幅方向）の位置を、該磁気情報源Ｃに対する車両の前後部の横方向の位置として検出する。
【００４５】
これらのセンサ５，６，８，９及びレーザレーダ１０の検出データが与えられる前記各装置１〜４は次のような機能を有する。
【００４６】
通信信号処理装置１は、前記漏洩同軸ケーブル（ＬＣＸケーブル）Ｄとの間での通信及び車々間通信を行う通信手段としての機能を有するものであり、それぞれの通信を車両に備えたアンテナや送受信器から成る通信機器７，１１を介して行う。
【００４７】
この場合、漏洩同軸ケーブルＤとの通信では、漏洩同軸ケーブルＤからは、車両の走行エリアにおける速度指令情報や、道路の曲率情報、渋滞情報、緊急メッセージ情報等が受信され、車両側からは自車のＩＤナンバーが送信される。このＩＤナンバーにより、漏洩同軸ケーブルＤ側では各車両の走行位置が把握される。そして、通信信号処理装置１は、受信した速度指令情報等を制御計画処理装置２に与える。
【００４８】
一方、車々間通信では、前走車と追従車との間で、各車両において後述のように把握される走行経路Ｂ上の車両の時々刻々の走行位置（走行距離）、速度（車速）、前後加速度及び後述の速度計画等を示すデータが相互に送受信される。そして、それらのデータは、各車両において、通信信号処理装置１から制御計画処理装置２に与えられる。従って、追従車側では、この通信信号処理装置１によって、前走車の速度や加速度等の走行状態を把握する手段が構成されている。
【００４９】
また、通信信号処理装置１は、走行経路Ｂ上における自車の走行位置を認識する走行位置認識手段としての機能も有している。
【００５０】
本実施形態では、次のように走行位置を認識する。すなわち、本実施形態の自動走行車は基本的には磁気情報源Ｃが配列された走行経路Ｂ上を走行するので、該走行経路Ｂ上における車両の走行距離が該走行経路Ｂ上における車両の走行位置を示すものとなる。そこで、通信信号処理装置１は、走行経路Ｂ上での走行を開始してから前記磁気センサ６により検出される磁気情報源Ｃの検出回数をカウントし、その検出回数に磁気情報源Ｃの間隔（一定）を乗算してなる距離を走行経路Ｂ上における車両の走行距離として把握する。但し、車両が走行経路Ｂから逸脱して、磁気情報源Ｃの検出を逃す場合もあり、このような場合には、前記車輪パルスセンサ８の出力に基づいて走行距離を把握する。そして、このように把握した走行距離により、車両が所持する走行経路Ｂの地図データ上で車両の走行位置を認識してそれを制御計画処理装置２に与える。この場合、走行経路Ｂの地図データは、磁気情報源Ｃの点列データとして表され、これは、あらかじめ車両の記憶装置に記憶保持してもよいし、あるいは、前記漏洩同軸ケーブルＤ等との通信によって外部から所定の走行区域毎に受信するようにしてもよい。
【００５１】
尚、本実施形態では、走行経路Ｂ上の磁気情報源Ｃは、例えば５００ｍ間隔で磁気極性を反転してなるビット情報が設けられており、磁気センサ６によりこのビット情報の検出が行われる毎に、上記５００ｍの間隔を基準として走行距離の修正が行われる（例えば、走行距離が５００ｍの整数倍となるように修正する）。
【００５２】
制御計画処理装置２は、自動走行スタートスイッチ１２が接続され、この自動走行スタートスイッチ１２のＯＮ操作に応じて自動走行のための情報の作成を開始する。
【００５３】
この制御計画処理装置２は、走行経路Ｂ上における車両の走行位置と速度との関係を規定する速度計画を作成する速度計画作成手段としての機能を有し、漏洩同軸ケーブルＤから通信信号処理装置１を介して与えられる車両の走行エリアに対応した速度指令情報に基づき、前記速度計画を作成する。この場合、漏洩同軸ケーブルＤから指示された速度に従うように速度計画を作成する。例えば、ある走行エリアで８０ｋｍ／ｈの速度指令が与えられたとき、今現在の車両の速度が７８ｋｍ／ｈであれば、車両の速度を８０ｋｍ／ｈまで所定の加速度（例えば２ｋｍ／ｈ／ｍｉｎ）で増速し、その後、８０ｋｍ／ｈの速度を維持するように速度計画を作成する。
【００５４】
また、制御計画処理装置２は上記のように作成した速度計画に基づいて、現在の車両の走行位置からあらかじめ定められた所定時間Ｔ（本実施形態では例えば１．５秒）後に到達すべき到達予定位置と、その到達予定位置における車両の予定速度とを決定する予定値決定手段としての機能を有する。この機能では、例えば、車両の現在位置からの速度計画が８０ｋｍ／ｈ（２２．２ｍ／秒）の速度を一定に維持するように作成されておれば、前記所定時間Ｔ（１．５秒）後の到達予定位置は走行経路Ｂ上を今現在の位置から３３．３ｍ進行した地点であり、また、その到達予定位置における予定速度は８０ｋｍ／ｈである。
【００５５】
さらに、制御計画処理装置２は以下に説明する予想値算出手段、偏差算出手段及び速度計画用加減速度データ算出手段としての機能を有し、さらに追従車側にあっては、以下に説明する前走者予想値算出手段、予想車間距離算出手段、車間速度差算出手段及び車間制御用加減速度データ算出手段としての機能も有する。
【００５６】
前記予想値算出手段としての機能は、前記所定時間Ｔ後の自車の到達予想位置と予想速度とを求めるものである。到達予想位置は、前記通信信号処理装置１から与えられる自車の現在の走行位置（走行距離）、現在の速度及び現在の加速度から後述の演算により求め、予想速度は自車の現在の速度と加速度とから後述の演算により求める。
【００５７】
この場合、本実施形態では、前記到達予想位置や予想速度を求めるための車両の速度は、基本的には通信信号処理装置１から与えられる車両の時々刻々の走行位置の最新の一階微分値、すなわち単位時間当たりの走行位置の変化量により求める。同様に、車両の加速度は、基本的には車両の時々刻々の走行位置の最新の二階微分値、すなわち単位時間当たりの走行位置の変化速度により求める。そして、このように求めた車両の速度と加速度とを用いて到達予想位置や予想速度を求める。これにより、自車速度や自車加速度を把握する手段が構成されている。但し、車両が走行経路Ｂから逸脱して走行位置を正しく把握できなかったような場合には、前記車輪パルスセンサ８の出力により把握される走行距離の単位時間当たりの変化量により検出される速度や前記前後加速度センサにより検出される加速度を用いて到達予想位置や予想速度を求める。尚、この場合、車両の速度の把握は、速度センサを用いて行うようにしてもよい。
【００５８】
前記偏差算出手段としての機能は、前述の速度計画に基づく所定時間Ｔ後の到達予定位置と前記到達予想位置との距離偏差（位置誤差）を求めると共に、速度計画に基づく所定時間Ｔ後の予定速度と前記予想速度との速度偏差（速度誤差）を求めるものであり、それらの算出は減算演算により行われる。
【００５９】
前記速度計画用加減速度データ算出手段としての機能は、上記距離偏差及び速度偏差に基づき、車両の速度計画用の加減速度修正データ（車両の加減速度を修正するための制御量）を作成するものであり、本実施形態では、上記距離偏差及び速度偏差にそれぞれ所定のゲイン係数を乗算してなる値を互いに加算することにより速度計画用の加減速度修正データを作成する。
【００６０】
また、追従車側における前走車予想値算出手段としての機能は、前記所定時間Ｔ後の前走車の到達予想位置と予想速度とを求めるものである。前走車の到達予想位置は、前記車々間通信によって自車の通信信号処理装置１を介して把握される前走車の現在の走行位置（走行距離）、現在の速度及び現在の加速度から自車の場合と同様の後述の演算によって求め、前走車の予想速度は、前走車の現在の速度及び加速度から自車の場合と同様の後述の演算によって求める。尚、この場合、前走車の現在の速度や加速度は、車々間通信によって与えられる前走車の走行位置のデータから、前述と同様に、該走行位置の一階微分値や二階微分値により求めて把握するようにしてもよい。
【００６１】
追従車側における予想車間距離算出手段としての機能は、前記所定時間Ｔ後に予想される自車と前走車との車間距離を求めるものであり、上記のように求められる前走車の到達予想位置と自車において前述の如く求められる自車の到達予想位置との距離差を演算することにより、所定時間Ｔ後の予想車間距離を求める。
【００６２】
同様に、追従車側における車間速度差算出手段としての機能は、前記所定時間Ｔ後に予想される前走車との速度差を求めるものであり、前走車の予想速度と自車の予想速度との差を演算することにより、所定時間Ｔ後の車間速度差を求める。
【００６３】
また、追従車側における車間制御用加減速度データ算出手段は、上記予想車間距離及び車間速度差に基づき、車両の車間制御用の加減速度修正データ（車両の加減速度を修正するための制御量）を作成するものである。本実施形態では、上記予想車間距離と自車又は前走車の速度に応じた目標車間距離（これについては後述する）との偏差に所定のゲイン係数を乗算してなる値（これが本発明でいうところの加減速度修正データに相当する）と、上記車間速度差に所定のゲイン係数を乗算してなる値（これが本発明でいうところの第２の加減速度修正データに相当する）とを互いに加算することにより車間制御用の総合的な加減速度修正データを作成する。
【００６４】
これらの機能を有する制御計画処理装置２は、さらに、車両の前後の二つの前記磁気センサ６の出力（走行経路Ｂに対する各磁気センサ６の横方向の位置データ）に基づき、走行経路Ｂ（磁気情報源列）に対する車両の現在の横方向の位置偏差や方向偏差（車両と走行経路Ｂとのなす角度θ、図２参照）を求めるようにしている。また、制御計画処理装置２は、車両の現在速度や操舵量、漏洩同軸ケーブルＤから与えられる道路の曲率情報等に基づき、前記所定時間Ｔ後の車両の走行経路Ｂに対する横方向の位置偏差や方向偏差を予測するようにしている。これらのデータは、車両を走行経路Ｂに沿って走行させるための操舵制御に使用されるものである。
【００６５】
また、この制御計画処理装置２は、追従車の場合は自車速度、前走車速度、前走車までの車間距離、前方道路形状や車線形状等のデータを表示装置１８や音声出力装置１７に出力する。
【００６６】
そして、前走車の場合は自車の速度、追従車の速度、追従車までの車間距離、前方道路形状や車線形状等のデータを表示装置１８、及び音声出力装置１７に出力する。
【００６７】
ここで、前走車及び追従車間の上記の車間距離は、前述の車々間通信もしくはレーザレーダ１０によって得られるものであり、前方道路形状や車線形状等のデータは漏洩同軸ケーブルＤとの通信によって得られるものである。
【００６８】
尚、本実施形態では、前記所定時間Ｔを１．５秒に設定しているが、１秒〜２秒の範囲で設定することが好ましい。
【００６９】
横方向制御装置３は、制御計画処理装置２の出力結果（前述の横方向の位置偏差や方向偏差等のデータ）に基づいて、車両を走行経路Ｂに沿わせるための操舵角の指示信号を生成し、その操舵角指示信号により車両のステアリング操作伝達系に設けられたアクチュエータ１４を制御する。
【００７０】
このアクチュエータ１４の制御により、ステアリングが自動制御され走行経路Ｂ（磁気情報源列）に沿った走行が行われる。
【００７１】
車速制御装置４は、制御計画処理装置２により生成される加減速度修正データに基づき加速度指示信号を生成し、その加速度指示信号によりスロットル系に設けられたアクチュエータ１５やブレーキ系に設けられたアクチュエータ１６を制御する。
【００７２】
この各アクチュエータ１５，１６の制御により、車両のスロットル系やブレーキ系が作動され、車両の加減速が行われる。
【００７３】
尚、この車速制御装置４には、図示しないブレーキペダルの操作を検知するブレーキペダルスイッチ１３が接続されており、このスイッチ１３の信号によりブレーキペダルが踏まれたことが検出された場合には、車速制御を解除する。
【００７４】
また、車速制御装置４は、前記レーザレーダ１０により前走車以外の障害物が検出された場合々等、状況に応じてレーザレーダ１０の出力に基づき、ブレーキ量の制御を行う。
【００７５】
次に本実施形態の自動走行車における車速制御を図３のブロック線図を参照しつつ説明する。
【００７６】
前述の如く通信信号処理装置１により磁気センサ６の検出信号に基づいて求められた自車位置Xi(0) ２１と、この自車位置Xi(0) から制御計画処理装置２により求められた自車速度Vi(0) （位置の一階微分値）２２と、自車加速度Ai(0) （位置の二階微分値）２３とが制御計画処理装置２において、自車のＴ秒後の状態を予想する処理部２４へ出力される。
【００７７】
この処理部２４は前記予想値算出手段として機能するものであり、Ｔ秒後の到達予想位置Xi(T) 、及びＴ秒後の予想速度Vi(T) をそれぞれ次式（１），（２）により求める。
【００７８】
Vi(T)＝Vi(0) ＋Ai(0) ×Ｔ ……（１）
Xi(T)＝Xi(0) ＋Vi(O) ×Ｔ＋１／２×Ai(0) ×Ｔ²……（２）
一方、制御計画処理装置２の制御計画処理部２５は、前記速度計画作成手段及び予定値決定手段としての機能を有し、前述の如く漏洩同軸ケーブルＤからの速度指令に基づき、走行経路Ｂに沿った速度計画を作成して、Ｔ秒後の到達予定位置Xi'(T)及び予定速度Vi'(T)を求める。
【００７９】
上記のように処理部２４で求められた到達予想位置Xi(T) 及び予想速度Vi(T) と、処理部２５で求められた到達予定位置Xi'(T)及び予定速度Vi'(T)は前記偏差算出手段としての機能を有する偏差演算部５０に出力される。この偏差演算部５０では、到達予定位置Xi'(T)及び予定速度Vi'(T)からそれぞれ到達予想位置Xi(T) 及び予想速度Vi(T) を減算することにより、Ｔ秒後の距離偏差及び速度偏差を算出し、それらが前記速度計画用加減速度データ作成手段としての機能を有する変換部２６に出力される。
【００８０】
この変換部２６では、前記距離偏差及び速度偏差にそれぞれ所定のゲインＫx ，Ｋu を乗算してなる値を互いに加算してなる加減速度修正データが生成され、それが車速制御装置４に備えた比較部２７へ出力される。
【００８１】
以上の処理は、前走車及び追従車のいずれにおいても同様に行われる。
【００８２】
また、追従車にあっては、前走車との車々間通信によって得られた前走車の現在の走行位置Xi-1(0) ２８、速度Vi-1(0) ２９及び加速度Ai-1(0) ３０が、追従車の制御計画処理装置２において、前走車のＴ秒後の状態を予想する処理部３１へ出力される。
【００８３】
この処理部３１は、前記前走車予想値算出手段として機能するものであり、前走車のＴ秒後の到達予想位置Xi-1(T) 、及びＴ秒後の予想速度Vi-1(T) をそれぞれ前記式（１），（２）と同じ形の演算式（図３参照）により求める。
【００８４】
この処理部３１で求められた前走車の到達予想位置Xi-1(T) 及び予想速度Vi-1(T) は、前記処理部２４で求められた自車（追従車）の到達予想位置Xi(T) 及び予想速度Vi(T) と共に、前記予想車間距離算出手段及び車間速度差算出手段としての機能を有する車間演算部４０に出力される。この車間演算部４０では、前走車のＴ秒後の到達予想位置Xi-1(T) 及び予想速度Vi-1(T) から、それぞれ自車（追従車）のＴ秒後の到達予想位置Xi(T) 及び予想速度Vi(T) を減算することにより、Ｔ秒後の予想車間距離及び車間速度差を算出する。
【００８５】
さらに、制御計画処理装置２には、追従車の自車速度Vi(0) ２２と前走車の前走車速度Vi-1(0) ２９との速度差（｜Vi(0) −Vi-1(0) ｜）の大小に基づき、前走車と追従車との車間距離の指示データ（目標車間距離を示すデータ）を作成する目標車間距離調整手段３２も設けられている。
【００８６】
この目標車間距離調整手段３２は、自車速度Vi(0) ２２と前走車の前走車速度Vi-1(0) ２９との速度差（｜Vi(0) −Vi-1(0) ｜）をあらかじめ定めた所定値（所定速度差）と比較し、その速度差（｜Vi(0) −Vi-1(0) ｜）が所定値以上で比較的大きな値である場合には、自車速度Vi(0) ２２の大きさに比例した車間距離の指示データを作成する。逆に、速度差（｜Vi(0) −Vi-1(0) ｜）が所定値以下の比較的小さな値である場合には、前走車速度Vi-1(0) ２９の大きさに比例した車間距離の指示データを作成する。自車速度Vi(0) ２２に比例した車間距離の指示データを作成する場合と、前走車速度Vi-1(0) ２９に比例した車間距離の指示データを作成する場合とでは、いずれの場合であっても、例えば前記図４（ａ）に示した比例関数に基づき、それらの速度Vi(0) 又はVi-1(0) の大きさに対応した車間距離の指示データが作成される。尚、上記所定値は本実施形態では、例えば１０ｋｍ／ｈに設定されている。
【００８７】
このようにして作成された車間距離の指示データ（目標間距離データ）は、前記車間演算部４０に与えられ、この車間演算部４０において、該車間距離の指示データと前記予想車間距離との偏差が求められる。
上記のように車間演算部４０によって算出された車間距離データ（予想車間距離と目標車間距離との偏差）と、車間速度差のデータは前記車間制御用加減速データ算出手段としての機能を有する変換部３３に出力される。この変換部３３では、上記車間距離データと、車間速度差データとにそれぞれ所定のゲインＫx1，Ｋu1を乗算してなる値を互いに加算してなる加減速度修正データが生成され、それが車速制御装置４の前記比較部２７へ出力される。
【００８８】
車速制御装置４において、上記比較部２７は、前述の速度計画に対する自車のＴ秒後の予想偏差に基づく加減速度修正データ（変換部２６の出力）と、前述のＴ秒後の前走車との予想車間距離及び車間速度差に基づく加減速度修正データ（変換部３３の出力）とを比較し、追従車が前走車に接近し過ぎないように車両の前進側の加速度が小さなものとなる加減速度修正データを択一的に選択し、スロットル側積分器４１、ブレーキ側積分器４２に出力する。
【００８９】
尚、この場合、前走車にあっては、その前方に他車がいないか、あるいはその前方他車が自車から十分に離れている場合には、比較部２７は、前述の速度計画に対する自車のＴ秒後の予想偏差に基づく加減速度修正データ（変換部２６の出力）を出力する。
【００９０】
また、比較部２７では、例えば、前走車側では変換部２６側の修正データを出力し、追従車側では、変換部３３側の修正データを出力するようにしてもよい。
【００９１】
このように加減速度修正データが入力された積分器４１，４２は該加減速度修正データを積分し、その積分値（これは目標車速に相当するものとなる）をそれぞれスロットル制御量換算部３４及びブレーキ制御量換算部３５に出力する。
【００９２】
スロットル制御量換算部３４では、積分器４１の出力に加えて、車両の現在の車速や、図示しないエンジンの回転数、変速機のギヤ段数等のデータが与えられ、これらのデータからあらかじめ定められマップ等を用いてスロットルの指示開度が決定される。そして、このスロットル指示開度に基づき、スロットル制御部３６によって、前記スロットル用のアクチュエータ１５の操作量を規定する指示デューティが該アクチュエータ１５に与えられ、それにより該アクチュエータ１５が制御される。
【００９３】
また、ブレーキ制御量換算部３５では、積分器４２の出力に加えて、車両の現在の車速データが与えられ、それらのデータからマップ等を用いてブレーキの指示圧が決定される。そして、このブレーキ指示圧に基づき、ブレーキ制御部３７によって、前記ブレーキ用のアクチュエータ１６の操作量を規定する指示デューティが該アクチュエータ１６に与えられ、それにより該アクチュエータ１６が制御される。
【００９４】
以上のような制御によって、前走車にあっては、速度計画に対する自車のＴ秒後の予想偏差に基づく速度計画用の加減速度修正データによって、該速度計画に従うように車速制御が行われる。そして、追従車にあっては、Ｔ秒後の前走車との予想車間距離及び車間速度差等に基づく加減速度修正データによって、自車速度Vi(0) 又は前走車速度Vi-1(0) に応じた車間距離の指示データに従った車間距離が保たれるように車速制御が行われる。
【００９５】
尚、本実施形態における横方向（操舵方向）の位置制御においては、車両の前後の磁気センサ６の出力に基づき得られる車両の現在位置における走行経路Ｂに対する横方向の位置偏差及び方向偏差（角度偏差）や、漏洩同軸ケーブルＤから得られる車両前方の道路の曲率情報等に基づき、所定時間後の車両の予想到達位置と、走行経路Ｂ上の目標到達位置との位置偏差や方向偏差が求められ、それらの位置偏差や方向偏差に基づき、車両が走行経路Ｂに沿うように操舵量が求められる。
【００９６】
以上説明した本実施形態の自動走行車によれば、追従車側では、自車と前走車との速度差（｜Vi(0) −Vi-1(0) ｜）の大小によって、車間距離の指示データ（目標車間距離データ）を自車速度Vi(0) に応じて作成したり、前走車速度Vi-1(0) に応じて作成したりするため、従来のように前走車の減速・停車に際して自車が前走車に接近し過ぎたりするような事態を生じることなく、適正な車間距離を確保しつつスムーズに前走車を追従して走行することができる。
【００９７】
すなわち、例えば前走車と自車との停車状態から前走車が発進・加速して自車との速度差（｜Vi(0) −Vi-1(0) ｜）が大きくなると、前記車間距離の指示データは自車速度Vi(0) に応じて作成される。そして、前走車が発進・加速の開始直後では、まだ、自車速度Vi(0) が低いため、前記車間距離の指示データも小さく、従って、前走車との車間距離がその低い自車速度Vi(0) に応じた短めの車間距離に調整されるよう自車の発進・加速が行われることとなる。このため、自車はスムーズに前走車に追従して走行していく。
【００９８】
また、その自車の加速により、速度差（｜Vi(0) −Vi-1(0) ｜）が小さくなり、さらに前走車と自車（追従車）とがほぼ同じ速度で定常的な走行を行うようになると、車間距離の指示データは前走車速度Vi-1(0) に応じて作成される。従って、前走車が一定の速度で走行している場合はもちろん、前走車が緩やかに速度を変化させた場合でも、その前走車速度Vi-1(0) に応じた適正な車間距離を保持しつつ、自車がスムーズに前走車に追従して走行していく。
【００９９】
さらに、自車の走行中に、例えば漏洩同軸ケーブルからの渋滞情報や事故情報が前走車に受信され、前走車が急激な減速を行った場合や、渋滞や故障等で停止している車両を前走車として認識した場合には、前走車と自車との速度差（｜Vi(0) −Vi-1(0) ｜）が大きくなるため、前記車間距離の指示データは自車速度Vi(0) に応じて作成される。このとき、まだ、自車速度Vi(0) が高いため、前記車間距離の指示データも大きく、従って、前走車との車間距離がその高い自車速度Vi(0) に応じた長めの車間距離に調整されるよう自車の減速が行われることとなる。このため、自車は大きな減速率で減速し、自車が急激に前走車に接近してしまうような事態が回避される。
【０１００】
また、本実施形態の自動走行車では、Ｔ秒後の予想車間距離と、車間距離の指示データとの偏差に応じて車間制御用の加減速度修正データを作成しているため、将来的な車間距離が指示データに従うように制御されるため、自車の加減速度の制御の遅れ等によらずに、前述のように適切な車間距離を確保しつつ追従走行を行う作動を確実且つ円滑に行うことができる。
【０１０１】
さらに、予想車間距離と、車間距離の指示データとの偏差だけでなく、Ｔ秒後の予想される車間速度差に応じても加減速度修正データを作成して自車（追従車）の車速制御を行うので、前走車の加速あるいは減速によって、車間速度差が大きくなるような状態では、それに合わせて自車の加速あるいは減速も比較的大きな度合いで行われる。従って、前走車の加速あるいは減速に合わせた自車の加速あるいは減速を迅速に行うことができる。
【０１０２】
また、前走車と追従車とでシステム構成を同一としているため、僅かなソフト（プログラム）上の処理の違いで、前走車及び追従車の両者について、それぞれに適合した自動走行を行うことができる。
【０１０３】
また、システム（装置１〜４）をモジュール化して、それぞれにＣＰＵを搭載したため、極めて高精度且つ高速に信号処理を行うことができる。
【０１０４】
尚、以上説明した実施形態では、磁気情報源Ｃを検出できない場合等を考慮して、車輪パルスセンサ８や加速度センサ９、レーザレーダ１０を備えたが、これらを削除して、磁気情報源Ｃの検出回数のみによって、車両の走行位置（走行距離）を把握し、また、その走行位置を一階微分及び二階微分して車両の速度や加速度を把握するようにしてもよい。
【０１０５】
また、前走車の速度や車間距離は、レーダや、ＣＣＤカメラによる画像処理にて求めてもよい。
【０１０６】
また、本実施形態では、磁気情報源Ｃを検出しつつ所定の走行経路Ｂ上を自動走行するものを示したが、ＣＣＤカメラ等による車両前方の画像を処理することで、自車の走行位置を認識しつつ自動走行を行うようなものについても本発明を適用できる。
【図面の簡単な説明】
【図１】本発明の一実施形態の自動走行車の追従システムを示す全体構成図。
【図２】図１の自動走行車の磁気センシングを示す構成図。
【図３】図１の自動走行車の車速制御を示すブロック図。
【図４】従来考えられる車間距離指示のための車間距離と車速の比例関数図。
【符号の説明】
１…通信信号処理装置、２…制御計画処理装置、４…車速制御手段、３２…目標車間距離調整手段。[0001]
BACKGROUND OF THE INVENTION
The present invention relates to an automatic traveling vehicle, and more particularly to an automatic traveling vehicle that automatically follows the preceding vehicle while controlling the distance between the vehicle and the preceding vehicle.
[0002]
[Prior art]
2. Description of the Related Art Conventionally, development of a technology for automatically driving a vehicle by recognizing a front obstacle, a road condition ahead, and the like while detecting the obstacle using a radar, a CCD camera, and a combination thereof has been advanced. However, no technique has yet been found for properly judging front obstacles and road conditions in front of all roads.
[0003]
On the other hand, automatic traveling under certain conditions has already been performed, for example, in an automated guided vehicle in a factory.
[0004]
This automatic transport vehicle travels on the travel route at a constant low speed while detecting magnetic markers arranged at regular intervals on the travel route on which the transport vehicle is to travel.
[0005]
However, it is difficult to accurately travel on the target travel route, and the actual travel position of the transport vehicle causes a displacement error with respect to the target travel route according to the travel.
[0006]
For this reason, the conventional automatic transport vehicle detects a displacement error between the current travel position of the transport vehicle and the target travel route, and travels while correcting the error by feedback control.
[0007]
However, in such a traveling method, fluctuations for correcting the error continue particularly in high speed traveling, and stability is poor.
[0008]
Therefore, it is difficult to run such an automatic guided vehicle on a general road while performing speed control.
[0009]
Further, an automatic traveling vehicle that detects a preceding vehicle and controls the inter-vehicle distance by a function proportional to the speed to automatically follow the preceding vehicle is considered.
[0010]
According to the conventional automatic tracking system, as shown in FIG. 4 (a), when the speed V is detected by the start of the preceding vehicle, the following distance L proportional to the speed V of the preceding vehicle is expressed by the following equation. This is output as a command value for the inter-vehicle distance.
[0011]
L = s · V
The coefficient s here has a unit of time.
[0012]
The acceleration / deceleration of the own vehicle (following vehicle) for maintaining the inter-vehicle distance L is obtained, and the speed of the own vehicle is controlled.
[0013]
When the acceleration period ends and the preceding vehicle reaches a constant speed, the host vehicle also maintains the same inter-vehicle distance corresponding to that speed and the same constant speed as the preceding vehicle.
[0014]
After this, if the preceding vehicle suddenly decelerates for some reason, or if a vehicle stopped due to traffic jams or malfunctions is recognized as the preceding vehicle, the command value for the inter-vehicle distance also decreases rapidly. Accordingly, on the own vehicle (following vehicle) side, the vehicle speed control is performed so that the inter-vehicle distance from the preceding vehicle is rapidly reduced.
[0015]
For this reason, on the own vehicle side, the vehicle decelerates at a deceleration rate smaller than the deceleration rate of the preceding vehicle, and suddenly approaches the preceding vehicle.
[0016]
In order to solve this, for example, as shown in FIG. 4 (b), the command value of the inter-vehicle distance is set by the following formulas when starting (acceleration) and when stopping (deceleration). It is conceivable that inter-vehicle distance command values of Ls and Le (> 0) are output when the vehicle speed V = 0 of the traveling vehicle.
[0017]
L = Ls + s · V (Starting side)
L = Le + s · V ...... (stop side)
In this way, the command value for the inter-vehicle distance L is always greater than or equal to Ls or Le. For example, even if the preceding vehicle suddenly decelerates as described above, the host vehicle will not be too close to the preceding vehicle. .
[0018]
However, in this case, even when the vehicle speed is increased to some extent, an extra inter-vehicle distance is taken by the distance of Ls or Le, and an unnecessarily large inter-vehicle distance is secured.
[0019]
Further, as described above, if the inter-vehicle distances Ls and Le at the time of the vehicle speed V = 0 are different on the start side and the stop side, and the command value of the inter-vehicle distance is set by each of different functions, a certain amount of traveling is appropriate. The function for setting the inter-vehicle distance command value must be switched at a certain vehicle speed (for example, the vehicle speed Vc in FIG. 4B). At this time, the inter-vehicle distance command value changes discontinuously, There is a risk that the speed of the vehicle may change suddenly.
[0020]
[Problems to be solved by the invention]
In view of such a background, the present invention provides an automatic follow-up travel while appropriately taking the distance between the preceding vehicle on a road under a certain condition, for example, on an automatic travel road provided with a magnetic information source for each lane. In particular, the object is to perform inter-vehicle distance control more smoothly and more stably during start / acceleration and deceleration / stop.
[0021]
[Means for solving the problems]
In order to achieve the above object, the automatic traveling vehicle according to the first aspect of the present invention grasps its own vehicle speed in an automatic traveling vehicle that automatically follows the preceding vehicle while controlling the inter-vehicle distance from the preceding vehicle. Comparing the speed difference between the own vehicle speed and the preceding vehicle speed with a predetermined value determined in advance, and based on the comparison result, the own vehicle speed or the preceding vehicle speed. Means for generating acceleration / deceleration correction data of the own vehicle for adjusting the inter-vehicle distance between the own vehicle and the preceding vehicle according to the control, and control means for controlling the acceleration / deceleration of the own vehicle according to the acceleration / deceleration correction data; And the means for generating the acceleration / deceleration correction data generates the acceleration / deceleration correction data according to the preceding vehicle speed when the speed difference is equal to or less than the predetermined value, and the speed difference is the predetermined value. When the value is greater than or equal to the value, the acceleration / deceleration according to the vehicle speed It is characterized in that to generate a modified data.
[0022]
According to the first aspect of the present invention, when the speed difference between the vehicle speed and the preceding vehicle speed is equal to or less than the predetermined value, that is, when the speed difference is small, the vehicle speed is determined according to the preceding vehicle speed. Acceleration / deceleration correction data for adjusting the distance between the vehicle and the preceding vehicle is generated, and the acceleration / deceleration of the own vehicle (following vehicle) is controlled by the control means in accordance with the acceleration / deceleration correction data. For this reason, for example, at the time of steady traveling in which the preceding vehicle and the host vehicle travel at a substantially constant speed, the host vehicle speed is controlled so that the inter-vehicle distance adapted to these speeds is maintained.
[0023]
On the other hand, when the speed difference is less than or equal to the predetermined value, that is, when the speed difference is large, acceleration / deceleration correction data for adjusting the inter-vehicle distance between the host vehicle and the preceding vehicle is generated according to the host vehicle speed. The acceleration / deceleration of the host vehicle is controlled by the control means in accordance with the acceleration / deceleration correction data. In other words, the acceleration / deceleration of the host vehicle is controlled such that the inter-vehicle distance from the preceding vehicle is adjusted according to the host vehicle speed. Therefore, for example, when the preceding vehicle starts and accelerates when the preceding vehicle stops and the speed difference from the own vehicle becomes large, the speed of the own vehicle is low in this state. The own vehicle is started and accelerated so that the inter-vehicle distance is adjusted to a shorter inter-vehicle distance corresponding to the low own vehicle speed. For this reason, the own vehicle travels smoothly following the preceding vehicle. Also, for example, if the speed difference between the preceding vehicle and the own vehicle becomes large while the preceding vehicle tries to decelerate and stop during steady driving, the vehicle speed is high in this state. The host vehicle is decelerated so that the inter-vehicle distance is adjusted to a longer inter-vehicle distance corresponding to the higher host vehicle speed. For this reason, the own vehicle is decelerated at a deceleration rate that matches the deceleration of the preceding vehicle, and a situation in which the own vehicle suddenly approaches the preceding vehicle is avoided.
[0024]
Therefore, according to the first aspect of the present invention, it is possible to stably perform automatic follow-up while appropriately taking the inter-vehicle distance from the preceding vehicle, and to control the inter-vehicle distance during start / acceleration and deceleration / stop Can be performed more smoothly and more stably.
[0025]
More specifically, in the first aspect of the present invention, the means for generating the acceleration / deceleration correction data includes means for grasping an inter-vehicle distance between the host vehicle and the preceding vehicle, the speed difference, and the predetermined value. On the basis of the comparison result, the means for generating the inter-vehicle distance instruction data between the own vehicle and the preceding vehicle according to the own vehicle speed or the preceding vehicle speed, and the grasped inter-vehicle distance and the indication of the inter-vehicle distance Means for generating the acceleration / deceleration correction data in accordance with a deviation from the data, and the means for generating the inter-vehicle distance instruction data is configured to set the preceding vehicle speed when the speed difference is equal to or less than the predetermined value. Accordingly, the inter-vehicle distance instruction data is generated, and when the speed difference is equal to or greater than the predetermined value, the inter-vehicle distance instruction data is generated according to the own vehicle speed.
[0026]
According to this, the acceleration / deceleration correction data for adjusting the inter-vehicle distance between the host vehicle and the preceding vehicle depends on a deviation between the grasped inter-vehicle distance and instruction data (target inter-vehicle distance) of the inter-vehicle distance. Therefore, the acceleration / deceleration of the own vehicle is controlled so that the actual inter-vehicle distance follows the instruction data. At this time, the inter-vehicle distance instruction data is generated according to the preceding vehicle speed when the speed difference between the host vehicle and the preceding vehicle is equal to or less than the predetermined value, and the speed difference is equal to or greater than the predetermined value. When it is, since it is generated according to the speed of the own vehicle, the following traveling of the own vehicle is performed as described above.
[0027]
In this way, by controlling the acceleration / deceleration of the vehicle according to the deviation from the instruction data of the inter-vehicle distance generated according to the own vehicle speed or the preceding vehicle speed while grasping the inter-vehicle distance, It is possible to secure a proper inter-vehicle distance.
[0028]
Further, according to a second aspect of the present invention, in an automatic traveling vehicle that automatically follows the preceding vehicle while controlling the inter-vehicle distance from the preceding vehicle, the current state of the own vehicle including at least the own vehicle speed and the own vehicle acceleration. Means for grasping the traveling state of the vehicle, means for grasping the current traveling state of the preceding vehicle including at least the position of the preceding vehicle relative to the own vehicle, the preceding vehicle speed and the preceding vehicle acceleration, and the current state of the own vehicle Based on the running state and the current running state of the preceding vehicle, a means for obtaining an expected inter-vehicle distance between the own vehicle and the preceding vehicle after a predetermined time, and a speed difference between the own vehicle speed and the preceding vehicle speed are determined in advance. A means for generating instruction data of the distance between the vehicle and the preceding vehicle according to the own vehicle speed or the preceding vehicle speed based on the comparison result, the predicted inter-vehicle distance and the inter-vehicle distance Acceleration / deceleration correction data of own vehicle according to deviation from distance indication data Means for generating and control means for controlling the acceleration / deceleration of the host vehicle according to the acceleration / deceleration correction data, wherein the means for generating the inter-vehicle distance instruction data has the speed difference equal to or less than the predetermined value. Generating the inter-vehicle distance instruction data according to the preceding vehicle speed, and generating the inter-vehicle distance instruction data according to the own vehicle speed when the speed difference is equal to or greater than the predetermined value. It is a feature.
[0029]
According to the second aspect of the present invention, the current running state (the own vehicle speed and the own vehicle acceleration) of the own vehicle and the current running state of the preceding vehicle (the position and front of the preceding vehicle relative to the own vehicle). Based on the traveling vehicle speed and the preceding vehicle acceleration), an expected inter-vehicle distance (predicted value of the inter-vehicle distance) between the host vehicle and the preceding vehicle after a predetermined time is obtained. In this case, since the current traveling state of the own vehicle includes the own vehicle speed and the own vehicle acceleration, it is possible to predict the traveling position after a predetermined time from the current position of the own vehicle based on the data. In addition, the current driving state of the preceding vehicle includes the position of the preceding vehicle relative to the own vehicle, the preceding vehicle speed, and the acceleration of the preceding vehicle. The traveling position after a predetermined time can be predicted. Therefore, the expected inter-vehicle distance between the host vehicle and the preceding vehicle after a predetermined time can be obtained.
[0030]
Then, in the second aspect of the present invention, as in the first aspect, the own vehicle speed or the preceding vehicle speed based on the comparison of the magnitude relationship with respect to the predetermined value of the speed difference between the preceding vehicle and the own vehicle. In response, the inter-vehicle distance instruction data is generated, and acceleration / deceleration correction data for adjusting the inter-vehicle distance is generated in accordance with the deviation between the instruction data and the predicted inter-vehicle distance. Furthermore, the acceleration / deceleration of the vehicle is controlled according to the acceleration / deceleration correction data.
[0031]
Therefore, in the second aspect of the present invention, the acceleration / deceleration of the host vehicle is controlled so that the future inter-vehicle distance after a predetermined time follows the inter-vehicle distance instruction data corresponding to the own vehicle speed or the preceding vehicle speed. It becomes.
[0032]
As a result, according to the second aspect of the present invention, the follow-up traveling is performed while ensuring the appropriate inter-vehicle distance as described in the first aspect without depending on the delay of the control of the acceleration / deceleration of the own vehicle. The operation can be performed more reliably and smoothly.
[0033]
In these first and second aspects of the present invention, the inter-vehicle distance instruction data is, for example, data proportional to the own vehicle speed or the preceding vehicle speed. By doing in this way, in either case of adjusting the inter-vehicle distance according to the preceding vehicle speed and adjusting the inter-vehicle distance according to the own vehicle speed, it is proportional to the magnitude of the speed. Since the inter-vehicle distance instruction data is generated, the optimum inter-vehicle distance can be ensured.
[0034]
Furthermore, in the first aspect of the present invention, the vehicle is provided with means for generating second acceleration / deceleration correction data of the own vehicle according to a speed difference between the own vehicle speed and the preceding vehicle speed, and the control means includes: The acceleration / deceleration of the host vehicle is controlled according to both the acceleration / deceleration correction data and the second acceleration / deceleration correction data. Similarly, in the second aspect of the present invention, based on the current traveling state of the own vehicle and the current traveling state of the preceding vehicle, an expected inter-vehicle speed difference between the own vehicle and the preceding vehicle after a predetermined time. And means for generating second acceleration / deceleration correction data of the vehicle according to the estimated inter-vehicle speed difference, and the control means includes the acceleration / deceleration correction data and the second acceleration / deceleration correction. The acceleration / deceleration of the vehicle is controlled in accordance with both data.
[0035]
As described above, in addition to the acceleration / deceleration control according to the acceleration / deceleration correction data, the second speed is determined according to the speed difference between the own vehicle and the preceding vehicle (the estimated inter-vehicle speed difference after a predetermined time in the second mode). The acceleration / deceleration correction data of the vehicle is generated, and the second acceleration / deceleration correction data is also used to control the acceleration / deceleration of the own vehicle. As the speed difference between the own vehicle and the preceding vehicle increases, The acceleration / deceleration of the own vehicle is increased or decreased so that the tracking is performed promptly. Therefore, it is possible to promptly follow the preceding vehicle of the host vehicle.
[0036]
At this time, in the second aspect of the present invention, since the second acceleration / deceleration correction data is generated according to the speed difference expected in the future (predicted inter-vehicle speed difference) after a predetermined time, It is possible to follow the preceding vehicle more quickly.
[0037]
Further, in the first aspect of the present invention, there is provided inter-vehicle communication means for transmitting and receiving information indicating the speed of each vehicle between at least the preceding vehicle and the own vehicle, and means for grasping the preceding vehicle speed. Recognizes the preceding vehicle speed based on the information received from the preceding vehicle by the inter-vehicle communication means. Similarly, in the second aspect of the present invention, there is provided inter-vehicle communication means for transmitting and receiving information indicating the traveling state between at least the preceding vehicle and the own vehicle, and the traveling state of the preceding vehicle is grasped. The means for grasping the traveling state of the preceding vehicle based on the information received from the preceding vehicle by the inter-vehicle communication means.
[0038]
As described above, the vehicle state (following vehicle side) easily grasps the traveling state such as the speed of the preceding vehicle by mutually transmitting and receiving the traveling state information such as the vehicle speed by the inter-vehicle communication. be able to.
[0039]
The traveling state such as the speed of the preceding vehicle can be grasped using a radar or the like.
[0040]
DETAILED DESCRIPTION OF THE INVENTION
An embodiment of an automatic traveling vehicle of the present invention will be described with reference to the drawings.
[0041]
First, an overview of the system of this embodiment will be described. Referring to FIG. 2, the automatic traveling vehicle A of the present embodiment is for automatic traveling in which a magnetic information source (magnetic nail) C is embedded, for example, at 1 m intervals on a central traveling route B of a road (traveling route). Automatic driving is performed while detecting the magnetic information source C on the road. When a preceding vehicle (not shown in FIG. 2) is in front of the own vehicle A (when the own vehicle A is a following vehicle), the required inter-vehicle distance is set between the preceding vehicle and the preceding vehicle. The automatic tracking operation is performed while maintaining. In this case, a leaky coaxial cable (LCX cable) D is installed on the road side, and information necessary for automatic traveling is transmitted and received between the leaky coaxial cable D and the autonomous vehicle A. In addition, information indicating the traveling state of the own vehicle is transmitted and received (communication between vehicles) between the preceding vehicle and the following vehicle.
[0042]
FIG. 1 shows a system configuration of an automatic traveling vehicle according to this embodiment that performs such automatic traveling.
[0043]
Referring to FIG. 1, in this embodiment, communication signal processing device 1, control plan processing device 2, vehicle lateral direction (steering direction) control device 3, and vehicle speed control device 4 each perform signal processing. It is mounted on each vehicle as a module having a device (CPU). Each vehicle also includes a yaw rate sensor 5 that detects an angular velocity in the lateral direction (steering direction) of the vehicle, a magnetic sensor 6 that detects the magnetic information source C, and each rotation of the wheel (for each rotation of the wheel). A wheel pulse sensor 8 that outputs a pulse (for each corresponding traveling distance), a longitudinal acceleration sensor 9 that detects acceleration in the longitudinal direction of the vehicle, and detects the preceding vehicle and front obstacles and determines the distance to those objects A laser radar 10 for detection is provided, and detection data thereof is provided to the devices 1 to 4 as appropriate.
[0044]
In this case, as shown in FIG. 2, the magnetic sensors 6 are provided at the lower part of the front bumper and the lower part of the rear bumper, respectively. Each of the magnetic sensors 6 not only detects the magnetic information source C below the magnetic sensor 6 but also laterally moves the magnetic sensor 6 relative to the magnetic information source C within a range of about 45 cm from the center of the magnetic information source C. The position in the direction (vehicle width direction) is detected as the lateral position of the front and rear parts of the vehicle with respect to the magnetic information source C.
[0045]
The devices 1 to 4 to which the detection data of the sensors 5, 6, 8, 9 and the laser radar 10 are given have the following functions.
[0046]
The communication signal processing apparatus 1 has a function as a communication means for performing communication with the leaky coaxial cable (LCX cable) D and inter-vehicle communication, and an antenna or a transmitter / receiver provided in the vehicle for each communication. This is performed via communication devices 7 and 11 consisting of:
[0047]
In this case, in the communication with the leaky coaxial cable D, speed command information, road curvature information, traffic jam information, emergency message information, etc. in the travel area of the vehicle are received from the leaky coaxial cable D. The car ID number is sent. From this ID number, the traveling position of each vehicle is grasped on the leaky coaxial cable D side. Then, the communication signal processing device 1 gives the received speed command information and the like to the control plan processing device 2.
[0048]
On the other hand, in the inter-vehicle communication, the vehicle's momentary travel position (travel distance), speed (vehicle speed), front and rear, between the preceding vehicle and the following vehicle, as will be described later for each vehicle. Data indicating acceleration, a speed plan described later, and the like are transmitted / received to / from each other. And those data are given to the control plan processing apparatus 2 from the communication signal processing apparatus 1 in each vehicle. Therefore, on the side of the following vehicle, the communication signal processing device 1 constitutes means for grasping the traveling state such as the speed and acceleration of the preceding vehicle.
[0049]
The communication signal processing device 1 also has a function as a travel position recognition unit that recognizes the travel position of the host vehicle on the travel route B.
[0050]
In the present embodiment, the travel position is recognized as follows. That is, the automatic traveling vehicle of the present embodiment basically travels on the travel route B on which the magnetic information source C is arranged, so that the travel distance of the vehicle on the travel route B is the vehicle travel distance on the travel route B. It shows the traveling position. Therefore, the communication signal processing device 1 counts the number of detections of the magnetic information source C detected by the magnetic sensor 6 after starting traveling on the traveling route B, and the interval of the magnetic information source C is counted as the number of detections. The distance obtained by multiplying (constant) is grasped as the travel distance of the vehicle on the travel route B. However, the vehicle may deviate from the travel route B and miss the detection of the magnetic information source C. In such a case, the travel distance is grasped based on the output of the wheel pulse sensor 8. Then, based on the travel distance grasped in this way, the travel position of the vehicle is recognized on the map data of the travel route B possessed by the vehicle and given to the control plan processing device 2. In this case, the map data of the travel route B is represented as point sequence data of the magnetic information source C, which may be stored in advance in a storage device of the vehicle, or with the leaky coaxial cable D or the like. You may make it receive for every predetermined traveling area from the outside by communication.
[0051]
In this embodiment, the magnetic information source C on the travel route B is provided with bit information obtained by reversing the magnetic polarity at intervals of, for example, 500 m, and every time this bit information is detected by the magnetic sensor 6. Further, the travel distance is corrected based on the interval of 500 m (for example, the travel distance is corrected to be an integral multiple of 500 m).
[0052]
The control plan processing device 2 is connected to an automatic travel start switch 12 and starts creating information for automatic travel in response to an ON operation of the automatic travel start switch 12.
[0053]
This control plan processing device 2 has a function as a speed plan creation means for creating a speed plan for defining the relationship between the travel position and speed of the vehicle on the travel route B, and a communication signal processing device from the leaky coaxial cable D The speed plan is created based on speed command information corresponding to the travel area of the vehicle given through 1. In this case, a speed plan is created so as to follow the speed instructed from the leaky coaxial cable D. For example, when a speed command of 80 km / h is given in a certain traveling area, if the current vehicle speed is 78 km / h, the vehicle speed is increased to a predetermined acceleration (for example, 2 km / h / min up to 80 km / h). ) And then create a speed plan to maintain a speed of 80 km / h.
[0054]
Further, the control plan processing device 2 arrives to be reached after a predetermined time T (1.5 seconds in the present embodiment, for example) determined in advance from the current vehicle travel position based on the speed plan created as described above. It has a function as planned value determination means for determining the planned position and the planned speed of the vehicle at the planned arrival position. In this function, for example, if the speed plan from the current position of the vehicle is created so as to maintain a constant speed of 80 km / h (22.2 m / sec), the predetermined time T (1.5 sec) The later planned arrival position is a point that has traveled 33.3 m from the current position on the travel route B, and the planned speed at the planned arrival position is 80 km / h.
[0055]
Further, the control plan processing device 2 has functions as an expected value calculation unit, a deviation calculation unit, and a speed plan acceleration / deceleration data calculation unit described below. It also has functions as a predicted runner value calculation means, an expected inter-vehicle distance calculation means, an inter-vehicle speed difference calculation means, and an inter-vehicle control acceleration / deceleration data calculation means.
[0056]
The function as the predicted value calculation means is to obtain the predicted arrival position and predicted speed of the vehicle after the predetermined time T. The predicted arrival position is obtained from the current travel position (travel distance) of the host vehicle, the current speed, and the current acceleration given from the communication signal processing device 1 by calculation described later. It calculates | requires by the below-mentioned calculation from acceleration.
[0057]
In this case, in this embodiment, the vehicle speed for obtaining the predicted arrival position and the predicted speed is basically the latest first-order differential value of the running position of the vehicle from moment to moment given from the communication signal processing device 1. That is, it is obtained from the amount of change in travel position per unit time. Similarly, the acceleration of the vehicle is basically obtained from the latest second-order differential value of the travel position of the vehicle from moment to moment, that is, the change speed of the travel position per unit time. Then, the predicted arrival position and the predicted speed are obtained using the vehicle speed and acceleration thus obtained. Thereby, a means for grasping the own vehicle speed and the own vehicle acceleration is configured. However, when the vehicle deviates from the travel route B and cannot correctly grasp the travel position, the speed detected by the change amount per unit time of the travel distance grasped by the output of the wheel pulse sensor 8. Further, the predicted arrival position and the predicted speed are obtained using the acceleration detected by the longitudinal acceleration sensor. In this case, the speed of the vehicle may be grasped using a speed sensor.
[0058]
The function as the deviation calculating means obtains a distance deviation (position error) between a predicted arrival position after a predetermined time T based on the speed plan and the predicted arrival position, and a plan after a predetermined time T based on the speed plan. A speed deviation (speed error) between the speed and the predicted speed is obtained, and the calculation is performed by a subtraction operation.
[0059]
The function as the speed planning acceleration / deceleration data calculating means is for creating acceleration / deceleration correction data (control amount for correcting the acceleration / deceleration of the vehicle) for vehicle speed planning based on the distance deviation and the speed deviation. In this embodiment, acceleration / deceleration correction data for speed planning is created by adding values obtained by multiplying the distance deviation and speed deviation by a predetermined gain coefficient to each other.
[0060]
Further, the function as the preceding vehicle predicted value calculation means on the following vehicle side is to obtain the predicted arrival position and the predicted speed of the preceding vehicle after the predetermined time T. The predicted arrival position of the preceding vehicle is determined based on the current traveling position (travel distance), the current speed, and the current acceleration of the preceding vehicle, which are grasped via the communication signal processing device 1 of the own vehicle by the inter-vehicle communication. The expected speed of the preceding vehicle is obtained from the current speed and acceleration of the preceding vehicle by the following computation similar to the case of the host vehicle. In this case, the current speed and acceleration of the preceding vehicle are obtained from the data on the traveling position of the preceding vehicle given by inter-vehicle communication, as described above, using the first-order differential value and the second-order differential value of the traveling position. You may make it grasp.
[0061]
The function as the predicted inter-vehicle distance calculation means on the side of the following vehicle is to obtain the inter-vehicle distance between the host vehicle and the preceding vehicle expected after the predetermined time T, and the predicted arrival of the preceding vehicle is obtained as described above. By calculating the distance difference between the position and the predicted arrival position of the own vehicle as described above in the own vehicle, the expected inter-vehicle distance after a predetermined time T is obtained.
[0062]
Similarly, the function as the inter-vehicle speed difference calculation means on the following vehicle side is to obtain a speed difference from the preceding vehicle expected after the predetermined time T, and the predicted speed of the preceding vehicle and the predicted speed of the own vehicle Is calculated to obtain the inter-vehicle speed difference after a predetermined time T.
[0063]
Further, the inter-vehicle control acceleration / deceleration data calculating means on the following vehicle side is based on the predicted inter-vehicle distance and inter-vehicle speed difference, and the acceleration / deceleration correction data (control amount for correcting the acceleration / deceleration of the vehicle) for inter-vehicle control of the vehicle Is to create. In the present embodiment, a value obtained by multiplying a deviation between the predicted inter-vehicle distance and a target inter-vehicle distance (which will be described later) according to the speed of the host vehicle or the preceding vehicle by a predetermined gain coefficient (this is the present invention). And the value obtained by multiplying the inter-vehicle speed difference by a predetermined gain coefficient (this corresponds to the second acceleration / deceleration correction data in the present invention). By adding, comprehensive acceleration / deceleration correction data for inter-vehicle control is created.
[0064]
The control plan processing apparatus 2 having these functions is further configured based on the output of the two magnetic sensors 6 before and after the vehicle (position data in the lateral direction of each magnetic sensor 6 with respect to the travel path B). The current lateral position deviation or directional deviation of the vehicle with respect to the information source row) (angle θ between the vehicle and the travel route B, see FIG. 2) is obtained. Further, the control plan processing device 2 determines the lateral position deviation with respect to the travel route B of the vehicle after the predetermined time T based on the current speed and steering amount of the vehicle, the curvature information of the road given from the leaky coaxial cable D, and the like. The direction deviation is predicted. These data are used for steering control for causing the vehicle to travel along the travel route B.
[0065]
In the case of a following vehicle, the control plan processing device 2 displays data such as the own vehicle speed, the preceding vehicle speed, the inter-vehicle distance to the preceding vehicle, the front road shape, the lane shape, and the like on the display device 18 and the voice output device 17. Output to.
[0066]
In the case of a preceding vehicle, data such as the speed of the own vehicle, the speed of the following vehicle, the inter-vehicle distance to the following vehicle, the shape of the front road and the lane shape are output to the display device 18 and the audio output device 17.
[0067]
Here, the above-mentioned inter-vehicle distance between the preceding vehicle and the following vehicle is obtained by the above-mentioned inter-vehicle communication or the laser radar 10, and data such as the road shape and the lane shape in the front are obtained by communication with the leaky coaxial cable D. It is what
[0068]
In the present embodiment, the predetermined time T is set to 1.5 seconds, but is preferably set in the range of 1 second to 2 seconds.
[0069]
The lateral direction control device 3 generates a steering angle instruction signal for moving the vehicle along the travel route B based on the output result of the control plan processing device 2 (data such as the above-described lateral position deviation and direction deviation). And the actuator 14 provided in the steering operation transmission system of the vehicle is controlled by the steering angle instruction signal.
[0070]
Under the control of the actuator 14, the steering is automatically controlled to travel along the travel route B (magnetic information source row).
[0071]
The vehicle speed control device 4 generates an acceleration instruction signal based on the acceleration / deceleration correction data generated by the control plan processing device 2, and the actuator 15 provided in the throttle system and the actuator 16 provided in the brake system based on the acceleration instruction signal. To control.
[0072]
Under the control of the actuators 15 and 16, the throttle system and brake system of the vehicle are operated, and the vehicle is accelerated and decelerated.
[0073]
The vehicle speed control device 4 is connected to a brake pedal switch 13 for detecting the operation of a brake pedal (not shown). When it is detected that the brake pedal is depressed by a signal from the switch 13, Cancel vehicle speed control.
[0074]
Further, the vehicle speed control device 4 controls the brake amount based on the output of the laser radar 10 depending on the situation, for example, when an obstacle other than the preceding vehicle is detected by the laser radar 10.
[0075]
Next, vehicle speed control in the automatic traveling vehicle of this embodiment will be described with reference to the block diagram of FIG.
[0076]
As described above, the own vehicle position Xi (0) 21 obtained by the communication signal processing device 1 based on the detection signal of the magnetic sensor 6 and the own vehicle position obtained by the control plan processing device 2 from the own vehicle position Xi (0). The vehicle speed Vi (0) (first-order differential value) 22 and the own-vehicle acceleration Ai (0) (second-order differential value of position) 23 indicate the state after T seconds of the own vehicle in the control plan processing device 2. The data is output to the expected processing unit 24.
[0077]
The processing unit 24 functions as the predicted value calculation means. The predicted arrival position Xi (T) after T seconds and the predicted speed Vi (T) after T seconds are expressed by the following equations (1) and (2), respectively. )
[0078]
Vi (T) = Vi (0) + Ai (0) x T (1)
Xi (T) = Xi (0) + Vi (O) × T + 1/2 × Ai (0) × T ² (2)
On the other hand, the control plan processing unit 25 of the control plan processing device 2 has functions as the speed plan creating means and the planned value determining means, and is based on the speed command from the leaky coaxial cable D as described above. A planned speed plan is created, and an expected arrival position Xi ′ (T) and a planned speed Vi ′ (T) after T seconds are obtained.
[0079]
The predicted arrival position Xi (T) and the predicted speed Vi (T) determined by the processing unit 24 as described above, and the expected arrival position Xi ′ (T) and the predicted speed Vi ′ (T) determined by the processing unit 25. Is output to the deviation calculator 50 having the function as the deviation calculating means. The deviation calculation unit 50 subtracts the expected arrival position Xi (T) and the expected speed Vi (T) from the expected arrival position Xi ′ (T) and the expected speed Vi ′ (T), respectively, thereby obtaining a distance after T seconds. The deviation and the speed deviation are calculated and output to the conversion unit 26 having a function as the speed planning acceleration / deceleration data creating means.
[0080]
The conversion unit 26 generates acceleration / deceleration correction data obtained by adding the values obtained by multiplying the distance deviation and the speed deviation by predetermined gains Kx and Ku to each other, and the comparison is provided in the vehicle speed control device 4. To the unit 27.
[0081]
The above processing is performed in the same manner for both the preceding vehicle and the following vehicle.
[0082]
In the following vehicle, the current traveling position Xi-1 (0) 28, speed Vi-1 (0) 29, and acceleration Ai-1 () of the preceding vehicle obtained by inter-vehicle communication with the preceding vehicle. 0) 30 is output to the processing unit 31 that predicts the state after T seconds of the preceding vehicle in the control plan processing device 2 for the following vehicle.
[0083]
The processing unit 31 functions as the preceding vehicle predicted value calculation means, and the predicted arrival position Xi-1 (T) after T seconds after the preceding vehicle and the predicted speed Vi-1 (T seconds after). T) is obtained by an arithmetic expression (see FIG. 3) having the same form as the expressions (1) and (2).
[0084]
The predicted arrival position Xi-1 (T) and the predicted speed Vi-1 (T) of the preceding vehicle determined by the processing unit 31 are the predicted arrival position of the own vehicle (following vehicle) determined by the processing unit 24. Along with the Xi (T) and the predicted speed Vi (T), it is output to the inter-vehicle calculation unit 40 that functions as the predicted inter-vehicle distance calculating means and the inter-vehicle speed difference calculating means. In the inter-vehicle distance calculation unit 40, the predicted arrival position of the vehicle (following vehicle) after T seconds from the estimated arrival position Xi-1 (T) and the expected speed Vi-1 (T) of the preceding vehicle after T seconds. By subtracting Xi (T) and predicted speed Vi (T), the predicted inter-vehicle distance and inter-vehicle speed difference after T seconds are calculated.
[0085]
Further, the control plan processing apparatus 2 includes a speed difference between the own vehicle speed Vi (0) 22 of the following vehicle and the preceding vehicle speed Vi-1 (0) 29 of the preceding vehicle (| Vi (0) −Vi− Based on the magnitude of 1 (0) |), target inter-vehicle distance adjustment means 32 is also provided for creating inter-vehicle distance instruction data (data indicating the target inter-vehicle distance) between the preceding vehicle and the following vehicle.
[0086]
This target inter-vehicle distance adjusting means 32 is a speed difference (| Vi (0) −Vi-1 (0)) between the own vehicle speed Vi (0) 22 and the preceding vehicle speed Vi-1 (0) 29 of the preceding vehicle. |) Is compared with a predetermined value (predetermined speed difference), and when the speed difference (| Vi (0) −Vi-1 (0) |) is a predetermined value or larger, Instruction data of the inter-vehicle distance proportional to the size of the own vehicle speed Vi (0) 22 is created. Conversely, when the speed difference (| Vi (0) −Vi-1 (0) |) is a relatively small value equal to or smaller than a predetermined value, the speed of the preceding vehicle speed Vi-1 (0) 29 is increased. Produce proportional vehicle distance instruction data. When creating the inter-vehicle distance instruction data proportional to the host vehicle speed Vi (0) 22, and when creating the inter-vehicle distance instruction data proportional to the preceding vehicle speed Vi-1 (0) 29, Even in this case, for example, based on the proportional function shown in FIG. 4A, the inter-vehicle distance instruction data corresponding to the speed Vi (0) or Vi-1 (0) is generated. . In the present embodiment, the predetermined value is set to 10 km / h, for example.
[0087]
The inter-vehicle distance instruction data (target inter-distance data) created in this way is given to the inter-vehicle distance calculation unit 40, and the inter-vehicle distance calculation unit 40 deviates between the inter-vehicle distance instruction data and the predicted inter-vehicle distance. Is required.
As described above, the inter-vehicle distance data (deviation between the predicted inter-vehicle distance and the target inter-vehicle distance) calculated by the inter-vehicle arithmetic unit 40 and the inter-vehicle speed difference data are converted to have the function as the inter-vehicle control acceleration / deceleration data calculating means. Is output to the unit 33. The conversion unit 33 generates acceleration / deceleration correction data obtained by adding the values obtained by multiplying the inter-vehicle distance data and the inter-vehicle speed difference data by predetermined gains Kx1 and Ku1, respectively. 4 to the comparison unit 27.
[0088]
In the vehicle speed control device 4, the comparison unit 27 includes acceleration / deceleration correction data (output of the conversion unit 26) based on the predicted deviation of the host vehicle after T seconds with respect to the speed plan described above, and the preceding vehicle after T seconds described above. And acceleration / deceleration correction data (output of the conversion unit 33) based on the predicted inter-vehicle distance and inter-vehicle speed difference, and the acceleration on the forward side of the vehicle is small so that the following vehicle does not approach the preceding vehicle too much. This acceleration / deceleration correction data is alternatively selected and output to the throttle-side integrator 41 and the brake-side integrator 42.
[0089]
In this case, in the preceding vehicle, if there is no other vehicle in front of the preceding vehicle, or the other vehicle in front is sufficiently away from the own vehicle, the comparison unit 27 performs the above-described speed plan. Acceleration / deceleration correction data (output of the conversion unit 26) based on the predicted deviation after T seconds of the host vehicle is output.
[0090]
Further, for example, the comparison unit 27 may output correction data on the conversion unit 26 side on the preceding vehicle side and output correction data on the conversion unit 33 side on the following vehicle side.
[0091]
Thus, the integrators 41 and 42 to which the acceleration / deceleration correction data is input integrates the acceleration / deceleration correction data, and the integrated values (which correspond to the target vehicle speed) are respectively converted into the throttle control amount conversion unit 34 and Output to the brake control amount conversion unit 35.
[0092]
In addition to the output of the integrator 41, the throttle control amount conversion unit 34 is provided with data such as the current vehicle speed of the vehicle, the number of rotations of an engine (not shown), the number of gear stages of the transmission, and the like. The throttle opening degree is determined using a map or the like. Based on the throttle instruction opening, the throttle control unit 36 gives an instruction duty to the actuator 15 that defines the operation amount of the throttle actuator 15, thereby controlling the actuator 15.
[0093]
In addition to the output of the integrator 42, the brake control amount conversion unit 35 is provided with the current vehicle speed data of the vehicle, and the command pressure of the brake is determined from the data using a map or the like. Based on this brake command pressure, the brake control unit 37 gives a command duty to the actuator 16 that defines the operation amount of the brake actuator 16, thereby controlling the actuator 16.
[0094]
By the control as described above, in the preceding vehicle, the vehicle speed control is performed so as to follow the speed plan by the acceleration / deceleration correction data for the speed plan based on the predicted deviation after T seconds of the own vehicle with respect to the speed plan. . In the following vehicle, the own vehicle speed Vi (0) or the preceding vehicle speed Vi-1 () is determined by the acceleration / deceleration correction data based on the estimated distance between the preceding vehicle and the speed difference between the preceding vehicle after T seconds. The vehicle speed control is performed so that the inter-vehicle distance according to the inter-vehicle distance instruction data corresponding to 0) is maintained.
[0095]
In the lateral direction (steering direction) position control in this embodiment, the lateral position deviation and the direction deviation (angle) with respect to the travel route B at the current position of the vehicle obtained based on the outputs of the magnetic sensors 6 before and after the vehicle. Deviation) and the curvature information of the road ahead of the vehicle obtained from the leaky coaxial cable D, the position deviation and the direction deviation between the predicted arrival position of the vehicle after a predetermined time and the target arrival position on the travel route B are obtained. The steering amount is obtained so that the vehicle follows the travel route B based on the positional deviation and the direction deviation.
[0096]
According to the automatic traveling vehicle of the present embodiment described above, on the following vehicle side, the inter-vehicle distance depends on the speed difference between the own vehicle and the preceding vehicle (| Vi (0) −Vi-1 (0) |). Because the command data (target inter-vehicle distance data) is generated according to the own vehicle speed Vi (0) or according to the preceding vehicle speed Vi-1 (0), Therefore, the vehicle can travel smoothly following the preceding vehicle while ensuring an appropriate inter-vehicle distance without causing a situation in which the host vehicle is too close to the preceding vehicle when the vehicle is decelerated or stopped.
[0097]
That is, for example, when the preceding vehicle starts and accelerates from the stop state of the preceding vehicle and the own vehicle and the speed difference from the own vehicle (| Vi (0) −Vi-1 (0) |) increases, The distance instruction data is created according to the vehicle speed Vi (0). Immediately after the start of the start and acceleration of the preceding vehicle, the host vehicle speed Vi (0) is still low, so the inter-vehicle distance indication data is also small, and therefore the host vehicle has a low inter-vehicle distance from the preceding vehicle. The vehicle is started and accelerated so as to be adjusted to a shorter inter-vehicle distance according to the speed Vi (0). For this reason, the own vehicle travels smoothly following the preceding vehicle.
[0098]
In addition, due to the acceleration of the host vehicle, the speed difference (| Vi (0) −Vi-1 (0) |) becomes smaller, and the preceding vehicle and the own vehicle (following vehicle) are stationary at almost the same speed. When traveling is started, the inter-vehicle distance instruction data is generated according to the preceding vehicle speed Vi-1 (0). Therefore, not only when the preceding vehicle is traveling at a constant speed, but also when the preceding vehicle is slowly changing the speed, the appropriate inter-vehicle distance according to the preceding vehicle speed Vi-1 (0) While holding the vehicle, the vehicle smoothly follows the preceding vehicle.
[0099]
Furthermore, while the vehicle is running, traffic jam information and accident information from a leaky coaxial cable, for example, is received by the preceding vehicle, and the preceding vehicle has stopped due to a sudden deceleration or due to traffic jams or breakdowns. When the vehicle is recognized as the preceding vehicle, the speed difference between the preceding vehicle and the own vehicle (| Vi (0) −Vi-1 (0) |) becomes large. Created according to vehicle speed Vi (0). At this time, since the host vehicle speed Vi (0) is still high, the instruction data of the inter-vehicle distance is also large.Therefore, the inter-vehicle distance from the preceding vehicle is a longer inter-vehicle distance corresponding to the higher host vehicle speed Vi (0). The host vehicle is decelerated so as to be adjusted to the distance. For this reason, the own vehicle decelerates at a large deceleration rate, and the situation where the own vehicle suddenly approaches the preceding vehicle is avoided.
[0100]
Further, in the automatic traveling vehicle of the present embodiment, the acceleration / deceleration correction data for inter-vehicle control is created according to the deviation between the expected inter-vehicle distance after T seconds and the inter-vehicle distance instruction data. Since the distance is controlled so as to follow the instruction data, the operation of performing the follow-up traveling is ensured and smoothly performed while ensuring an appropriate inter-vehicle distance as described above, regardless of the delay in the control of the acceleration / deceleration of the own vehicle. be able to.
[0101]
Further, not only the deviation between the predicted inter-vehicle distance and the inter-vehicle distance instruction data, but also the acceleration / deceleration correction data is generated according to the expected inter-vehicle speed difference after T seconds, thereby controlling the vehicle speed of the own vehicle (following vehicle). Therefore, in a state where the inter-vehicle speed difference becomes large due to acceleration or deceleration of the preceding vehicle, the acceleration or deceleration of the own vehicle is also performed with a relatively large degree accordingly. Accordingly, it is possible to quickly accelerate or decelerate the own vehicle in accordance with the acceleration or deceleration of the preceding vehicle.
[0102]
In addition, because the system configuration is the same for the preceding vehicle and the following vehicle, automatic traveling suitable for each of the preceding vehicle and the following vehicle can be performed with a slight difference in processing on the software (program). Can do.
[0103]
Further, since the systems (devices 1 to 4) are modularized and each has a CPU, signal processing can be performed with extremely high accuracy and high speed.
[0104]
In the embodiment described above, the wheel pulse sensor 8, the acceleration sensor 9, and the laser radar 10 are provided in consideration of the case where the magnetic information source C cannot be detected. The vehicle travel position (travel distance) may be ascertained only by the number of times detected, and the speed and acceleration of the vehicle may be ascertained by first-order and second-order differentiation of the travel position.
[0105]
The speed of the preceding vehicle and the distance between the vehicles may be obtained by image processing using a radar or a CCD camera.
[0106]
Further, in the present embodiment, the one that automatically travels on the predetermined travel route B while detecting the magnetic information source C is shown. However, by processing an image in front of the vehicle by a CCD camera or the like, the travel position of the host vehicle The present invention can also be applied to a vehicle that automatically travels while recognizing the vehicle.
[Brief description of the drawings]
FIG. 1 is an overall configuration diagram showing a tracking system for an autonomous vehicle according to an embodiment of the present invention.
FIG. 2 is a configuration diagram showing magnetic sensing of the autonomous vehicle shown in FIG. 1;
FIG. 3 is a block diagram showing vehicle speed control of the autonomous vehicle shown in FIG. 1;
FIG. 4 is a proportional function diagram of an inter-vehicle distance and a vehicle speed for a conventional inter-vehicle distance instruction.
[Explanation of symbols]
DESCRIPTION OF SYMBOLS 1 ... Communication signal processing apparatus, 2 ... Control plan processing apparatus, 4 ... Vehicle speed control means, 32 ... Target inter-vehicle distance adjustment means.

Claims

前走車との車間距離を制御しつつ該前走車を自動追従走行する自動走行車において、自車速度を把握する手段と、前走車速度を把握する手段と、前記自車速度及び前走車速度の速度差をあらかじめ定めた所定値と比較し、その比較結果に基づき前記自車速度又は前走車速度に応じて自車と前走車との車間距離を調整するための自車の加減速度修正データを生成する手段と、該加減速度修正データに応じて自車の加減速度を制御する制御手段とを具備し、前記加減速度修正データを生成する手段は、前記速度差が前記所定値以下であるとき、前記前走車速度に応じて前記加減速度修正データを生成し、前記速度差が前記所定値以上であるとき、前記自車速度に応じて前記加減速度修正データを生成することを特徴とする自動走行車。In an automatic traveling vehicle that automatically follows the preceding vehicle while controlling the distance between the preceding vehicle and the preceding vehicle, means for grasping the own vehicle speed, means for grasping the preceding vehicle speed, the own vehicle speed and the front vehicle The own vehicle for comparing the speed difference of the traveling vehicle with a predetermined value determined in advance and adjusting the distance between the own vehicle and the preceding vehicle according to the comparison result or the preceding vehicle speed. Means for generating the acceleration / deceleration correction data, and control means for controlling the acceleration / deceleration of the host vehicle according to the acceleration / deceleration correction data. The means for generating the acceleration / deceleration correction data has the speed difference as described above. When it is less than a predetermined value, the acceleration / deceleration correction data is generated according to the preceding vehicle speed, and when the speed difference is equal to or greater than the predetermined value, the acceleration / deceleration correction data is generated according to the own vehicle speed. A self-propelled vehicle characterized by

前記加減速度修正データを生成する手段は、前記自車と前走車との車間距離を把握する手段と、前記速度差と前記所定値との比較結果に基づき、前記自車速度又は前走車速度に応じて自車と前走車との車間距離の指示データを生成する手段と、前記把握された車間距離と該車間距離の前記指示データとの偏差に応じて前記加減速度修正データを生成する手段とから成り、前記車間距離の指示データを生成する手段は、前記速度差が前記所定値以下であるとき、前記前走車速度に応じて前記車間距離の指示データを生成し、前記速度差が前記所定値以上であるとき、前記自車速度に応じて前記車間距離の指示データを生成することを特徴とする請求項１記載の自動走行車。The means for generating the acceleration / deceleration correction data is based on the comparison result between the speed difference and the predetermined value based on the means for determining the inter-vehicle distance between the own vehicle and the preceding vehicle, and the preceding vehicle speed or the preceding vehicle. A means for generating an inter-vehicle distance instruction data between the host vehicle and the preceding vehicle according to the speed, and an acceleration / deceleration correction data according to a deviation between the grasped inter-vehicle distance and the instruction data of the inter-vehicle distance. And the means for generating the inter-vehicle distance instruction data generates the inter-vehicle distance instruction data according to the preceding vehicle speed when the speed difference is equal to or less than the predetermined value. 2. The automatic traveling vehicle according to claim 1, wherein when the difference is equal to or greater than the predetermined value, the inter-vehicle distance instruction data is generated according to the own vehicle speed.

前記車間距離の指示データは、前記自車速度又は前走車速度の大きさに比例した大きさのデータであることを特徴とする請求項２記載の自動走行車。3. The automatic traveling vehicle according to claim 2, wherein the inter-vehicle distance instruction data is data having a size proportional to the size of the own vehicle speed or the preceding vehicle speed.

前記自車速度と前走車速度との速度差に応じて自車の第２の加減速度修正データを生成する手段を具備し、前記制御手段は、前記加減速度修正データと前記第２の加減速度修正データとの両者に応じて自車の加減速度を制御することを特徴とする請求項１乃至３のいずれかに記載の自動走行車。Means for generating second acceleration / deceleration correction data of the own vehicle in accordance with the speed difference between the host vehicle speed and the preceding vehicle speed, and the control means includes the acceleration / deceleration correction data and the second acceleration / deceleration data; The automatic traveling vehicle according to any one of claims 1 to 3, wherein the acceleration / deceleration of the host vehicle is controlled in accordance with both of the speed correction data.

少なくとも前走車と自車との間で各車両の速度を示す情報を相互に送受信する車々間通信手段を具備し、前記前走車速度を把握する手段は、該車々間通信手段により前走車から受信された情報により該前走車速度を把握することを特徴とする請求項１乃至４のいずれかに記載の自動走行車。At least vehicle-to-vehicle communication means for mutually transmitting and receiving information indicating the speed of each vehicle between the preceding vehicle and the host vehicle is provided, and means for grasping the preceding vehicle speed is detected from the preceding vehicle by the vehicle-to-vehicle communication means. The automatic traveling vehicle according to any one of claims 1 to 4, wherein the speed of the preceding vehicle is grasped based on the received information.

前走車との車間距離を制御しつつ該前走車を自動追従走行する自動走行車において、少なくとも自車速度及び自車加速度を含む自車の現在の走行状態を把握する手段と、少なくとも自車に対する前走車の位置、前走車速度及び前走車加速度を含む前走車の現在の走行状態を把握する手段と、前記自車の現在の走行状態及び前記前走車の現在の走行状態に基づき、所定時間後の自車と前走車との予想車間距離を求める手段と、前記自車速度及び前走車速度の速度差をあらかじめ定めた所定値と比較し、その比較結果に基づき前記自車速度又は前走車速度に応じて自車と前走車との車間距離の指示データを生成する手段と、前記予想車間距離と前記車間距離の指示データとの偏差に応じて自車の加減速度修正データを生成する手段と、該加減速度修正データに応じて自車の加減速度を制御する制御手段とを具備し、前記車間距離の指示データを生成する手段は、前記速度差が前記所定値以下であるとき、前記前走車速度に応じて前記車間距離の指示データを生成し、前記速度差が前記所定値以上であるとき、前記自車速度に応じて前記車間距離の指示データを生成することを特徴とする自動走行車。In an automatic traveling vehicle that automatically follows the preceding vehicle while controlling the inter-vehicle distance from the preceding vehicle, means for grasping the current traveling state of the own vehicle including at least the own vehicle speed and the own vehicle acceleration; Means for grasping the current traveling state of the preceding vehicle including the position of the preceding vehicle relative to the vehicle, the preceding vehicle speed and the acceleration of the preceding vehicle, and the current traveling state of the host vehicle and the current traveling of the preceding vehicle Based on the state, the means for obtaining the expected inter-vehicle distance between the host vehicle and the preceding vehicle after a predetermined time is compared with a predetermined value determined in advance, and the comparison result is Based on the vehicle speed or the preceding vehicle speed based on the difference between the vehicle-to-vehicle distance instruction data and the predicted distance between the vehicle and the vehicle-to-vehicle distance instruction data. Means for generating vehicle acceleration / deceleration correction data, and the acceleration / deceleration Control means for controlling the acceleration / deceleration of the host vehicle according to the positive data, and the means for generating the inter-vehicle distance instruction data, when the speed difference is equal to or less than the predetermined value, Accordingly, the inter-vehicle distance instruction data is generated, and when the speed difference is greater than or equal to the predetermined value, the inter-vehicle distance instruction data is generated according to the own vehicle speed.

前記車間距離の指示データは、前記自車速度又は前走車速度の大きさに比例した大きさのデータであることを特徴とする請求項６記載の自動走行車。7. The automatic traveling vehicle according to claim 6, wherein the inter-vehicle distance instruction data is data having a size proportional to the own vehicle speed or the preceding vehicle speed.

前記自車の現在の走行状態及び前記前走車の現在の走行状態に基づき、所定時間後の自車と前走車との予想車間速度差を求める手段と、該予想車間速度差に応じて自車の第２の加減速度修正データを生成する手段とを具備し、前記制御手段は、前記加減速度修正データと前記第２の加減速度修正データとの両者に応じて自車の加減速度を制御することを特徴とする請求項６又は７記載の自動走行車。Based on the current traveling state of the host vehicle and the current traveling state of the preceding vehicle, a means for obtaining a predicted inter-vehicle speed difference between the host vehicle and the preceding vehicle after a predetermined time, and according to the predicted inter-vehicle speed difference Means for generating second acceleration / deceleration correction data of the own vehicle, and the control means determines acceleration / deceleration of the own vehicle according to both the acceleration / deceleration correction data and the second acceleration / deceleration correction data. The automatic traveling vehicle according to claim 6 or 7, wherein the automatic traveling vehicle is controlled.

少なくとも前走車と自車との間で前記走行状態を示す情報を相互に送受信する車々間通信手段を具備し、前記前走車の走行状態を把握する手段は、該車々間通信手段により前走車から受信された情報により該前走車の走行状態を把握することを特徴とする請求項６乃至８のいずれかに記載の自動走行車。At least vehicle-to-vehicle communication means for mutually transmitting and receiving information indicating the traveling state between the preceding vehicle and the host vehicle is provided, and means for grasping the traveling state of the preceding vehicle is provided by the vehicle-to-vehicle communication means. The automatic traveling vehicle according to any one of claims 6 to 8, wherein the traveling state of the preceding vehicle is grasped based on information received from the vehicle.