JP6874834B2 - 走行支援装置の動作予測方法及び動作予測装置 - Google Patents

Description

本発明は、自車両の周囲における他車両の動作を予測した結果に基づいて自車両の走行を支援する走行支援装置の動作予測方法及び動作予測装置に関する。

従来から、先行車の前方のコーナーの情報と、先行車のコーナーへのアプローチ速度とに基づいて、先行車がコーナーを逸脱する可能性を推定し、推定結果に基づいて自車両を制御する車両用制御装置が知られていた。

特開２００６−２４０４４４号公報

しかしながら、特許文献１の車両用制御装置は、道路形状に基づいて他車の動作を予測するため、路面の状態に応じた他車両の動作を正しく予測することは難しい。

本発明は、このような従来の課題を解決するためになされたものであり、その目的とするところは、他車両の動作の予測精度を向上させる走行支援装置の動作予測方法及び動作予測装置を提供することにある。

本発明の一態様に関わる走行支援装置の動作予測方法は、他車両の周囲における路面上の轍を示す情報を取得し、路面上の轍を示す情報に基づいて轍に沿って走行する他車両の動作を予測する。

本発明の一形態によれば、他車両の動作の予測精度を向上させることができる。

図１は、実施形態に係わる走行支援装置及び動作予測装置の構成を示すブロック図である。 図２は、図１の走行支援装置及び動作予測装置の動作の一例を示すフローチャートである。 図３は、図２のステップ０６の詳細な手順の一例を示すフローチャートである。 図４は、二車線の一方通行路において、自車両５１が右側車線を走行し、自車両５１の斜め前方の左側車線を他車両５２が並走している走行シーンにおいて、水たまり５３付近の歩道に歩行者５５がいる場合を示す天頂図である。 図５は、二車線の一方通行路において、自車両５１が右側車線を走行し、自車両５１の斜め前方の左側車線を先行車両５２が並走している走行シーンにおいて、水たまり５３付近の隣接車線に先行車５６が存在する場合を示す天頂図である。 図６は、交差点内で停車している他車両５２及びその周囲の路面に形成された轍５４ａ及び轍５４ｂを示す天頂図である。 図７Ａは、二車線のカーブ路を走行する他車両５２の基本軌道（直進）６１及び実効軌道（直進）７１を示す天頂図である。 図７Ｂは、二車線のカーブ路を走行する他車両５２の基本軌道（車線変更）６２及び実効軌道（車線変更）７２を示す天頂図である。

次に、図面を参照して、実施形態を詳細に説明する。

実施形態に係わる走行支援装置は、例えば、図４に示すような走行シーンにおいて有効に機能する。図４に示すように、二車線の一方通行路において、自車両５１が右側車線を走行し、自車両５１の斜め前方の左側車線を他車両５２が並走している。他車両５２の進行方向前方の左側車線には水たまり５３があり、左側車線に沿って走行する軌道６３と水たまり５３とは交差している。つまり、他車両５２は左側車線に沿って走行した場合、水たまり５３の上を通過することになる。

しかし、図４の軌道６４に示すように、他車両５２は、一時的に進路を右側に変更することにより、水たまり５３を避け且つ進行方向を維持することができる。よって、他車両５２は、軌道６３よりも軌道６４を選択する可能性（尤度）がある。

このように、例えば、路面上の水たまり５３のような路面の状態を考慮して他車両の軌道を予測することにより、他車両の動作予測の精度が高まる。よって、自車両５１は、自車線にはみ出してくる他車両５２の動作を予測できるため、自らの挙動を急変させる必要が無くなり、自車両５１の乗員に与える違和感を低減することができる。

図１を参照して、実施形態に係わる走行支援装置の構成を説明する。走行支援装置は、物体検出装置１と、自車位置推定装置３と、地図取得装置４と、マイクロコンピュータ１００とを備える。

物体検出装置１は、自車両５１に搭載された、レーザレーダやミリ波レーダ、カメラなど、自車両５１の周囲の物体を検出する、複数の異なる種類の物体検出センサを備える。物体検出装置１は、複数の物体検出センサを用いて、自車両５１の周囲における物体を検出する。物体検出装置１は、他車両、バイク、自転車、歩行者を含む移動物体、及び駐車車両を含む静止物体を検出する。例えば、移動物体及び静止物体の自車両５１に対する位置、姿勢、大きさ、速度、加速度、減速度、ヨーレートを検出する。なお、物体の位置、姿勢（ヨー角）、大きさ、速度、加速度、減速度、ヨーレートを纏めて、物体の「挙動」と呼ぶ。物体検出装置１は、検出結果として、例えば自車両５１の上方の空中から眺める天頂図（平面図ともいう）における、２次元の物体の挙動を出力する。

自車位置推定装置３は、自車両５１に搭載された、ＧＰＳ（グローバル・ポジショニング・システム）やオドメトリなど自車両５１の絶対位置を計測する位置検出センサを備える。自車位置推定装置３は、位置検出センサを用いて、自車両５１の絶対位置、すなわち、所定の基準点に対する自車両５１の位置、姿勢及び速度を計測する。

