JP2017165309A - 車両の走行制御装置 - Google Patents

Abstract

【課題】走行車線に追従して走行する走行制御と先行車両に追従して走行する走行制御とを切り換える際の自車両の挙動変化を抑制し、安定性を確保する。
【解決手段】自車両Ｃが破線状の白線Ｌ１，Ｌ２によって形成される車線内を走行する場合、カメラの視野Ｒ内で白線Ｌ１，Ｌ２が認識されているときに、先行車両Ｃ１の中心位置Ｘｃの車線中央位置Ｘｏからのオフセット量δを算出して、その値を記憶しておく。そして、両側の白線Ｌ１，Ｌ２が一時的にカメラの視野Ｒから外れて認識されなくなったとき、それまで車線中央位置Ｘｏにあった制御目標点を、先行車両Ｃ１の中心位置Ｘｃからオフセット量δだけシフトさせた位置とすることで、制御目標点の変動を抑制する。
【選択図】図２

Description

本発明は、自車両の走行車線及び自車両前方の先行車両を認識して走行制御を行う車両の走行制御装置に関する。

従来、自動車等の車両においては、自車両の走行車線及び自車両前方の先行車両をカメラやレーダ等により検知し、先行車両との車間距離を適正距離に制御すると共に、走行車線内での自車両の横方向の位置を制御して、車線中央位置や先行車両の中心位置に追従させる追従走行制御が知られている。

例えば、特許文献１には、道路白線が検出できるときには、車線中心線に追従する走行制御を行い、白線が先行車両によって隠れて検出できないときには、先行車両の中心位置に追従する走行制御を行う技術が開示されている。この先行技術では、先行車両への追従走行時に、先行車両が右左折する可能性を地図情報から判断した場合には制御ゲインを弱め、また、先行車両の横変位変化から蛇行を推定して追従制御を弱めることで、自車両の不適正な挙動変化を低減するようにしている。

特開２０００−２０８９６号公報

しかしながら、特許文献１に開示の技術では、車線への追従走行と先行車両への追従走行とを切り換える際の制御性については考慮されておらず、先行車両が車線中心線から偏って走行しているような状況では、車線追従走行制御から先行車両追従走行制御へ切り換えたとき、自車両の挙動変化が大きくなる虞がある。

例えば、図５に示すように、３車線の道路では中央車線は両側の白線Ｌ１．Ｌ２が破線状であるため、自車両Ｃが中央車線を走行しているときには、両側の白線Ｌ１．Ｌ２が同時にカメラの視野Ｒから外れて認識できなくなるシーンが周期的に出現する。両側の白線Ｌ１，Ｌ２を認識している状態では、白線Ｌ１．Ｌ２の中央位置への追従走行を行っているが、両側の白線Ｌ１，Ｌ２を認識できなくなったときには、先行車両Ｃ１への追従走行に切り換わる。このとき、先行車両Ｃ１の中心位置が車線中央位置からオフセットしていると、追従走行の目標点が車線中央位置から先行車両の中心位置へと変化して車両のふらつきが発生し、更には周期的な追従目標点の切り換わりによって自車両が蛇行する虞がある。

本発明は上記事情に鑑みてなされたもので、走行車線への追従走行制御と先行車両への追従走行制御とを切り換える際の自車両の挙動変化を抑制し、安定性を確保することのできる車両の走行制御装置を提供することを目的としている。

本発明の一態様による車両の走行制御装置は、自車両の走行車線及び自車両前方の先行車両を認識して、前記走行車線に追従して走行する走行制御と前記先行車両に追従して走行する走行制御とを切り換える車両の走行制御装置であって、前記走行車線を認識している状態で、前記走行車線の中央位置に対する前記先行車両の中心位置の横方向のオフセット量を算出する先行車両オフセット算出部と、前記走行車線を認識しているとき、前記走行車線の中央位置を前記走行車線に追従する走行制御の制御目標点として設定し、前記走行車線を認識している状態から前記走行車線を認識しない状態に移行したとき、前記先行車両の中心位置から前記オフセット量だけシフトさせた位置を、前記先行車両に追従する走行制御の制御目標点として設定する制御目標点設定部とを備える。

