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

Description

本発明は、自車両が走行する目標経路への追従走行を制御する車両の走行制御装置に関する。

自動車等の車両においては、自車両の走行車線及び自車両前方の先行車両をカメラやレーダ等により検知し、先行車両との車間距離を適正距離に制御すると共に、自車両が車線中央位置や先行車両の中心位置を軌跡とする目標経路に沿って走行するように制御する追従走行制御の技術が実用化されている。追従走行制御を行う車両の走行制御装置は、例えば特開２０１７−１３５８６号公報に開示されている。

特開２０１７−１３５８６号公報には、追従走行制御中において自車両の走行車線をカメラ等により認識できない場合に、運転者のハンドル操作の情報に基づいて、走行車線中における自車両の車幅方向の位置を算出する技術が開示されている。

特開２０１７−１３５８６号公報

特開２０１７−１３５８６号公報に開示の技術では、先行車両が走行車線の中央から車幅方向の一方に偏って走行している場合には、運転者による操作が行われるまでは、自車両も先行車両と同様に走行車線の中央から車幅方向の一方に偏って走行する。車両の走行制御装置による追従走行制御時においては、運転者の省力化が図られることが好ましい。

本発明は前述した問題を解決するものであり、先行車両の走行軌跡に追従して走行する際に、自車両を走行車線の中央に維持することのできる車両の走行制御装置を提供することを目的とする。

本発明の一態様の車両の走行制御装置は、自車両が走行する目標経路を生成し、前記目標経路への追従走行を制御する車両の走行制御装置であって、前記自車両の測位結果を出力する測位装置と、前記自車両の走行車線の形状を示す道路形状データを出力する地図情報処理装置と、前記走行車線上において前記自車両の前方を走行する先行車両の前記自車両に対する相対位置を認識する外部環境認識装置と、前記道路形状データから取得される前記走行車線のカーブの入口座標、および前記測位結果と前記先行車両の相対位置から取得される前記先行車両が当該カーブに対応して旋回を開始する旋回開始座標、の比較から前記測位結果における前記自車両の前後方向の誤差量を算出し、前記道路形状データから取得される前記走行車線のカーブの曲率半径、および前記自車両の車速とヨーレートから算出される前記自車両の旋回半径、の比較から前記測位結果における前記自車両の車幅方向の誤差量を算出する測位誤差情報算出部と、を備える。

本発明によれば、先行車両の走行軌跡に追従して走行する際に、自車両を走行車線の中央に維持することのできる車両の走行制御装置を提供することができる。

走行制御システムの構成図である。 測位誤差情報算出部の動作を示すフローチャートである。 前後方向誤差情報算出処理のフローチャートである。 車幅方向誤差情報算出処理のフローチャートである。

以下に、本発明の好ましい形態について図面を参照して説明する。なお、以下の説明に用いる各図においては、各構成要素を図面上で認識可能な程度の大きさとするため、構成要素毎に縮尺を異ならせてあるものであり、本発明は、これらの図に記載された構成要素の数量、構成要素の形状、構成要素の大きさの比率、および各構成要素の相対的な位置関係のみに限定されるものではない。

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

図示しないが、車両は、車両の車速やヨーレート等の状態量を検出する状態量検出装置を備える。状態量検出装置は、車速センサ、加速度センサ、ヨーレートセンサおよび舵角センサを少なくとも含む。これらのセンサは公知の技術であるため、詳細な説明は省略する。

外部環境認識装置１０は、車載のカメラユニット１１、ミリ波レーダやレーザレーダ等のレーダ装置１２等の各種デバイスによる自車両周囲の物体の検出情報、路車間通信や車車間通信等のインフラ通信によって取得した交通情報、ＧＮＳＳ等の測位装置２０で測位した自車両の位置情報、地図情報処理装置３０からの地図情報等により、自車両周囲の外部環境を認識する。