地図取得装置４は、自車両５１が走行する道路の構造を示す地図情報を取得する。地図取得装置４は、地図情報を格納した地図データベースを所有してもよいし、クラウドコンピューティングにより地図情報を外部の地図データサーバから取得しても構わない。地図取得装置４が取得する地図情報には、車線の絶対位置や車線の接続関係、相対位置関係などの道路構造の情報が含まれる。

更に、地図取得装置４は、更新頻度の高い地図情報（例えば、ダイナミックマップに埋め込まれている情報）を取得する。具体的には、地図取得装置４は、１秒以下の時間の周期で更新される動的情報、１分以下の時間の周期で更新される准動的情報、１時間以下の時間の周期で更新される准静的情報を自車両５１の外部から無線通信により取得する。例えば、動的情報には、周辺車両、歩行者、信号機の情報が含まれ、准動的情報には、事故情報、渋滞情報、狭域気象情報が含まれ、准静的情報には、交通規制情報、道路工事情報、広域気象情報が含まれる。これに対して、上記した「道路の構造を示す地図情報」は、１時間以上の時間の周期で更新される静的情報に相当する。

マイクロコンピュータ１００（制御部の一例）は、物体検出装置１及び自車位置推定装置３による検出結果及び地図取得装置４による取得情報に基づいて、他車両５２の動作を予測し、他車両５２の動作から自車両５１の経路を生成し、生成した経路に従って自車両５１を制御する。

なお、実施形態では、マイクロコンピュータ１００は、自車両５１を制御する走行支援装置の例として説明する。しかし、本発明はこれに限定されない。例えば、マイクロコンピュータ１００は、他車両の動作を予測する動作予測装置としても実施可能である。つまり、マイクロコンピュータ１００は、自車両５１の経路生成及び経路に沿った走行支援を行なわず、予測した他車両の動作を最終出力してもよい。

マイクロコンピュータ１００は、ＣＰＵ（中央処理装置）、メモリ、及び入出力部を備える汎用のマイクロコンピュータである。マイクロコンピュータ１００には、走行支援装置として機能させるためのコンピュータプログラム（走行支援プログラム）がインストールされている。コンピュータプログラムを実行することにより、マイクロコンピュータ１００は、走行支援装置が備える複数の情報処理回路（２ａ、２ｂ、５、１０、２１、２２）として機能する。なお、ここでは、ソフトウェアによって走行支援装置が備える複数の情報処理回路（２ａ、２ｂ、５、１０、２１、２２）を実現する例を示すが、もちろん、以下に示す各情報処理を実行するための専用のハードウェアを用意して、情報処理回路（２ａ、２ｂ、５、１０、２１、２２）を構成することも可能である。また、複数の情報処理回路（２ａ、２ｂ、５、１０、２１、２２）を個別のハードウェアにより構成してもよい。更に、情報処理回路（２ａ、２ｂ、５、１０、２１、２２）は、車両にかかわる他の制御に用いる電子制御ユニット（ＥＣＵ）と兼用してもよい。

マイクロコンピュータ１００は、複数の情報処理回路（２ａ、２ｂ、５、１０、２１、２２）として、検出統合部２ａと、物体追跡部２ｂと、地図内位置演算部５と、動作予測部１０と、自車経路生成部２１と、車両制御部２２とを備える。更に、動作予測部１０は、挙動判定部１１と、動作候補予測部１２と、第１動作候補修正部１３と、第２動作候補修正部１５と、軌道予測部１６と、尤度推定部１７と、路面状態取得部１８と、前方物体判定部１９とを備える。なお、他車両の動作を予測する動作予測装置として実施する場合、情報処理回路（自車経路生成部２１及び車両制御部２２）は不要である。

検出統合部２ａは、物体検出装置１が備える複数の物体検出センサの各々から得られた複数の検出結果を統合して、各物体に対して一つの検出結果を出力する。具体的には、物体検出センサの各々から得られた物体の挙動から、各物体検出センサの誤差特性などを考慮した上で最も誤差が少なくなる最も合理的な物体の挙動を算出する。具体的には、既知のセンサ・フュージョン技術を用いることにより、複数種類のセンサで取得した検出結果を総合的に評価して、より正確な検出結果を得る。

物体追跡部２ｂは、物体検出装置１によって検出された物体を追跡する。具体的に、検出統合部２ａにより統合された検出結果から、異なる時刻に出力された物体の挙動から、異なる時刻間における物体の同一性の検証（対応付け）を行い、かつ、その対応付けを基に、物体の挙動を予測する。なお、異なる時刻に出力された物体の挙動は、マイクロコンピュータ１００内のメモリに記憶され、後述する軌道予測の際に用いられる。

地図内位置演算部５は、自車位置推定装置３により得られた自車両５１の絶対位置、及び地図取得装置４により取得された地図データから、地図上における自車両５１の位置及び姿勢を推定する。例えば、自車両５１が走行している道路、更に当該道路のうちで自車両５１が走行する車線を特定する。