本発明によれば、走行車線への追従走行制御と先行車両への追従走行制御とを切り換える際の自車両の挙動変化を抑制し、安定性を確保することができる。

走行制御システムの構成図 先行車両のオフセットを考慮した目標制御点の変化を示す説明図 走行制御のフローチャート 制御目標点の変化を示す説明図 従来の追従走行切換時の自車両の挙動変化を示す説明図

以下、図面を参照して本発明の実施の形態を説明する。図１において、符号１０は、自動車等の車両の走行制御システムであり、車両の自律的な自動運転を含む走行制御を実行する。この走行制御システム１０は、走行制御装置１００を中心として、外部環境認識装置２０、地図情報処理装置３０、エンジン制御装置４０、変速機制御装置５０、ブレーキ制御装置６０、操舵制御装置７０等が車内ネットワークを形成する通信バス１５０を介して互いに接続されて構成されている。

外部環境認識装置２０は、車載のカメラ、ミリ波レーダ、レーザレーダ等の各種デバイスにより、自車両周囲の外部環境を認識する。本実施の形態においては、外部環境認識装置２０として、車載のカメラ１及び画像認識装置２による外部環境の認識を主として説明する。

カメラ１は、本実施の形態においては、同一対象物を異なる視点から撮像する２台のカメラ１ａ，１ｂで構成されるステレオカメラであり、ＣＣＤやＣＭＯＳ等の撮像素子を有するシャッタ同期のカメラである。これらのカメラ１ａ，１ｂは、例えば、車室内上部のフロントウィンドウ内側のルームミラー近傍に所定の基線長で配置されている。

カメラ１で撮像した左右一対の画像は、画像認識装置２で処理される。画像認識装置２は、ステレオマッチング処理により、左右画像の対応位置の画素ずれ量（視差）を求め、画素ずれ量を輝度データ等に変換して距離画像を生成する。距離画像上の点は、三角測量の原理から、自車両の車幅方向すなわち左右方向をＸ軸、車高方向をＹ軸、車長方向すなわち距離方向をＺ軸とする実空間上の点に座標変換され、自車両が走行する道路の白線（車線）、障害物、自車両の前方を走行する先行車両等が３次元的に認識される。

車線としての白線は、画像から白線の候補となる点群を抽出し、その候補点を結ぶ直線や曲線を算出することにより、認識することができる。例えば、画像上に設定された白線検出領域内において、水平方向（車幅方向）に設定した複数の探索ライン上で輝度が所定以上変化するエッジの検出を行って探索ライン毎に１組の白線開始点及び白線終了点を検出し、白線開始点と白線終了点との間の中間の領域を白線候補点として抽出する。

そして、単位時間当たりの車両移動量に基づく白線候補点の空間座標位置の時系列データを処理して左右の白線を近似するモデルを算出し、このモデルにより、白線を認識する。白線の近似モデルとしては、ハフ変換によって求めた直線成分を連結した近似モデルや、２次式等の曲線で近似したモデルを用いることができる。

地図情報処理装置３０は、地図データベースを備え、ＧＰＳ衛星等からの信号に基づいて自車両位置を測位し、地図データとの照合を行う。地図データベースには、車両走行の経路案内や車両の現在位置を表示するための地図データと、自動運転を含む運転支援制御を行うための高精細の地図データとが含まれている。

地図情報処理装置３０は、自車両位置の測位結果と地図データとの照合に基づく走行経路案内や交通情報を、図示しない表示装置を介してドライバに提示し、また、自車両及び先行車両が走行する道路の曲率、車線幅、路肩幅等の道路形状データや、道路方位角、道路白線種別、レーン数等の走行制御用の地図情報を出力する。

エンジン制御装置４０は、エンジン運転状態を検出する各種センサ類からの信号及び通信バス１５０を介して送信される各種制御情報に基づいて、エンジン（図示せず）の運転状態を制御する。エンジン制御装置４０は、例えば、吸入空気量、スロットル開度、エンジン水温、吸気温度、空燃比、クランク角、アクセル開度、その他の車両情報に基づき、燃料噴射制御、点火時期制御、電子制御スロットル弁の開度制御等を主要とするエンジン制御を実行する。