以下では、外部環境認識装置１０における外部環境の認識処理として、カメラユニット１１で撮像した画像を処理して外部環境を認識する処理を主として説明する。カメラユニット１１は、例えば、同一対象物を異なる視点から撮像する２台のカメラで構成されるステレオカメラであり、ＣＣＤやＣＭＯＳ等の撮像素子を有するシャッタ同期のカメラで構成されている。このカメラユニット１１は、例えば、車室内上部のフロントウィンドウ内側のルームミラー近傍に２台のカメラが所定の基線長で車幅方向左右に配置されて構成されている。

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

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

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

測位装置２０は、複数の衛星からの信号に基づいて自車位置を測位する衛星航法を主として測位を行い、衛星からの信号（電波）の捕捉状態化や電波の反射によるマルチパスの影響等で測位精度が悪化した場合には、自車両の方位と移動距離に基づいて自己位置を測位する自律航法によって測位を行う。なお、測位装置２０は、路車間通信や車車間通信等のインフラ通信によって交通情報を取得する通信ユニットを一体的に備えるようにしても良い。

衛星航法による測位では、例えば、ＧＮＳＳ衛星等の複数の航法衛星から送信される軌道および時刻等に関する情報を含む信号を受信し、受信した信号に基づいて自車両の自己位置を３次元の絶対位置として測位する。また、自律航法による測位は、方位センサによって検出した自車両の進行方位と車速センサから出力される車速パルス等から算出した自車両の移動距離とに基づいて、算出位置（自車位置）の相対的な変化分としての自車位置を測位する。

地図情報処理装置３０は、地図データベースＤＢを備え、測位装置２０で測位した自車両の位置データから地図データベースＤＢの地図データ上での位置を特定して出力する。地図データベースＤＢには、例えば、主として車両走行の経路案内や車両の現在位置を表示する際に参照されるナビゲーション用の地図データと、この地図データよりも詳細な、自動運転を含む運転支援制御を行う際に参照される走行制御用の地図データとが保持されている。

ナビゲーション用の地図データは、現在のノードに対して前のノードと次のノードとがそれぞれリンクを介して結びつけられており、各リンクには、信号機、道路標識、建築物等に関する情報が保存されている。一方、走行制御用の高精細の地図データは、ノードと次のノードとの間に、複数のデータ点を有している。このデータ点には、自車両が走行する道路の曲率、車線幅、路肩幅等の道路形状データや、道路方位角、道路白線種別、レーン数等の走行制御用データが、データの信頼度やデータ更新の日付け等の属性データと共に保持されている。

地図情報処理装置３０は、自車両位置の測位結果と地図データとの照合を行い、その照合結果に基づく走行経路案内や交通情報を図示しない表示装置を介してドライバに提示する。また、地図情報処理装置３０は、自車両が走行する道路の曲率、車線幅、路肩幅等の道路形状データや、道路方位角、道路白線種別、レーン数等の走行制御用の地図情報を通信バス１５０を介して送信する。なお、走行制御用の地図情報は、主として走行制御装置１００に送信されるが、必要に応じて他の制御装置にも送信される。

更に、地図情報処理装置３０は、地図データベースＤＢの保守管理を行い、地図データベースＤＢのノード、リンク、データ点を検定して常に最新の状態に維持すると共に、データベース上にデータが存在しない領域についても新規データを作成・追加し、より詳細なデータベースを構築する。地図データベースＤＢのデータ更新および新規データの追加は、測位装置２０によって測位された位置データと、地図データベースＤＢに記憶されているデータとの照合によって行われる。

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

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

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

操舵制御装置７０は、電動アクチュエータの出力により車両の舵角を変化させる電動パワーステアリング装置を制御する。操舵制御装置７０は、後述する操舵制御部１０５から出力される舵角変更指示値に基づいて、車両の舵角を変更する。

例えば、車速、ドライバの操舵トルク、ハンドル角、ヨーレート、その他の車両情報に基づいて、操舵系に設けた電動パワーステアリングモータ（図示せず）による操舵トルクを制御する。