動作予測部１０では、検出統合部２ａにより得られた検出結果と、地図内位置演算部５により特定された自車両５１の位置に基づいて、自車両５１の周囲における移動物体の動作を予測する。以下に、動作予測部１０の具体的な構成を説明する。

挙動判定部１１は、地図上における自車両５１の位置と、検出統合部２ａにより得られた物体の挙動とから、地図上における物体の位置及び挙動を特定する。更に、挙動判定部１１は、物体の地図上の位置が時間の経過と共に変化する場合、当該物体は「移動物体」であると判断し、移動物体の大きさ及び速度から、当該移動物体の属性（走行中の他車両、歩行者）を判断する。そして、移動物体が走行中の「他車両」であると判断した場合、挙動判定部１１は、当該他車両が走行する道路及び車線と判定する。

なお、物体の地図上の位置が時間の経過と共に変化しない場合、静止物体であると判断し、静止物体の地図上の位置、姿勢及び大きさから、静止物体の属性（停止中の他車両、駐車車両、歩行者など）を判定する。

動作候補予測部１２は、地図に基づく他車両の動作候補を予測する。動作候補予測部１２は、地図情報に含まれる道路構造及び他車両が属している車線情報から、他車両が次にどのように走行するのかという動作意図を予測し、当該動作意図に基づく他車両の基本軌道を道路構造に基づいて演算する。「動作候補」とは、動作意図及び基本軌道を含む上位概念である。「基本軌道」は、異なる時刻における他車両の位置のプロファイルのみならず、各位置における他車両の速度のプロファイルをも示す。

例えば、他車両が単車線の単路及びカーブ路を走行する場合、動作候補予測部１２は、車線の形状に沿って走行する動作意図（直進）を予測し、基本軌道として、地図上の車線に沿った軌道を演算する。また、他車両が複数車線の単路及びカーブ路を走行する場合、動作候補予測部１２は、動作意図（直進）と、右側もしくは左側へ車線変更する動作意図（車線変更）を予測する。動作意図（車線変更）における他車両の基本軌道は、道路構造及び所定の車線変更時間に基づいて車線変更する軌道である。さらに、交差点を走行する場合、動作候補予測部１２は、直進、右折及び左折の動作意図を予測し、地図上の交差点における道路構造に基づく直進軌道、右折軌道、左折軌道を基本軌道として演算する。なお、「基本軌道」の演算において、道路構造を考慮するが、検出統合部２ａにより統合された他車両の挙動は考慮しない。

図４に示す走行シーンにおいて、動作候補予測部１２は、左側車線に沿って走行する動作意図（直進）及び基本軌道６３を演算することができる。しかし、動作候補予測部１２は、水たまり５３を避け且つ進行方向を維持する軌道６４は、演算しない。

第１動作候補修正部１３は、物体検出装置１により検出された静止物体を考慮して、動作候補予測部１２により予測された動作候補を修正する。具体的に、第１動作候補修正部１３は、他車両の基本軌道と静止物体の位置が干渉するか否かを判断する。干渉する場合、静止物体を回避する他車両５２の動作意図及び基本軌道を新たに追加する。

図４に示す他車両５２と同時に、他の移動物体が物体検出装置１により検出されている場合（図示省略）、第１動作候補修正部１３は、他の移動物体を考慮して、動作候補予測部１２により予測された動作候補を修正する。具体的に、第１動作候補修正部１３は、他の移動物体と他車両５２の干渉があるか否かを経時的に判断する。移動物体同士の干渉がある場合には、他の移動物体との干渉を回避する他車両５２の動作意図及び基本軌道を新たに追加する。

路面状態取得部１８は、他車両５２の周囲における路面の状態を示す情報を取得する。路面の状態を示す情報には、摩擦抵抗が低く滑り易い路面（低ミュー路）の状態を示す情報が含まれる。例えば、路面上の水たまり５３を示す情報、路面上の積雪箇所を示す情報、及び路面の凍結箇所を示す情報が含まれる。

更に、路面の状態を示す情報には、路面上の轍を示す情報が含まれる。「路面上の轍」は、アスファルト、土、或いは雪の上の車輪が通った跡を示し、路面の同じ場所を車輪が何度も通った為にアスファルト又は土が削られてできた路面上の凹みや溝も含まれる。雪の上の車輪が通った跡には、雪面の凹みや溝のみならず、雪面の凹みや溝の底面にアスファルトや土が表出している箇所も含まれる。アスファルト又は土が削られてできた路面上の凹みや溝に溜まっている水を、路面上の轍として検出することも可能である。雨が降り止んだ後に車輪が何度も通った為に部分的に乾燥した箇所を、路面上の轍として検出することも可能である。