変速機制御装置５０は、変速位置や車速等を検出するセンサ類からの信号や通信バス１５０を介して送信される各種制御情報に基いて、自動変速機（図示せず）に供給する油圧を制御し、予め設定された変速特性に従って自動変速機を制御する。

ブレーキ制御装置６０は、例えば、ブレーキスイッチ、４輪の車輪速、ハンドル角、ヨーレート、その他の車両情報に基づき、４輪のブレーキ装置（図示せず）をドライバのブレーキ操作とは独立して制御する。また、ブレーキ制御装置６０は、各輪のブレーキ力に基づいて各輪のブレーキ液圧を算出して、アンチロック・ブレーキ・システムや横すべり防止制御等を行う。

操舵制御装置７０は、例えば、車速、ドライバの操舵トルク、ハンドル角、ヨーレート、その他の車両情報に基づき、車両の操舵系に設けた電動パワーステアリングモータ（図示せず）によるアシストトルクを制御する。また、操舵制御装置７０は、走行制御装置１００からの指示により、走行車線や先行車両に追従するための操舵量で電動パワーステアリングモータを駆動制御する。

次に、走行制御システム１０の中心となる走行制御装置１００について説明する。走行制御装置１００は、外部環境認識装置２０による外部環境の認識結果に基づいて、自車両の走行車線に追従して走行する走行制御と、先行車両に追従して走行する走行制御とを、エンジン制御装置４０、変速機制御装置５０、ブレーキ制御装置６０、及び操舵制御装置７０を介して実行する。これらの走行制御は、走行制御装置１００の主要部となる制御部１０１を中心として実行される。

詳細には、制御部１０１は、道路の白線を自車両の走行車線として検出し、この走行車線に沿った目標コースを設定する。この目標コースへの走行制御は、車線に追従する走行制御（車線追従走行制御）であり、自車両前方に先行車両が検出されていない場合、目標コース上を設定車速で走行するよう制御し、自車両前方に先行車両が検出されている場合には、先行車両と所定の車間距離を維持しながら目標コース上を設定車速で走行するよう制御する。

車線追従の目標コースは、左右の白線（自車両の走行車線）の横方向（幅方向）の中心位置の軌跡Ｐとして設定され、例えば、左右の白線を２次曲線で近似した場合、以下の（１）式で示すことができる。（１）式において、係数Ｋ１は目標コースの曲率成分、係数Ｋ２は目標コースのヨー角成分（自車両に対する目標コースの傾き成分）、係数Ｋ３は自車両に対する目標コースの横位置成分を示している。
Ｐ＝Ｋ１・Ｚ²＋Ｋ２・Ｚ＋Ｋ３ …（１）

この目標コースへの走行制御では、自車両の車幅方向の中心位置が目標コース上の制御目標点に一致するように、操舵制御装置７０を介して自車両の操舵角を制御する。この制御目標点への操舵制御は、自車両の車線内での横位置と制御目標点との偏差に基づくフィードバック制御を主として実行される。

例えば、以下の（２）式に示すように、自車両の横位置と制御目標点との偏差に基づくフィードバック分の操舵角αｆに、自車両のヨー角を目標コースのヨー角成分に一致させるための偏差のフィードバック分の操舵角αｙと、目標コースの曲率に基づくフィードフォーワード分の操舵角αｆｆとを加えて目標操舵角αrefを算出する。そして、この目標操舵角αrefを実現する目標操舵トルクで電動パワーステアリングモータが駆動制御される。
αref＝αｆ＋αｙ＋αｆｆ …（２）

一方、渋滞時等の低速走行時に先行車両に接近してカメラ１の視野内に白線が入らない場合や、走路の白線が無い或いは白線が途切れて認識できない場合には、制御部１０１は、先行車両に追従して走行する走行制御を行う。この先行車両への追従走行制御では、制御部１０１は、先行車両の走行軌跡に一致するように操舵制御装置７０を介した操舵制御を行うと共に、エンジン制御装置４０、変速機制御装置５０、ブレーキ制御装置６０を介した走行駆動制御を実行する。