警報制御装置８０は、車両の各種装置に異常が生じた場合、警報を発生する装置であり、例えば、モニタ、ディスプレイ、アラームランプ等の視覚的な出力と、スピーカ・ブザー等の聴覚的な出力との少なくとも一方を用いて、警告・報知を行う。また、ドライバの操作により自動運転を含む運転支援制御の休止時には、現在の運転状態をドライバに報知する。

次に、走行制御システム１の中心となる走行制御装置１００について説明する。走行制御装置１００は、ＣＰＵ、ＲＯＭ、ＲＡＭ、入出力装置等がバスに接続されたコンピュータを備えて構成されている。

走行制御装置１００は、外部環境認識装置１０による外部環境の認識結果、測位装置２０および地図情報処理装置３０からの自車位置情報や交通情報に基づいて、自車両が走行する目標経路を生成し、この目標経路に沿って追従走行するよう、エンジン制御装置４０、変速機制御装置５０、ブレーキ制御装置６０、および操舵制御装置７０を介した走行制御を実行する。

走行制御装置１００は、目標経路への追従走行制御に係る機能部として、測位誤差情報算出部１０１、測位結果補正部１０２、目標経路算出部１０３および追従走行制御部１０４を備える。走行制御装置１００が備えるこれらの構成は、個々の機能を実行する別個のハードウェアとして実装されていてもよいし、所定のプログラムをＣＰＵが実行することによって個々の機能が達成されるようにソフトウェア的に実装されていてもよい。

測位誤差情報算出部１０１は、測位装置２０から出力される、ＧＮＳＳ等を用いて得られた自車両の測位結果の誤差（ずれ量）の情報である測位誤差情報Ｅを算出する。

測位誤差情報算出部１０１が算出する測位誤差情報Ｅは、自車両の前後方向（Ｚ軸）についての測位装置２０による測位結果の誤差の情報である前後方向誤差情報Ｅｚと、自車両の車幅方向（Ｘ軸）についての測位装置２０による測位結果の誤差の情報である車幅方向誤差情報Ｄｘと、を含む。

図２は、測位誤差情報算出部１０１による測位誤差情報Ｅの算出処理のフローチャートである。測位誤差情報算出部１０１による測位誤差情報Ｅの算出処理は、少なくとも走行制御装置１００による追従走行制御の実行時に、所定の時間間隔で繰り返し実行される。なお、測位誤差情報Ｅの算出処理は、追従走行制御の実行時以外の例えば自車両の手動運転時においても行われてもよい。

測位誤差情報Ｅの算出処理では、まずステップＳ１０において、測位誤差情報算出部１０１は、測位装置２０による自車両の測位結果に基づき、地図情報処理装置３０から自車両周辺の道路形状データを取得する。そして、ステップＳ１１において、測位誤差情報算出部１０１は、自車両の測位結果と道路形状データに基づき、自車両が走行している車線である走行車線を推定する。

次に、ステップＳ１２において、測位誤差情報算出部１０１は、自車両の走行車線上において自車両に先行して走行する先行車両が存在するか否かを、外部環境認識装置１０による認識結果に基づいて判定する。

ステップＳ１２の判定において、先行車両が存在しないと判定した場合には、測位誤差情報算出部１０１は、測位誤差情報Ｅの算出処理を終了する。

一方、ステップＳ１２の判定において、先行車両が存在すると判定した場合には、測位誤差情報算出部１０１は、ステップＳ１３に移行する。ステップＳ１３では、測位誤差情報算出部１０１は、自車両および先行車両の双方が直線路を走行中であるか否かを判定する。ステップＳ１３では、測位誤差情報算出部１０１は、道路形状データ、自車両の測位結果、および外部環境認識装置１０により算出された先行車両の位置情報に基づいて判定を行う。

ステップＳ１３の判定において、自車両および先行車両の双方が直線路を走行中であると判定した場合には、測位誤差情報算出部１０１は、ステップＳ１４に移行し、前後方向誤差情報算出処理を実行する。ステップＳ１４の前後方向誤差情報算出処理は、前後方向誤差情報Ｅｚを算出する処理である。