路面状態取得部１８は、例えば、自車両５１に搭載されたカメラで撮像して取得した画像データから、路面の状態を示す情報を取得することができる。進行方向前方の画像データに対してパターン認識処理を施すことにより、路面の状態を検出することができる。一方、湿潤時又は凍結時に路面が鏡面状態になることに着目して、鏡面時の偏光特性の変化を利用して路面の状態を検出することもできる。具体的には、通常のカメラと偏光レンズを備えた偏光カメラとを併用することにより通常画像と偏光画像の差異が大きい場所を検出してもよい。或いは、上記したダイナミックマップなどから得られる情報として、路面の状態を示す情報を自車両５１の外部から取得してもよい。実施形態では、路面状態を取得する方法は特に問わず、その他の既知の方法を用いてもよい。

前方物体判定部１９は、他車両５２の進行方向前方に物体が存在するか否かを判断する。例えば、物体検出装置１により検出された物体（静止物体及び移動物体）の中に、他車両５２の進行方向前方に存在する物体が含まれているか否かを判断すればよい。他車両５２の進行方向前方の領域は、他車両５２の中心を通り且つ車幅方向に延びる直線よりも進行方向前方側の領域である。例えば、前方物体判定部１９は、他車両５２が走行する自車線又は隣接車線を走行する先行車両５６（図５参照）、自車線又は隣接車線に停車している車両、路側帯や車道に隣接する歩道上の歩行者５５（図４参照）を検出する。

第２動作候補修正部１５は、少なくとも路面状態取得部１８により検出された路面の状態を示す情報に基づいて、動作候補予測部１２により予測された動作候補を修正する。具体的に、先ず、第２動作候補修正部１５は、低ミュー路の状態を示す情報（例えば、図４の水たまり５３、積雪箇所、凍結箇所）を取得した場合、低ミュー路の場所を回避する他車両５２の動作意図及び基本軌道６４を新たに追加する。更に、第２動作候補修正部１５は、低ミュー路の場所を低速で通過する他車両５２の動作意図及び基本軌道６３を新たに追加する。

更に、第２動作候補修正部１５は、路面上の轍を示す情報を取得した場合、路面上の轍に沿って走行する他車両５２の動作意図及び基本軌道を新たに追加する。例えば、図６に示すように、交差点の手前或いは交差点内で他車両５２が停車している。他車両５２の周囲の路面上には轍５４ａ及び轍５４ｂが存在している。路面上の轍５４ａ及び轍５４ｂを示す情報を取得した場合、轍５４ａ及び轍５４ｂに沿って走行する他車両５２の動作意図及び基本軌道をそれぞれ新たに追加する。

第２動作候補修正部１５は、前方物体判定部１９による判断結果に基づいて、第２動作候補修正部１５により新たに追加された動作候補を修正してもよい。具体的には、他車両５２の進行方向前方に物体が存在するか否かに応じて、第２動作候補修正部１５により新たに追加された動作候補に対する尤度を推定する。

例えば、第２動作候補修正部１５は、図４に示す水たまり５３付近の歩道に歩行者５５がいる場合や、水たまり５３付近の隣接車線（右側車線）に先行車が存在しない場合、他車両５２が、軌道６３よりも軌道６４を選択する可能性（尤度）を高く設定する。

これとは逆に、図５に示すように、水たまり５３付近の歩道に歩行者５５がいない場合や、水たまり５３付近の隣接車線（右側車線）に先行車両５６が存在する場合、第２動作候補修正部１５は、図４に示す走行シーンに比べて、軌道６４を選択する可能性（尤度）を低く設定し、軌道６３を選択する可能性（尤度）を高く設定する。

図４の歩行者５５及び図５の先行車両５６の双方が存在する場合、第２動作候補修正部１５は、前方物体判定部１９による判断結果に基づいて、水たまり５３の水を跳ね上げない程度に徐行して水たまり５３を通過する他車両５２の動作候補を新たに追加してもよい。

また、第２動作候補修正部１５は、図６に示す轍５４ａ又は轍５４ｂ上に、物体（障害物）が存在しなければ、轍５４ａ又は轍５４ｂに沿って走行する他車両５２の動作候補に対する尤度を高く設定する。一方、轍５４ａ又は轍５４ｂ上に、物体（障害物）が存在する場合、第２動作候補修正部１５は、轍５４ａ又は轍５４ｂに沿って走行する他車両５２の動作候補に対する尤度を低く設定し、物体（障害物）を回避する動作候補に対する尤度を高く設定する。

軌道予測部１６は、挙動判定部１１において検出された挙動に基づいて、他車両５２が取る軌道（実効軌道）を予測する。具体的に、軌道予測部１６は、上記予測された動作意図にしたがって動作する場合の他車両５２の実効軌道を、例えばカルマンフィルターなどの既知の状態推定技術を用いて演算する。「実効軌道」は、基本軌道と同様にして、異なる時刻における他車両５２の位置を示すのみならず、各位置における他車両５２の速度のプロファイルをも示す。実効軌道と基本軌道は、共に他車両５２が取る軌道である点で共通するが、実効軌道は他車両５２の挙動を考慮して演算されるが、基本軌道は他車両の挙動を考慮しないで演算される点で、両者は相違する。