先行車両の走行軌跡は、車線に基づく目標コースと同様に求めることができる。例えば、カメラ１の撮像画像の１フレーム当たりの自車両の移動量に基づいて先行車両の位置のフレーム毎の候補点を求め、この候補点の点群を近似する曲線を先行車両の走行軌跡として算出する。先行車両の位置は、カメラ１の撮像画像から先行車両の背面領域の横方向（車幅方向）の中心位置を求め、この中心位置を先行車両の位置を示す候補点とする。

そして、これらの候補点の点群に対して、例えば最小二乗法を適用することにより、前述の（１）式と同様の曲線を求め、この曲線を先行車両の走行軌跡とする。この場合、（１）式における係数Ｋ１は走行軌跡の曲率成分、係数Ｋ２は走行軌跡のヨー角成分（自車両に対する走行軌跡の傾き成分）、係数Ｋ３は自車両に対する走行軌跡の横位置成分を示すことになる。

先行車両の走行軌跡に追従する制御では、先行車両の背面領域の車幅方向の設定位置を制御目標点として設定し、自車両の車線内での横位置が制御目標点に一致するよう操舵角を修正することにより、自車両の進行方向を決定する制御となる。後述するように、制御目標点として設定する位置は、先行車両の背面領域の車幅方向の中心位置を基準として、この基準位置を、追従走行制御の切換時に適宜シフトさせる。

先行車両への追従走行における操舵制御は、基本的には車線への追従走行における操舵制御と同様であり、自車両の車線内での横位置と制御目標点との偏差に基づくフィードバック制御を主として実行される。但し、先行車両への追従走行制御では、比較的低速での走行が多いことから、前述の（２）式における曲率に基づくフィードフォワード分αｆｆは省略することができる。

前述したように、白線認識に基づく走行制御中に白線を認識できなくなった場合、先行車両に対する追従走行制御に切り換えられる。しかしながら、先行車両の中心位置が車線中央位置からオフセットしている場合、操舵制御の目標点が車線中央位置から先行車両の中心位置へと急激に移動されることになり、自車両の挙動が不安定になる虞がある。

例えば、自車両が３車線区間の道路で中央車線を走行している場合、車線両側の白線が破線状であるため、両側の白線が同時に見えなくなるシーンが周期的に出現する。このため、先行車両の中心位置が車線中央位置からオフセットしている場合には、白線が見えなくなるたびに制御目標点が変動して車両のふらつきが発生する。

これに対して、走行制御装置１００は、カメラ１による自車両前方の撮像画像から車線及び先行車両が認識されているとき、先行車両の車線中央位置からのオフセット量を算出して、その値を記憶しておく。そして、時系列的な撮像画像の認識情報や、地図情報処理装置３０からの地図情報から一時的に車線が認識できなく区間の出現が予想される場合、車線を認識できない区間では、先行車両の中心位置から先に記憶したオフセット量だけシフトさせた位置を制御目標点として設定し、先行車両への追従走行に切り換える。これにより、制御目標点の変動を抑制して車両のふらつき発生を防止することができる。白線の見えなくなる区間が想定より長い場合には、白線が無くなったと判断して制御目標点のシフトを解除する。

このため、走行制御装置１００は、図１に示すように、主機能部である制御部１０１に対して、先行車両オフセット算出部１０２、制御目標点設定部１０３を備えている。制御部１０１は、白線への追従走行制御と先行車両への追従走行制御とを、制御目標点設定部１０３で設定された制御目標点への追従走行制御として実行する。

先行車両オフセット算出部１０２は、カメラ１の撮像画像から認識される車線（白線）に対して、この車線内の先行車両の横位置を求め、車線中央位置からのオフセット量をオフセットの方向を含めて算出する。算出されたオフセット量はメモリに保存され、先行車両の動きに応じて随時算出される最新のオフセット量で更新される。

例えば、図２に示すように、自車両Ｃが破線状の白線Ｌ１，Ｌ２によって形成される車線内を走行する場合には、両側の白線Ｌ１，Ｌ２が同時にカメラの視野Ｒから外れて認識できなくシーンが周期的に出現する。このため、先行車両オフセット算出部１０２において、カメラの視野Ｒ内で白線Ｌ１，Ｌ２が認識されているときに、先行車両Ｃ１の中心位置Ｘｃの車線中央位置Ｘｏからのオフセット量δを算出して、その値を記憶しておく。