図３は、測位誤差情報算出部１０１が実行する前後方向誤差情報算出処理のフローチャートである。前後方向誤差情報算出処理では、まずステップＳ１００において、測位誤差情報算出部１０１は、測位装置２０による自車両の測位結果の取得を開始する。測位結果には、自車両の緯度Ｌａｔ０、経度Ｌｏｎ０、進行方位θ０の情報が含まれている。

次に、ステップＳ１１０において、測位誤差情報算出部１０１は、地図情報処理装置３０からの走行車線の道路形状データの取得を開始する。道路形状データには、自車両の進行方向であって先行車両よりも遠方である地点までの情報が含まれている。

そして、ステップＳ１２０において、測位誤差情報算出部１０１は、外部環境認識装置１０により認識された先行車両の自車両に対する相対位置の取得を開始する。先行車両の自車両に対する相対位置には、自車両の車幅方向（Ｘ軸）における先行車両の相対位置である先行車両横位置Ｘ１、自車両の前後方向（Ｚ軸）における先行車両の相対位置である先行車両前後位置Ｚ１の情報が含まれている。

なお、ステップＳ１００、ステップＳ１１０およびステップＳ１２０を実行する順序は特に限定されず、これらは同時に実行されてもよい。

以降の処理の実行中は、自車両の測位結果（Ｌａｔ０、Ｌｏｎ０）、道路形状データおよび先行車両の相対位置（Ｘ１、Ｚ１）の値が常に更新され続ける。

次に、ステップＳ１３０において、測位誤差情報算出部１０１は、道路形状データから走行車線においてカーブの開始地点である、カーブ入口座標を検出する。ステップＳ１３０の実行時において、自車両および先行車両が走行する走行車線は直線路である。ステップＳ１３０では、測位誤差情報算出部１０１は、走行車線が直線から曲線に変わる座標のうちの最も自車両に近い座標をカーブ入口座標として検出する。カーブ入口座標は、緯度Ｌａｔｃおよび経度Ｌｏｎｃの情報により構成される。

ステップＳ１４０では、測位誤差情報算出部１０１は、先行車両がカーブ入口座標（Ｌａｔｃ、Ｌｏｎｃ）に所定の距離に接近するまで待機する。ここで、先行車両の緯度・経度（Ｌａｔ１、Ｌｏｎ１）は、自車両の測位結果（Ｌａｔ０、Ｌｏｎ０）と先行車両の相対位置（Ｘ１、Ｚ１）から算出される。

なお、ステップＳ１００からステップＳ１４０の実行中において先行車両が自車両の走行車線から逸脱した場合には、測位誤差情報算出部１０１は、前後方向誤差情報算出処理を異常終了する。前後方向誤差情報算出処理を異常終了する場合には、前後方向誤差情報Ｅｚは異常終了を表す値となる。

先行車両がカーブ入口座標に接近したら、測位誤差情報算出部１０１は、ステップＳ１５０に移行する。ステップＳ１５０では、測位誤差情報算出部１０１は、自車両に対する先行車両の車幅方向への相対移動を検出するまで待機する。自車両に対する先行車両の車幅方向への相対移動を検出は、先行車両の車幅方向の相対位置Ｘ１の変化を監視することにより行われる。自車両に対する先行車両の車幅方向への相対移動を検出した場合には、測位誤差情報算出部１０１は、ステップＳ１６０に移行する。

ここで、ステップＳ１５０の開始時点では、自車両および先行車両は共に直線状である走行車線を走行しており、かつ先行車両はカーブ入口座標近傍を走行している。この場合において先行車両の車幅方向の相対位置Ｘ１が変化し始める時点とは、先行車両がカーブ形状に合わせた旋回を開始した時点であると解釈することができる。

なお、ステップＳ１５０においてＹＥＳの判定を行うには、先行車両の車幅方向の相対位置Ｘ１が変化する方向が、カーブの屈曲方向と一致している場合という条件が付けられていてもよい。