図７Ａ及び図７Ｂに示す基本軌道（６１、６２）は、動作意図及び道路構造に基づいて導出された他車両５２の軌道の例であり、他車両５２の挙動は考慮されていない。よって、例えば、他車両５２の現在の姿勢（ヨー角）が考慮されていないため、他車両５２の現在位置から、異なる方向に向けて、複数の基本軌道（６１、６２）が延びている。これに対して、軌道予測部１６は、他車両５２の挙動を考慮して、上記した動作意図に沿った軌道（実効軌道）を演算する。換言すれば、上記した動作意図に沿った動作を取った場合の他車両５２の実効軌道を演算する。

図４、図５に示す軌道（６３、６４）も、他車両５２の動作意図及び道路構造に基づいて導出された他車両５２の基本軌道の一例である。更に、図６に示す路面上の轍（５４ａ、５４ｂ）も、轍（５４ａ、５４ｂ）に沿って走行する他車両５２の基本軌道の一例と言える。

図７Ａ及び図７Ｂにおいて、他車両５２の姿勢（ヨー角）は、道路の形状に沿った走行の基本軌道６１よりも左側に傾き、他車両５２の速度は、進行方向の速度成分のみからなり、車幅方向の速度成分はゼロである。つまり、他車両５２は直進状態である。よって、この姿勢及び速度を起点として他車両５２が道路の形状に沿った走行の動作意図に従って走行する場合、図７Ａに示すように、基本軌道６１から左側に離れた後に、基本軌道６１に近づいて一致する実効軌道７１となる。換言すれば、走行車線からの逸脱を修正するような修正軌道（オーバーシュート軌道）を描くことが予測される。軌道予測部１６は、他車両５２の姿勢（ヨー角）及び速度を起点として、道路の形状に沿った走行の動作意図（直進）に従って走行する実効軌道７１を予測する。

次に、同じ姿勢及び速度を起点として他車両５２が車線変更の動作意図に従って走行する場合、図７Ｂに示すように、左方向への旋回を開始し、左側車線へ移動した後に、右へ旋回して左側車線に沿った軌道へ修正する実効軌道７２となる。つまり、舵角が中立位置の状態から始まる左旋回のクロソイド曲線及び右旋回のクロソイド曲線からなる実効軌道７２を描く。よって、実効軌道７２は、車線変更軌道６２を演算するときの「所定の車線変更時間」とほぼ同じ時間をかけて車線変更が完了する軌道となる。なお、実行軌道を描く際の曲線は必ずしもクロソイド曲線である必要はなく、その他の曲線を用いて描いてもよい。図７Ｂに示すように、実効軌道７２は車線変更における基本軌道６２とほぼ同じ軌道となる。

図７Ａ及び図７Ｂと同様にして、図４、図５、図６に示す基本軌道（６３、６４）及び基本軌道を見なせる轍（５４ａ、５４ｂ）についても、軌道予測部１６は、他車両５２の挙動を考慮して、動作意図に沿った軌道（実効軌道）を演算する。

例えば、図４及び図５に示す走行シーンにおいて、他車両５２の位置、姿勢（ヨー角）及び速度を起点として、低速或いは徐行して水たまり５３を通過する動作意図、或いは水たまり５３を回避する動作意図に従って走行する他車両５２の実効軌道をそれぞれ演算する。

図６に示す走行シーンでは、他車両５２の位置を起点として、交差点を右折する動作意図に従って、轍５４ａに沿って走行する他車両５２の実効軌道、及び交差点を直進する動作意図に従って、轍５４ｂに沿って走行する他車両５２の実効軌道をそれぞれ演算する。

ここでは、他車両５２の挙動の例として、位置、姿勢及び速度を考慮したが、他車両５２の加速度、減速度を考慮して、実効軌道を演算してもよい。例えば、直進に比べて、車線変更の時の減速度は大きくなることが予測することができる。

尤度推定部１７は、動作候補予測部１２、第１動作候補修正部１３及び第２動作候補修正部１５により予測された動作候補と、検出統合部２ａにより統合された他車両５２の挙動とを対比することにより、他車両５２の動作を予測する。更に、尤度推定部１７は、第２動作候補修正部１５により予測された尤度を考慮して、他車両５２の動作を予測する。

具体的に、尤度推定部１７は、動作候補予測部１２、第１動作候補修正部１３及び第２動作候補修正部１５により予測された動作候補の各々について、基本軌道と実効軌道とを対比する。そして、基本軌道と実効軌道との差違から各動作候補の尤度を求める。基本軌道と実効軌道との差違が小さいほど、高い尤度を演算する。

更に、尤度推定部１７は、第２動作候補修正部１５により予測された尤度に基づいて、各動作候補の尤度に重み付けを行う。例えば、第２動作候補修正部１５により予測された尤度を、係数として、各動作候補の尤度に乗算する。これにより、第２動作候補修正部１５により予測された尤度を、尤度推定部１７が推定する尤度に結合させることができる。例えば、尤度推定部１７は、図４に示すシーンにおいて、水たまり５３を低速で通過する動作候補６３の尤度よりも、水たまり５３を回避する動作候補６４の尤度により大きな係数を乗算する。