このオフセット量（記憶値）は、制御目標点設定部１０３において随時参照される。制御目標点設定部１０３は、外部環境認識装置２０（カメラ１及び画像認識装置２）による白線（車線）の認識状態に応じて、先行車両オフセット算出部１０２で算出された先行車両のオフセット量から車線或いは先行車両に対する追従走行における操舵制御の制御目標点を設定する。

すなわち、車線が認識されている状態では、制御目標点設定部１０３は、車線の中央位置を制御目標点として設定し、制御部１０１に送信して車線追従の走行制御とする。また、車線が認識されている状態から車線が認識されなくなった状態に移行したときには、先行車両オフセット算出部１０２で算出されたオフセット量を用い、先行車両の中心位置からオフセット量だけシフトさせた位置を、制御目標点とする。

図２の例では、両側の白線Ｌ１，Ｌ２が一時的にカメラの視野Ｒから外れて認識されなくなったとき、それまで車線中央位置Ｘｏにあった制御目標点を、先行車両Ｃ１の中心位置Ｘｃからオフセット量δだけシフトさせた位置とすることで、制御目標点の変動を抑制する。

尚、車線を認識しない状態が所定時間以上継続した場合には、先行車両のオフセット量をクリアして制御目標点を先行車両の中心位置とする通常の先行車追従走行制御に移行する。そして、先行車両の中心位置を制御目標点とする追従走行制御中に、車線が認識される状態に復帰したときには、制御目標点を先行車両の中心位置から車線中心位置に漸次移動させ、先行車両への追従走行から車線への追従走行に徐々に移行させる。

次に、走行制御装置１００における走行制御のプログラム処理について、図３に示すフローチャートを用いて説明する。

この走行制御では、最初のステップＳ１において、自車両の前方の所定範囲内に認識された先行車両が有るか否かを調べる。そして、先行車両が認識されていない場合には、本処理を抜け、先行車両が認識されている場合、ステップＳ２へ進んで左右両側の白線がカメラ視野外となって認識されない状態であるか否かを調べる。

ステップＳ２において両側の白線が認識されている場合、ステップＳ２からステップＳ３へ進み、自車両から先行車両までの距離を考慮して左右白線間の横方向の中央位置と先行車両の横位置との偏差（オフセット量）を算出し、メモリに保存する。そして、ステップＳ４で白線への追従走行制御を行う。この白線追従走行制御では、左右の白線の中央位置を制御目標点として、先行車両と所定の車間距離を維持しながら自車両の車線内横位置が制御目標点に収束するように、車速及び操舵角を制御する。

一方、ステップＳ２において両側の白線が認識されていない場合には、ステップＳ２からステップＳ５へ進み、メモリに保存されている先行車両の車線中央位置からのオフセット量を読み込む。そして、ステップＳ６で、先行車両の中心位置からオフセット量だけシフトさせた位置を制御目標点として、先行車両への追従走行制御を行う。

このときの追従走行制御は、先行車両の中心位置からオフセット量だけシフトさせた位置を制御目標点としているため、制御目標点の急激な変化を抑制することができる。直線状の道路や渋滞時等の極低速運転時には、実質的に車線中央位置への追従走行制御と同様になり、ドライバに制御切り換えによる違和感を与えることもない。但し、後述するステップＳ９，Ｓ１０でオフセット量がクリアされて既に先行車両追従走行制御となっている場合は除く。

その後、ステップＳ７へ進み、両側の白線が認識されていない状態から認識可能な状態となって両側の白線が認識されはじめたか否かを調べる。その結果、両側の白線が未だ認識されない場合には、ステップＳ７からステップＳ８へ進み、両側の白線が認識されなくなってから一定時間が経過したか否かを車速及び距離に基づいて判断する。

例えば、両側白線が破線状で道路上のマーキング部分が一定距離毎に断続する場合、道路の時系列的な画像認識情報や地図情報からマーキング間の破断区間の距離を取得しておく。そして、自自車両の車速から破断区間の距離を超えたか否かを判断することにより、白線を認識しない状態が一定時間以上継続したか否かを判断する。