ステップＳ１６０では、測位誤差情報算出部１０１は、ステップＳ１５０において先行車両の車幅方向への相対移動を検出した時点における、先行車両の緯度・経度の情報である先行車両旋回開始座標（Ｌａｔ１ｃ、Ｌｏｎ１ｃ）の情報を取得する。先行車両旋回開始座標（Ｌａｔ１ｃ、Ｌｏｎ１ｃ）は、先行車両の車幅方向への相対移動を検出した時点における自車両の測位結果（Ｌａｔ０、Ｌｏｎ０）と先行車両の相対位置（Ｘ１、Ｚ１）から算出される。

次に、ステップＳ１７０において、測位誤差情報算出部１０１は、先行車両旋回開始座標（Ｌａｔ１ｃ、Ｌｏｎ１ｃ）と、カーブ入口座標（Ｌａｔｃ、Ｌｏｎｃ）と、を比較する。先行車両旋回開始座標（Ｌａｔ１ｃ、Ｌｏｎ１ｃ）と、カーブ入口座標（Ｌａｔｃ、Ｌｏｎｃ）と、は理想的には一致する。

しかしながら、先行車両旋回開始座標（Ｌａｔ１ｃ、Ｌｏｎ１ｃ）には測定誤差が含まれる。先行車両旋回開始座標（Ｌａｔ１ｃ、Ｌｏｎ１ｃ）は、前述のように、ＧＮＳＳ等を用いた測位装置２０による自車両の測位結果と、自車両が備える外部環境認識装置１０による先行車両の相対位置に基づいて決定される座標である。ここで、外部環境認識装置１０の測定誤差が、測位装置の測位誤差に対して十分に小さい場合、先行車両旋回開始座標（Ｌａｔ１ｃ、Ｌｏｎ１ｃ）には測定誤差は、測位装置２０の測位誤差であるとみなすことができる。

このため、ステップＳ１７０における、先行車両旋回開始座標（Ｌａｔ１ｃ、Ｌｏｎ１ｃ）と、カーブ入口座標（Ｌａｔｃ、Ｌｏｎｃ）との比較における、両者間の緯度および経度の第１ずれ量（ΔＬａｔ１、ΔＬｏｎ）は、測位装置２０の測位誤差であるといえる。

したがって、ステップＳ１８０において、測位誤差情報算出部１０１は、第１ずれ量（ΔＬａｔ１、ΔＬｏｎ）に基づいて、前後方向誤差情報Ｅｚを算出する。すなわち、測位誤差情報算出部１０１は、緯度および経度の座標で表される第１ずれ量（ΔＬａｔ１、ΔＬｏｎ）を、進行方位θ０を用いて自車両に固定されたＸ−Ｚ座標に変換し、このＸ−Ｚ座標上における第１ずれ量の前後方向成分（Ｚ軸成分）を、前後方向誤差情報Ｅｚとして決定する。

ここで、Ｘ−Ｚ座標上における第１ずれ量の車幅方向成分（Ｘ軸成分）を、測位誤差情報Ｅに含めないのは、先行車両が必ずしも走行車線の中央（道路形状データ）に沿って走行しているとは限らないからである。先行車両が走行車線の中央から車幅方向の一方に偏った位置を走行すれば、Ｘ−Ｚ座標上における第１ずれ量の車幅方向成分は、この偏りに応じて変化する。よって、外部環境認識装置１０によって先行車両の走行車線の中央からの車幅方向への偏差を認識できない場合には、Ｘ−Ｚ座標上における第１ずれ量の車幅方向成分は、測位誤差情報Ｅに含めないことが好ましい。

そして、図２のフローチャートに戻り、ステップＳ１５において、測位誤差情報算出部１０１は、ステップＳ１８０において算出した前後方向誤差情報Ｅｚを、当該情報を算出した時刻と、当該時刻における自車両の進行方位θとともに記憶する。

一方、前述したステップＳ１３の判定において、自車両および先行車両の双方が直線路を走行中ではないと判定した場合には、測位誤差情報算出部１０１は、ステップＳ２０に移行する。