最も尤度が高く演算された動作候補は、他車両５２の挙動及び路面の状態を考慮すれば最も尤もらしい動作候補であると判断することができる。よって、尤度推定部１７は、最も尤度が高く評価された動作候補を、他車両５２の動作として決定する。基本軌道と実効軌道との差違は、例えば、両軌道間の位置や速度のプロファイルの差異の総和を基に算出する。図７Ａ及び図７Ｂに示す面積Ｓ１、Ｓ２は、基本軌道と実効軌道との位置の差違を積分した総和の一例である。面積が狭い程、位置の差違が小さいと判断できるので、高い尤度を演算する。他の例として、位置の差違が小さくても、速度のプロファイルが大きく異なる場合には、低い尤度を演算することができる。なお、尤度は、その動作候補が実際に発生する可能性を表す指標の一例であって、尤度以外の表現であっても構わない。

尤度推定部１７は、図４〜図６に示す動作候補（６３、６４、５４ａ、５４ｂ）の各々についても、基本軌道と実効軌道とを比較することにより尤度を算出し、更に当該尤度に係数（第２動作候補修正部１５により予測された尤度）を乗算する。そして、尤度が最も大きな動作候補（６３、６４、５４ａ、５４ｂ）を他車両５２の動作として決定する。

以上説明したように、動作予測部１０では、尤度推定部１７により想定された各動作候補の尤度に基づいて、他車両５２の動作を予測する。なお、「他車両の動作」には、他車両の軌道及び速度のプロファイルを含む。他車両５２の軌道とは、異なる時刻における他車両５２の位置のプロファイルを示す。

自車経路生成部２１は、動作予測部１０により予測された他車両５２の動作に基づいて、自車両５１の経路を生成する。例えば、動作予測部１０が図４に示す動作６４を予測した場合、他車両５２の車線逸脱を予測した上での自車両５１の経路を生成できる。自車両５１の経路は、水たまり５３を回避した動作（意図）に干渉しない経路であり、具体的には、他車両５２を先に水たまり５３の脇を通過させるように、減速する経路である。或いは、レーン幅（車線幅）が十分に広ければ、右側車線内の右側に寄って走行する経路であってもよい。更に右側に隣接レーンがある場合、事前にレーンチェンジを行う経路であってもよい。

よって、他車両５２と接触せず、かつ、他車両５２の挙動により自車両５１が急減速又は急ハンドルとならない滑らかな自車両５１の経路を生成することができる。「自車両５１の経路」は、異なる時刻における自車両５１の位置のプロファイルのみならず、各位置における自車両５１の速度のプロファイルをも示す。

ここでは、地図上における他車両５２の挙動に基づいて、他車両５２の軌道を含む他車両の動作を予測している。このため、他車両５２の軌道を基にして自車両５１の経路を生成することは、他車両５２との相対距離の変化、加減速度或いは姿勢角の差に基づいて自車両５１の経路を生成していることになる。

例えば、図４に示す走行シーンにおいて、他車両５２が減速して水たまり５３の手前で停車する挙動を示す場合、他車両５２の挙動は、自車両５１を先に行かせ、他車両５２はその後に軌道６４を選択したい、という動作意図を示していると解釈できる。この場合、他車両５２の動作意図を考慮して自車両５１の経路を形成し、或いは自車両５１を制御することにより、自車両５１は減速せず或いは加速して水たまり５３の脇を先に通過することができる。これにより、他車両５２と自車両５１の双方が譲り合ってしまう状況を回避できるので、円滑な交通流を実現可能となる。

車両制御部２２では、自車経路生成部２１により生成された経路に従って自車両５１が走行するように、地図内位置演算部５により演算された自己位置に基づいて、ステアリングアクチュエータ、アクセルペダルアクチュエータ、及びブレーキペダルアクチュエータの少なくとも１つを駆動する。なお、実施形態では、自車両５１の経路に従って制御する場合を示すが、自車両５１の経路を生成せずに、自車両５１を制御してもよい。この場合、他車両５２との相対距離、或いは、他車両５２と自車両５１との姿勢角の差に基づいて制御を行うことも可能である。

図２及び図３を参照して、図１の走行支援装置を用いた走行支援方法を説明する。なお、他車両５２の動作を予測する動作予測装置として図１のマイクロコンピュータ１００を用いることにより、図２のステップＳ０６に示す処理動作の結果を最終出力する動作予測方法として実施することができる。

先ず、ステップＳ０１において、物体検出装置１が、複数の物体検出センサを用いて、自車両５１の周囲における物体の挙動を検出する。ステップＳ０２に進み、検出統合部２ａが、複数の物体検出センサの各々から得られた複数の検出結果を統合して、各物体に対して一つの検出結果を出力する。そして、物体追跡部２ｂが、検出及び統合された各物体を追跡する。