ステップＳ８において、両側の白線が認識されなくなってから一定時間が経過していない場合には、ステップＳ７へ戻り、両側の白線が認識されなくなってから一定時間が経過している場合、ステップＳ９へ進んで、先行車両のオフセット量を０にクリアする。そして、ステップＳ１０で先行車両の中心位置を制御目標点にセットし、先行車両への追従走行制御を行う。

一方、ステップＳ７において、両側の白線が認識されていない状態から両側の白線が認識されはじめた場合には、ステップＳ７からステップＳ１１へ進んで、先行車両のオフセット量を０にクリアして制御目標点を先行車両から車線中央位置に漸次移動させる。そして、ステップＳ１２で車線に追従する走行制御に移行する。

この車線追従走行制御への移行では、先に先行車両の中心位置からオフセット量だけシフトさせた位置を制御目標点とする追従走行制御を行っていた場合には、制御目標点の移動量が小さく実質的に０の場合もある。これに対して、先行車両の中心位置を制御目標点とする追従走行制御を行っていた場合には、先行車両の横位置によっては制御目標点の移動が比較的大きくなることが予想される。

従って、図４に示すように、時間ｔ0で先行車両の中心位置を制御目標点とする追従走行制御に切り換えた後、制御目標点を先行車両の中心位置Ｘｃから車線中央位置Ｘｏに切り換える際には、時間ｔの経過とともに位置Ｘｃから位置Ｘｏに向かって徐々にオフセット量δが小さくなるように制御目標点を移動させることで、制御目標点の急激な変動を抑制する。

このように本実施の形態においては、車線を認識している状態で車線中央位置に対する先行車両の中心位置の横方向のオフセット量を予め算出しておき、車線を認識しない状態になったとき、先行車両の中心位置からオフセット量だけシフトさせた位置を制御目標点として、車線中央位置への追従走行制御から先行車両への追従走行制御に切り換える。これにより、車線追従走行制御と先行車両追従走行制御とを切り換える際の自車両の挙動変化を抑制して安定性を確保することができ、ドライバに不安感を与えることがない。

１ カメラ
２ 画像認識装置
１０ 走行制御システム
２０ 外部環境認識装置
７０ 操舵制御装置
１００ 走行制御装置
１０１ 制御部
１０２ 先行車両オフセット算出部
１０３ 制御目標点設定部

Claims (4)

1. 自車両の走行車線及び自車両前方の先行車両を認識して、前記走行車線に追従して走行する走行制御と前記先行車両に追従して走行する走行制御とを切り換える車両の走行制御装置であって、
   前記走行車線を認識している状態で、前記走行車線の中央位置に対する前記先行車両の中心位置の横方向のオフセット量を算出する先行車両オフセット算出部と、
   前記走行車線を認識しているとき、前記走行車線の中央位置を前記走行車線に追従する走行制御の制御目標点として設定し、前記走行車線を認識している状態から前記走行車線を認識しない状態に移行したとき、前記先行車両の中心位置から前記オフセット量だけシフトさせた位置を、前記先行車両に追従する走行制御の制御目標点として設定する制御目標点設定部と
   を備えることを特徴とする車両の走行制御装置。
2. 前記制御目標点設定部は、前記走行車線を認識しない状態が所定時間以上継続した場合、前記オフセット量をクリアして前記制御目標点を前記先行車両の中心位置とすることを特徴とする請求項１に記載の車両の走行制御装置。
3. 前記制御目標点設定部は、前記走行車線を認識しない状態で前記制御目標点を前記先行車両の中心位置とした後、前記走行車線を認識する状態に復帰したとき、前記制御目標点を前記走行車線の中心位置に漸次移動させることを特徴とする請求項２に記載の車両の走行制御装置。
4. 前記制御目標点設定部は、前記走行車線が一定距離毎に断続する場合、自車両の車速に基づいて前記走行車線の破断区間の距離を超えたか否かを判断することにより、前記走行車線を認識しない状態が所定時間以上継続したか否かを判断することを特徴とする請求項２又は３に記載の車両の走行制御装置。

Images