ステップＳ２０では、測位誤差情報算出部１０１は、自車両が定曲率路を定常旋回中であるか否かを判定する。定曲率路とは、カーブの曲率が一定である区間のことである。また、定常旋回とは、自車両の車速が一定であり、かつ一定の旋回半径で旋回中である場合を指すものとする。

測位誤差情報算出部１０１は、自車両の測位結果と、道路形状データとに基づいて、自車両が走行中の走行車線が定曲率路であるか否かを判定する。また、測位誤差情報算出部１０１は、自車両の車速およびヨーレートに基づいて、定常旋回中であるか否かを判定する。

なお、ステップＳ２０においては、測位誤差情報算出部１０１は、外部環境認識装置１０によって認識される先行車両の相対位置（Ｘ１、Ｚ１）に変化がない場合に、自車両が定常旋回中であるか否かを判定することもできる。

ステップＳ２０において、自車両が定曲率路を定常旋回中ではないと判定した場合には、測位誤差情報算出部１０１は、測位誤差情報Ｅの算出処理を終了する。

一方、ステップＳ２０において、自車両が定曲率路を定常旋回中であると判定した場合には、測位誤差情報算出部１０１は、ステップＳ２１に移行し、車幅方向誤差情報算出処理を実行する。ステップＳ２１の車幅方向誤差情報算出処理は、車幅方向誤差情報Ｅｘを算出する処理である。

図４は、測位誤差情報算出部１０１が実行する車幅方向誤差情報算出処理のフローチャートである。車幅方向誤差情報算出処理では、まずステップＳ３００において、測位誤差情報算出部１０１は、道路形状データから定曲率路の曲率半径Ｒｍを取得する。

次に、ステップＳ３１０において、測位誤差情報算出部１０１は、自車両の車速およびヨーレートに基づいて、自車両の旋回半径Ｒ０を算出する。

次に、ステップＳ３２０において、測位誤差情報算出部１０１は、曲率半径Ｒｍと自車両の旋回半径Ｒ０との差を算出する。そして、ステップＳ３３０において、測位誤差情報算出部１０１は、曲率半径Ｒｍと自車両の旋回半径Ｒ０との差に基づいて、車幅方向誤差情報Ｅｘを算出する。

自車両が先行車両に追従走行している場合において、自車両が走行車線の中央（道路形状データ）に沿って走行しているならば、曲率半径Ｒｍと自車両の旋回半径Ｒ０の値は理想的には一致する。しかしながら、先行車両が必ずしも走行車線の中央（道路形状データ）に沿って走行しているとは限らず、また自車両の測位結果（Ｌａｔ０、Ｌｏｎ０）にも誤差が含まれているため、自車両が走行車線の中央（道路形状データ）に沿って走行しているという確かさも低い。これは、積雪の影響等により外部環境認識装置１０による走行車線の認識が困難である場合に特に顕著となる。

そこで、本実施形態の測位誤差情報算出部１０１は、ステップＳ３３０において、曲率半径Ｒｍと自車両の旋回半径Ｒ０の差である第２ずれ量ΔＲを、自車両の測位結果（Ｌａｔ０、Ｌｏｎ０）における車幅方向の誤差量（車幅方向誤差情報Ｅｘ）として算出する。

そして、図２のフローチャートに戻り、ステップＳ２２において、測位誤差情報算出部１０１は、ステップＳ３３０において算出した車幅方向誤差情報Ｅｘを、当該情報を算出した時刻と、当該時刻における自車両の進行方位θとともに記憶する。

測位結果補正部１０２は、以上に説明した測位誤差情報算出部１０１により算出された測位誤差情報Ｅと、現在の自車両の進行方位θと、に基づき、測位装置２０による測位結果を補正する。例えば、測位結果補正部１０２は、過去の所定の期間中に現在の自車両の進行方位θに対して所定の角度範囲内である場合に算出された測位誤差情報Ｅを用いて、当該誤差を解消するように測位結果を補正する。

目標経路生成部１０３は、外部環境認識装置１０による外部環境の認識結果や道路形状データに基づいて、自車両の追従走行の対象となる目標点の軌跡を算出し、この目標点の軌跡を目標経路として設定する。