ステップＳ０３に進み、自車位置推定装置３が、位置検出センサを用いて、所定の基準点に対する自車両５１の位置、姿勢及び速度を計測する。ステップＳ０４に進み、地図取得装置４が、自車両５１が走行する道路の構造を示す地図情報を取得する。

ステップＳ０５に進み、地図内位置演算部５が、ステップＳ０３で計測された自車両５１の位置、及びステップＳ０４で取得された地図データから、地図上における自車両５１の位置及び姿勢を推定する。ステップＳ０６に進み、動作予測部１０が、ステップＳ０２で得られた検出結果（他車両５２の挙動）と、ステップＳ０５で特定された自車両５１の位置に基づいて、自車両５１の周囲における他車両５２の動作を予測する。

ステップＳ０６の詳細を、図３を参照して説明する。先ず、ステップＳ６１１において、挙動判定部１１が、地図上における自車両５１の位置と、ステップＳ０２で得られた物体の挙動とから、他車両５２が走行する道路及び車線と判定する。ステップＳ６１２に進み、動作候補予測部１２が、地図に基づく他車両５２の動作候補を予測する。例えば、道路構造から動作意図を予測する。

ステップＳ６１３に進み、マイクロコンピュータ１００は、ステップＳ０１で検出された全ての他車両５２についてステップＳ６１１及びＳ６１２を実施する。実施した後（Ｓ６１３でＹＥＳ）、ステップＳ６１４に進み、第１動作候補修正部１３が、ステップＳ０１において同時に検出された静止物体を考慮して、ステップＳ６１２で予測された動作候補を修正する。

ステップＳ６１５に進み、他車両５２と同時に、他の移動物体がステップＳ０１にいて検出されている場合、第１動作候補修正部１３が、他の移動物体を考慮して、ステップＳ６１２で予測された動作候補を修正する。

ステップＳ６１６に進み、路面状態取得部１８は、他車両５２の周囲における路面の状態を示す情報を取得する。例えば、図４及び図５に示す水たまり５３、及び図６に示す轍５４ａ、５４ｂを示す情報を取得する。

ステップＳ６１７に進み、前方物体判定部１９は、物体検出装置１により検出された物体（静止物体及び移動物体）の中に、他車両５２の進行方向前方に存在する物体が含まれているか否かを判断する。例えば、前方物体判定部１９は、他車両５２の前方を走行する先行車両５６（図５参照）、車道に隣接する歩道上の歩行者５５（図４参照）を検出する。

ステップＳ６１８に進み、第２動作候補修正部１５は、少なくとも路面状態取得部１８により検出された路面の状態を示す情報に基づいて、動作候補予測部１２により予測された動作候補を修正する。例えば、低ミュー路の状態を示す情報（例えば、図４の水たまり５３、積雪箇所、凍結箇所）を取得した場合、低ミュー路の場所を回避する他車両５２の動作意図及び基本軌道６４、及び低ミュー路の場所を低速で通過する他車両５２の動作意図及び基本軌道６３を新たに追加する。図６に示すように、路面上の轍５４ａ及び轍５４ｂを示す情報を取得した場合、轍５４ａ及び轍５４ｂに沿って走行する他車両５２の動作意図及び基本軌道をそれぞれ新たに追加する。

更に、第２動作候補修正部１５は、他車両５２の進行方向前方に物体が存在するか否かに応じて、第２動作候補修正部１５により新たに追加された動作候補に対する尤度を推定する。例えば、第２動作候補修正部１５は、図４に示す歩行者５５、図５に示す先行車両５６に応じて、軌道６３及び軌道６４の尤度を調整する。

ステップＳ６２０に進み、マイクロコンピュータ１００は、ステップＳ０１で検出された全ての他車両についてステップＳ６１４〜Ｓ６１８を実施する。実施した後（Ｓ６２０でＹＥＳ）、ステップＳ６２１に進み、軌道予測部１６が、他車両５２が挙動を維持し、且つ予測された動作意図にしたがって動作する場合の他車両５２の実効軌道（７１、７２、図７Ａ及び図７Ｂ参照）を、例えばカルマンフィルターなどの既知の状態推定技術を用いて演算する。

ステップＳ６２２に進み、尤度推定部１７が、Ｓ６１２、Ｓ６１４、Ｓ６１５及びＳ６１８で予測された動作候補の各々について、基本軌道（６３、６４、５４ａ、５４ｂ）と実効軌道とを対比する。そして、基本軌道と実効軌道との差違から各動作候補の尤度を求める。更に、尤度推定部１７は、ステップＳ６１８で推定された尤度に基づいて、各動作候補の尤度に重み付けを行う。尤度推定部１７は、最も尤度が高く評価された動作候補を、他車両５２の動作として決定する。

ステップＳ６２３に進み、マイクロコンピュータ１００は、ステップＳ０１で検出された全ての他車両についてステップＳ６２１〜Ｓ６２２を実施する。これにより、図２のステップＳ０６が終了する。