走行制御部１０４は、目標経路生成部１０３により生成された目標経路に沿って自車両が走行するように、エンジン制御装置４０、変速機制御装置５０、ブレーキ制御装置６０および操舵制御装置７０の制御を行う。走行制御部１０４は、外部環境認識装置１０による外部環境の認識結果、道路形状データ、および測位結果補正部１０２によって補正された自車両の測位結果を用いて追従走行制御を行う。

以上に説明したように、本実施形態の車両の走行制御装置１００が備える測位誤差情報算出部１０１は、道路形状データから取得される走行車線のカーブ入口座標（Ｌａｔｃ、Ｌｏｎｃ）、および測位結果（Ｌａｔ０、Ｌｏｎ０）と先行車両の相対位置（Ｘ１、Ｚ１）から取得される先行車両旋回開始座標（Ｌａｔ１ｃ、Ｌｏｎ１ｃ）の比較から測位結果における前後方向誤差情報Ｅｚを算出する。また、本実施形態の車両の走行制御装置１００が備える測位誤差情報算出部１０１は、道路形状データから取得される走行車線のカーブの曲率半径Ｒｃ、および自車両の車速およびヨーレートから算出される自車両の旋回半径Ｒ０の比較から測位結果における車幅方向誤差情報Ｅｘを算出する。

そして、走行制御装置１００は、測位誤差情報算出部１０１により算出された前後方向誤差情報Ｅｚおよび車幅方向誤差情報Ｅｘを用いて測位結果の誤差を補正する。したがって、本実施形態の走行制御装置１００は、測位装置２０による測位結果と、外部環境認識装置１０による先行車両の相対位置の認識結果と、に基づいて自車両の位置を高精度に検出することができる。この高精度な自車両の位置検出により、本実施形態の走行制御装置１００は、外部環境認識装置による走行車線の認識が不可能な場合であっても、走行車線中における自車両の車幅方向の偏りを検出することが可能となる。

したがって本実施形態の車両の走行制御装置１００によれば、先行車両の走行軌跡に追従して走行する追従走行制御を実行する際において、先行車両の挙動に関わらず自動的に自車両を走行車線の中央に維持することができる。

本発明は、上述した実施形態に限られるものではなく、請求の範囲および明細書全体から読み取れる発明の要旨或いは思想に反しない範囲で適宜変更可能であり、そのような変更を伴う車両の走行制御装置もまた本発明の技術的範囲に含まれるものである。

１ 走行制御システム、
１０ 外部環境認識装置、
２０ 測位装置、
３０ 地図情報処理装置、
４０ エンジン制御装置、
５０ 変速機制御装置、
６０ ブレーキ制御装置、
７０ 操舵制御装置、
８０ 警報制御装置、
１００ 車両の走行制御装置、
１０１ 測位誤差情報算出部、
１０２ 測位結果補正部、
１０３ 目標経路算出部、
１０４ 追従走行制御部。

Claims (1)

1. 自車両が走行する目標経路を生成し、前記目標経路への追従走行を制御する車両の走行制御装置であって、
   前記自車両の測位結果を出力する測位装置と、
   前記自車両の走行車線の形状を示す道路形状データを出力する地図情報処理装置と、
   前記走行車線上において前記自車両の前方を走行する先行車両の前記自車両に対する相対位置を認識する外部環境認識装置と、
   前記道路形状データから取得される前記走行車線のカーブの入口座標、および前記測位結果と前記先行車両の相対位置から取得される前記先行車両が当該カーブに対応して旋回を開始する旋回開始座標、の比較から前記測位結果における前記自車両の前後方向の誤差量を算出し、前記道路形状データから取得される前記走行車線のカーブの曲率半径、および前記自車両の車速とヨーレートから算出される前記自車両の旋回半径、の比較から前記測位結果における前記自車両の車幅方向の誤差量を算出する測位誤差情報算出部と、
   を備えることを特徴とする車両の走行制御装置。

Images