図２のステップＳ０７に進み、自車経路生成部２１が、ステップＳ０６で予測された他車両の動作に基づいて、自車両５１の経路を生成する。ステップＳ０８に進み、車両制御部２２が、ステップＳ０７で生成された経路に従って自車両５１が走行するように、自車両５１を制御する。

以上説明したように、実施形態によれば、以下の作用効果が得られる。

マイクロコンピュータ１００（制御部の一例）は、路面の状態を示す情報を取得し、それに基づいて他車両５２の動作を予測するため、他車両５２の動作を高精度に予測することができる。よって、路面の状態に応じた他車両５２の動作を考慮して自車両５１の軌道を修正することができ、自車両５１の急操舵や急減速の発生の可能性を抑えることができる。

マイクロコンピュータ１００（制御部の一例）は、路面の状態に加えて、他車両５２の進行方向前方に物体が存在するか否かを考慮して他車両５２の動作を予測する。よって、より高精度に他車両５２の動作を予測することができる。自車両５１の急操舵や急減速の発生を抑えることができる。

路面上の水たまり５３を示す情報を取得することによって、他車両５２の動作を正確に予測することができるようになる。水たまり５３に応じた他車両５２の動作を予測して自車両５１の軌道を修正することができる。例えば、他車両５２の進行方向前方に物体及び水たまり５３が存在する場合に、水たまり５３を避ける他車両５２の動作或いは水たまり５３を避けずに通過する他車両５２の動作をそれぞれ正しく予測することができる。

図６に示すように、他車両５２が停止している、つまり、他車両５２が静止物体である場合、他車両５２を検出するセンサ構成によっては、他車両５２の姿勢や進行方向を特定することが難しい場合がある。例えば、カメラやレーザレンジファインダを用いて停止している他車両５２を検出した場合、他車両５２の姿勢から他車両５２の進行方向を特定しにくい。そこで、路面の状態（轍５４ａ、５４ｂ）を検出し、それに基づいて他車両５２の動作を予測する。これにより、他車両５２の姿勢や進行方向の特定が困難な場合であっても、他車両５２の動作を高精度に予測することができる。

路面上の轍５４ａ、５４ｂを示す情報に基づいて他車両５２の動作を予測することにより、轍５４ａ、５４ｂに沿って走行する他車両５２の動作を正確に予測することができる。

以上、実施形態に沿って本発明の内容を説明したが、本発明はこれらの記載に限定されるものではなく、種々の変形及び改良が可能であることは、当業者には自明である。

実施形態では、自車両５１が自律走行可能な自動運転モードである場合を例示したが、自車両５１がドライバによる手動運転モードであってもよい。この場合、マイクロコンピュータ１００は、自車両５１の制御（運転サポート）として、音声或いは画像などを用いて、ステアリング、アクセル、ブレーキの操作をドライバに対して案内するためのスピーカ、ディスプレイ、及びこれらのユーザインターフェースを制御すればよい。

実施形態では、予測した他車両５２の軌跡に基づいて、自車両５１の軌跡を調整する場合を例示したが、走行支援として自車両で実行する内容をそれに限らず、予測結果に基づいて、自動運転制御や走行支援制御（自動ブレーキ等も含む）の中で、例えば、加減速する、事前に減速する、車線内の位置を制御する、路肩に寄せる、車線を通過する順番、などのような制御を実行するようにしてもよい。これにより、自車両５１において、急制動、急加減速を抑制することができるようになるため、乗員に与える違和感を抑制することができるようになる。

５１ 自車両
５２ 他車両
５３ 水たまり（路面の状態）
５４ａ、５４ｂ 轍（路面の状態）
５５ 歩行者（他車両の進行方向前方の物体）
５６ 先行車両（他車両の進行方向前方の物体）
１００マイクロコンピュータ（制御部）

Claims (4)

1. 自車両の周囲における他車両の動作を予測した結果に基づいて自車両の走行を支援する走行支援装置の動作予測方法において、
   前記他車両の周囲における路面上の轍を示す情報を取得し、
   前記路面上の轍を示す情報に基づいて前記轍に沿って走行する前記他車両の動作を予測する
   ことを特徴とする走行支援装置の動作予測方法。
2. 前記路面上の轍の上に物体が存在するか否かを判断し、
   前記路面上の轍を示す情報及び前記路面上の轍の上に物体が存在するか否かの判断結果に基づいて、前記他車両の動作を予測する
   ことを特徴とする請求項１に記載の走行支援装置の動作予測方法。
3. 前記他車両は停車していることを特徴とする請求項１に記載の走行支援装置の動作予測方法。
4. 自車両の周囲における他車両の位置に基づいて前記他車両の動作を予測する制御部を備える走行支援装置の動作予測装置において、
   前記制御部は、
   前記他車両の周囲における路面上の轍を示す情報を取得し、
   前記路面上の轍を示す情報に基づいて前記轍に沿って走行する前記他車両の動作を予測する
   ことを特徴とする走行支援装置の動作予測装置。

Images