JP6966632B2 - 車両制御装置 - Google Patents

Description

本発明は、車両の動作を制御する車両制御装置に関する。

現在、車両を自動運転する技術が盛んに開発されている。自動運転においては、車両の現在位置を判定することが重要である。車両の現在位置は一般に、例えばＧＮＳＳ（Ｇｌｏｂａｌ Ｎａｖｉｇａｔｉｏｎ Ｓａｔｅｌｌｉｔｅ Ｓｙｓｔｅｍ）によって車両の現在座標を特定し、さらにセンサによって車両の方位を特定することにより、判定することができる。

車両制御装置が運転者による車両運転を支援する際には、車両位置に加えて、車両が道路上のどのレーンを走行しているかを推定することが有用な場合がある。例えば車両が高速道路を走行する場面において、高速道路の本線と分岐路を区別し、道路種別に適した運転支援を提供することが考えられる。

下記特許文献１は、車両の位置を認識する技術を開示している。同文献は、『走行中の道路が分岐点にて分岐しても、自車両の現在位置を正しくマップマッチングする車両位置認識装置を提供する。』ことを目的として、『本発明における車両位置認識装置は、ＧＰＳ信号を受信するＧＰＳセンサと、ＧＰＳセンサが受信したＧＰＳ信号を基に自車両の位置を特定する自車位置特定部と、地図データを記憶した地図データ記憶部と、地図データ記憶部に記憶された地図データに基づいて、自車両が要判定分岐点に接近することを判定する要判定分岐点接近判定部と、自車両の側方対象物までの距離を測定するレーダ装置と、要判定分岐点接近判定部が要判定分岐点への接近を判定したときに、レーダ装置によって測定された測定結果によって分岐点を判定する分岐判定部と、を備える。』という技術を開示している（要約参照）。

下記特許文献２は、カーナビゲーションに関する技術を開示している。同文献は、『互いに並走する複数の道路の道路データを正しく補正し、次に車両がこれらの道路を走行したときに正しい走行道路を認識できるナビゲーション装置を提供する。』ことを課題として、『ナビゲーション装置は、道路情報を記憶する地図情報記憶手段１０３と、位置推定手段１１１と、複数のリンク候補点を特定するマップマッチング手段１１２と、互いに並走している並走路の各リンクを検出する並走路検出手段１２１と、並走路検出手段１２１により検出された並走路の各リンクについて、車両が走行している走行リンクまたは走行リンクに並走する並走リンクのいずれであるかをそれぞれ判定する走行リンク判定手段１２２と、走行リンクに対応するリンク候補点と位置推定手段１１１により推定された車両の位置との間の距離に基づいて、走行リンク及び並走リンクの各ノードの位置補正量を求めるリンク位置補正手段１２５とを備える。』という技術を開示している（要約参照）。

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

自動運転やカーナビゲーションにおいては、ＧＮＳＳを介して自車位置を取得し、その自車位置を用いて地図データを照会することにより、自車が走行している道路やレーンを特定するのが一般的である。しかし例えば高速道路のように、一般道から本線に対して合流する合流路や、本線から一般道に対して分岐する分岐路を備えている道路においては、合流路や分岐路が地図データ内に記述されていない場合がある。したがって合流路や分岐路の近傍において、自車位置を誤認識する可能性が高まる。

上記特許文献１〜２は、分岐点や並走路において車両位置を認識する技術について記載している。しかしこれら従来技術は、地図データが存在しない道路の周辺において車両位置の誤認識が生じる課題については、必ずしも具体的な解決手段を提供するには至っていない。

本発明は、上記のような課題に鑑みてなされたものであり、地図データが存在しない分岐路や合流路の周辺において、車両位置を正確に認識することができる技術を提供することを目的とする。

本発明に係る車両制御装置は、地図データに記述されていない道路を車両が走行している場合において、合流路や分岐路の始点と車両位置との間の位置関係に基づき、車両が合流路または分岐路を走行しているか否かを判定する。

本発明に係る車両制御装置によれば、合流路や分岐路の地図データが存在しない場合であっても、車両の位置を正確に判定することができる。

実施形態１に係る車両制御装置１００の構成図である。 高速道路の本線と分岐路の例である。 高速道路の本線と合流路の例である。 立体的に交差する道路の例である。 高速道路の本線と合流路の例である。

＜実施の形態１＞
図１は、本発明の実施形態１に係る車両制御装置１００の構成図である。車両制御装置１００は、車両の動作を制御する装置であり、車両内に搭載されている。車両制御装置１００は、演算部１１０、ＧＮＳＳチューナ１２０、加速度センサ１３０、高精度地図１４０、外界認識部１５０を備える。演算部１１０は、絶対位置推定部１１１、相対位置推定部１１２、道路特定部１１３、レーン判定部１１４を有する。

ＧＮＳＳチューナ１２０は、ＧＮＳＳシステムから車両の位置座標を取得する。この位置座標は車両自身の状態や周辺情報を用いずに取得した位置座標であるので、絶対位置と呼ぶ場合がある。加速度センサ１３０は車両の加速度を計測する。高精度地図１４０は、ＧＮＳＳチューナ１２０が取得する絶対位置よりも位置精度が高い地図情報であり、あらかじめ車両制御装置１００が備える記憶装置に格納されている。例えば道路やレーンの座標を高精度地図１４０として格納することができる。外界認識部１５０は、車両の外界の状態を表す情報を取得する。例えば車両の周辺画像をカメラから取得する。車両の加速度や車速などを取得してもよい。

絶対位置推定部１１１は、ＧＮＳＳチューナ１２０が取得した絶対位置座標に基づき、車両の現在の絶対位置を推定する。相対位置推定部１１２は、加速度センサ１３０が取得した加速度や車両の車速などの情報を用いて、絶対位置を基準とする車両の相対位置を推定する。すなわち相対位置は、絶対位置よりも精度の高い車両位置を表すとともに、ＧＮＳＳを介して間欠的に取得する座標を補完する役割も有している。絶対位置推定部１１１と相対位置推定部１１２は、車両の位置に加えて方位も推定する。道路特定部１１３は、高精度地図１４０と車両の周辺画像を用いて、車両が現在走行している道路（走行中道路）を特定する。詳細手順については後述する。レーン判定部１１４は、車両の絶対位置および相対位置と高精度地図１４０を比較することにより、車両が現在走行しているレーン（走行中レーン）を特定する。

図２は、高速道路の本線と分岐路の例である。高速道路は一般に、本線から一般道へ接続する分岐路を有している。本線と分岐路の接続点近傍（図２の中央付近）においては、本線のレーンに加えて分岐路が新たなレーンとして併存することになる。ここでは本線が２レーンを有し、分岐路が１レーンを有する例を示した。

レーン判定部１１４は、車両１０が本線を走行している間は２レーンのうちいずれを車両１０が走行しているかを判定するとともに、接続点近傍においては３レーンのうちいずれを車両１０が走行しているかを判定する。分岐路は１レーンのみ有するので、車両１０が分岐路を走行しているとき、レーン判定部１１４はそのレーンを車両１０が走行しているものとみなすことが望ましいといえる。

高精度地図１４０は、道路やレーンの座標を例えばネットワーク構造によって表現することができる。すなわち高精度地図１４０は、ノード１４１とリンク１４２の集合によって、道路やレーンを記述している。ただし高精度地図１４０は、分岐路の座標についての情報を記述していない場合がある。図２に示す例において高精度地図１４０は、本線から分岐路へ至る途中のリンクを記述しているが、分岐路内のその他部分についてはリンクもノードも記述していない。

高精度地図１４０が記述していない道路を車両１０が走行しているとき、道路特定部１１３とレーン判定部１１４は、車両１０が走行している道路とレーンを誤判定する可能性が高まる。特に図２に示す車両１０の位置においては、分岐路と本線が並走しており、かつ高精度地図１４０が記述している本線の座標が車両１０の近傍に存在するので、本線上を走行する車両１０’として誤認識する可能性が高まる。本実施形態１は、このような誤認識を抑制する手法を提案する。

高精度地図１４０が記述している道路から、高精度地図１４０が記述していない座標へ向かって車両１０が走行している場合、車両１０は本線から分岐路へ向かっていると推測される。そこで道路特定部１１３は、車両１０の位置と方位を取得するとともに、その位置と方位を用いて高精度地図１４０を照会することにより、高精度地図１４０が記述していない道路（すなわち図２の分岐路）へ向かって車両１０が走行しているか否かを、車両１０が走行している間に繰り返し判定する。例えばリンク１４２の方位と車両１０の方位との間の差分が所定閾値以下であるとともにリンク１４２の座標と車両１０の位置との間の差分が所定閾値以下である場合は、車両１０が分岐路へ向かっていると判定することができる。その他適当な手法を用いて判定してもよい。

車両１０とノード１４１またはリンク１４２とが近接しているか否かを判定するその他手法としては、例えば位置および方位それぞれの差分の２乗和が所定閾値以下であるか否かに基づき判定するなどが考えられる。例えば、車両１０の位置とリンク１４２の位置との間の差分を２乗し、車両１０の方位とリンク１４２の方位との間の差分を２乗し、これらを合算した値を所定閾値と比較する。合算する際に適当な重みを付与してもよい。

車両１０が分岐路へ向かっていると推測されるとしても、一時的に分岐路の方向を向いている可能性や、誤判定の可能性も考えられる。そこで道路特定部１１３はさらに、レーン判定部１１４による判定結果を用いて、車両１０が分岐路へ入ったか否かを判定する。
具体的には、本線のレーン（図２の中央レーン）から分岐路のレーン（図２の左レーン）へ向かって車両１０がレーンチェンジしたか否かを、レーン判定部１１４による判定結果に基づき判定する。車両１０が分岐路へ向かっており、かつ分岐路のレーンへレーンチェンジしたと判定した場合、道路特定部１１３は車両１０が分岐路を走行しているものと判定する。

レーン判定部１１４が走行レーンを判定する手法としては、絶対位置推定部１１１と相対位置推定部１１２による推定結果を基準としつつ、車両１０の周辺画像を併用して、レーン変更が発生したか否かを判定するなどの手法が考えられる。例えば車両１０が走行しているレーンの区画線の種別を用いて、走行レーンを判定することが考えられる。その他適当な判定手法を用いてもよい。

＜実施の形態１：まとめ＞
本実施形態１に係る車両制御装置１００は、高精度地図１４０が記述していない分岐路へ向かって車両１０が走行しているとき、車両１０が分岐路へ向かってレーンチェンジしたか否かを判定することにより、車両１０が分岐路を走行しているか否かを判定する。これにより、高精度地図１４０が記述していない分岐路を車両１０が走行しているときであっても、車両１０が分岐路に近接する本線を走行しているものとして誤認識する可能性を抑制することができる。

＜実施の形態２＞
実施形態１においては、車両１０が本線から分岐路へ向かうときにおける誤認識を抑制する手法について説明した。同様の誤認識は、車両１０が合流路から本線へ合流する際にも生じる可能性がある。そこで本発明の実施形態２では、車両１０が合流路から本線へ合流する際において、車両１０が走行している道路を正確に特定する手法を説明する。車両制御装置１００の構成は実施形態１と同様である。

図３は、高速道路の本線と合流路の例である。高速道路は一般に、一般道から本線へ接続する合流路を有している。分岐路と同様に、本線と合流路の接続点近傍（図３の中央付近）においては、本線のレーンに加えて合流路が新たなレーンとして併存する。ここでは本線が２レーンを有し、合流路が１レーンを有する例を示した。

本実施形態２において高精度地図１４０は、（ｉ）合流路と本線を接続する接続リンク１４４、（ｉｉ）接続リンク１４４の始点ノード１４３（接続リンク１４４の合流路側の端部）、を記述しているが、合流路内のその他部分についてはリンクもノードも記述していないものとする。

このような合流路を車両１０が走行しているとき、道路特定部１１３とレーン判定部１１４は、車両１０が走行している道路とレーンを誤判定する可能性が高まる。例えば図３における車両１０の位置においては、合流路と本線が並走しており、かつ高精度地図１４０が記述している本線の座標が車両１０の近傍に存在するので、本線上を走行する車両１０’として誤認識する可能性が高まる。本実施形態２においては、以下の手順によりそのような誤認識を抑制する。

（道路特定手順：ステップ１）
高精度地図１４０が記述していない道路を車両１０が走行しているとき、車両１０は図３の合流路のような道路を走行している可能性がある。そこで道路特定部１１３は、高精度地図１４０が記述していない道路を車両１０が走行しているとき、本実施形態２に係る道路判定手順を開始する。高精度地図１４０が記述していない道路であるか否かは、絶対位置推定部１１１と相対位置推定部１１２による車両１０の位置についての推定結果を高精度地図１４０と比較することにより判定できる。以下では記載の便宜上、高精度地図１４０が記述していない道路のことを合流路と呼ぶ。

（道路特定手順：ステップ２）
道路特定部１１３は、高精度地図１４０が記述している道路が車両１０の近傍に存在しているか否かを、例えば所定時間間隔で周期的に探索する。具体的には、車両１０の現在位置および方位と高精度地図１４０が記述している各道路の位置および方位とを比較することにより、近傍の道路を探索する。道路特定部１１３は、車両１０が合流路を走行していると推定されるときは、近傍に道路を発見したとしても、直ちにその道路を走行中道路とみなさず、以下の手順を実施する。

（道路特定手順：ステップ３）
道路特定部１１３は、近傍に発見した道路が、車両１０の走行方向とは反対方向に延伸しているか否か判定する。具体的には、発見した道路の高精度地図１４０上におけるリンク構造を走行方向とは反対方向にたどればよい。なお、この場合における高精度地図１４０は、リンク構造をたどることができる構成とする。発見した道路が反対方向に延伸している場合、その道路は図３における本線である可能性がある。したがって車両１０’のような誤認識を回避するため、発見した道路を走行中道路の候補から破棄する。すなわちこの時点においては走行中道路を特定しない。

（道路特定手順：ステップ４）
道路特定部１１３は、始点ノード１４３が車両１０の近傍に存在するか否か判定する。
具体的には、高精度地図１４０が記述しているネットワーク構造のうち、車両１０の現在位置の近傍において、以下の条件を満たすノードを探索することが考えられる：（ｉ）高精度地図１４０上に記述されている他の道路（図３における本線に相当）に対して接続するリンク（図３における接続リンク１４４に相当）を有し、（ｉｉ）それ以外のリンクを有さない。このようなノードは、高精度地図１４０が記述していない合流路の始点部分に相当すると考えられるからである。道路特定部１１３はさらに、車両１０が始点ノード１４３に向かって合流路を走行しているか否かを判定する。始点ノード１４３を通過した場合は後述する実施形態３の問題となるからである。

（道路特定手順：ステップ５）
道路特定部１１３は、ステップ４において始点ノード１４３を発見した場合は、始点ノード１４３以降（すなわち始点ノード１４３から見て車両１０の進行方向に延伸したノードおよびリンク）から、走行中道路を特定する処理を開始する。車両１０が始点ノード１４３に到達するまでは、走行中道路を特定する処理を保留する。

以上のステップ１〜ステップ４にしたがって走行中道路を特定することにより、高精度地図１４０が記述している始点ノード１４３以降を車両１０が走行しているときに限り、車両１０の位置と高精度地図１４０をマッチングすることになる。したがって、車両１０’のような誤認識を抑制できる。

図４は、立体的に交差する道路の例である。図４のように交差道路２００が延伸している場合、図３の始点ノード１４３と同じ平面座標上に交差道路２００が存在することになる。この場合、道路特定部１１３が始点ノード１４３を発見したとき、始点ノード１４３から延伸するのが接続リンク１４４と交差道路２００のいずれであるのか、判定できない可能性がある。そこでこのような場合、道路特定部１１３は、接続リンク１４４の方位と交差道路２００の方位を比較し、交差道路２００の方位が接続リンク１４４の方位と合致しなければ、交差道路２００を走行中道路の候補から除外することができる。これにより交差道路２００を走行中道路として誤認識することを抑制できる。

図４において、ＧＮＳＳチューナ１２０が車両１０の高さ方向の位置を取得するとともに、高精度地図１４０が高さ方向の道路構造を記述している場合、これらの情報を用いて交差道路２００を走行中道路の候補から除外することもできる。ＧＮＳＳチューナ１２０の高さ方向における精度が充分でなければ、図４で説明した手法を用いればよい。

＜実施の形態２：まとめ＞
本実施形態２に係る車両制御装置１００は、高精度地図１４０が記述していない合流路を車両１０が走行しており、かつ始点ノード１４３と接続リンク１４４を高精度地図１４０が記述している場合は、走行中道路を特定する処理を始点ノード１４３から開始する。
これにより車両１０’のように、合流路の始点ノード１４３近傍において、近接する本線を走行中道路として誤認識することを抑制できる。

本実施形態２に係る車両制御装置１００は、車両１０の近傍に隣接道路を発見した場合であっても、隣接道路が走行方向とは反対方向に延伸している場合は、その隣接道路を走行中道路として特定することを留保する。これにより、合流路上かつ始点ノード１４３から比較的離れた場所においても、合流路に近接する隣接不道路を走行中道路として誤認識することを抑制できる。

＜実施の形態３＞
実施形態２においては、車両１０が合流路の始点ノード１４３に到達するまでの間において、車両１０の位置を誤認識することを抑制する手法を説明した。同様の誤認識は、車両１０が始点ノード１４３を通過した後においても生じる可能性がある。そこで本発明の実施形態３では、車両１０が合流路の始点ノード１４３を通過する際において、車両１０が走行している道路を正確に特定する手法を説明する。車両制御装置１００の構成は実施形態１と同様である。

図５は、高速道路の本線と合流路の例である。図５の高速道路は図３に示したものと同じであるが、車両１０は本線に合流せず始点ノード１４３を通過したものとする。高精度地図１４０は、接続リンク１４４の終端（合流路と本線との間の接続点）を、終点ノード１４５として記述しているものとする。

合流路が始点ノード１４３以降も延伸しており、さらにその延伸部分において本線と並走している場合、道路特定部１１３とレーン判定部１１４は、車両１０が走行している道路とレーンを誤判定する可能性が高まる。例えば図５における車両１０の位置においては、合流路と本線が並走しており、かつ高精度地図１４０が記述している本線の座標が車両１０の近傍に存在するので、本線上を走行する車両１０’として誤認識する可能性が高まる。本実施形態３においては、以下の手順によりそのような誤認識を抑制する。

（道路特定手順：ステップ１）
道路特定部１１３は、高精度地図１４０が記述していない道路（以下では記載の便宜上合流路と呼ぶ）を車両１０が走行しているか否かを判定する。具体的な判定手法は例えば実施形態２におけるステップ１と同じでよい。

（道路特定手順：ステップ２）
道路特定部１１３は、車両１０が合流路を走行している場合において、車両１０が始点ノード１４３と終点ノード１４５いずれも通過したか否かを判定する。具体的には、車両１０の位置と始点ノード１４３および終点ノード１４５それぞれの位置を比較することにより、車両１０がこれらノードをともに通過したことを認識できる。通過したのが始点ノード１４３と終点ノード１４５であるのかそれともその他のノードであるのかは、ノードとリンクの構造を参照することにより識別できる。例えば実施形態２のステップ４のような手法を用いればよい。

（道路特定手順：ステップ３）
道路特定部１１３は、車両１０が合流路を走行しておりかつ始点ノード１４３と終点ノード１４５いずれも通過した場合は、車両１０が接続リンク１４４を走行したか否かを判定する。接続リンク１４４を走行したか否かは、例えば以下のような手法により判定することが考えられるが、これら以外の適当な手法を用いて判定してもよい。これらの手法を組み合わせてもよい。

（道路特定手順：ステップ３：判定手法その１）
道路特定部１１３は、車両１０の周辺画像を取得し、その周辺画像を用いて、車両１０が接続リンク１４４を走行したか否かを判定することができる。高速道路の本線は、高架上に設置されていて合流路と本線との間に高低差があることが多く、その場合の合流路は上り坂になっている。道路特定部１１３は、周辺画像に基づき、車両１０が上り坂を走行したか否かを判定する。上り坂を走行した場合は、車両１０が接続リンク１４４を走行したと推定することができる。その他、合流路を示す道路標識を画像認識することにより、合流路を走行したか否かを判定するなども考えられる。なお、高精度地図１４０が有する座標が平面座標に加えて高さ情報も含めたもの（三次元座標など）であれば、高低差の走行判定の際、高精度地図１４０の高さ情報と照合することにより、判定精度を向上することができる。

（道路特定手順：ステップ３：判定手法その２）
合流路が上り坂になっている場合、道路特定部１１３は、加速度センサ１３０による計測結果にしたがって、車両１０が接続リンク１４４を走行したか否かを判定することができる。例えば車両１０のピッチ角が前上がり方向に傾いている時間が所定閾値以上継続した場合は、車両１０が上り坂を走行したと推定できる。なお、高精度地図１４０が有する座標が平面座標に加えて高さ情報も含めたもの（傾斜に関する情報など）であれば、高低差の走行判定の際、高精度地図１４０の高さ情報と照合することにより、判定精度を向上することができる。

（道路特定手順：ステップ３：判定手法その３）
車両１０が接続リンク１４４を走行したか否かを判定することができれば、その他手法を用いてもよい。例えば周辺画像や車両１０の方位変化（例：ヨーレート）に基づき道路の曲率を判定し、曲率がある範囲内に収まっていれば車両１０がランプウェイ（１例として高低差のある場所を連結／分岐／合流する道路）を走行したと判定することが考えられる。以上の判定手法を組み合わせてもよい。

（道路特定手順：ステップ３：補足その１）
本ステップは、車両１０が図５の延伸部分を走行しているとき、すなわち車両１０が始点ノード１４３と終点ノード１４５を通過してから間がない時点において実施することに意義がある。例えば車両１０が合流路を降りて一般道に到達した時点で本ステップを実施する意義はないからである。したがって道路特定部１１３は、車両１０が始点ノード１４３と終点ノード１４５を通過したと判定したときは、即座に本ステップを実施することが望ましい。

（道路特定手順：ステップ３：補足その２）
始点ノード１４３と終点ノード１４５が比較的近接している場合、道路特定部１１３はこれらのうちいずれを車両１０が通過したのか、直ちに特定できない場合がある。このような場合には、車両１０が本線に入って終点ノード１４５を通過したのか、それとも合流路上を走行して始点ノード１４３を通過したのかを判別しにくいので、本実施形態３の手法が有用である。他方で始点ノード１４３と終点ノード１４５が比較的離れておりこれらを明確に区別できる場合は、車両１０がこれらノードのうち少なくともいずれか一方を通過した時点で本ステップを実施してもよい。さらに、これらノードのうち少なくともいずれか一方を通過してから所定時間が経過するまでの間、本ステップを繰り返し実施してもよい。

（道路特定手順：ステップ３：補足その３）
本線と合流路の位置関係によっては、合流路が下り坂または上り坂と下り坂の混合である場合も考えられるが、その場合であっても上記と同様の手法により本ステップを実施することができる。その他適当な手段を組み合わせてもよいし、上記手法に代えてその他適当な手段を用いてもよい。例えば道路側に配置されている路側センサから適当な信号を受信することにより、車両１０が接続リンク１４４を走行したか否かを判定するなどが考えられる。

（道路特定手順：ステップ４）
道路特定部１１３は、車両１０が接続リンク１４４を走行したと判定した場合は車両１０が本線を走行していると判定し、車両１０が接続リンク１４４を走行しなかったと判定した場合は車両１０が合流路を走行していると判定する。

＜実施の形態３：まとめ＞
本実施形態３に係る車両制御装置１００は、車両１０が始点ノード１４３または終点ノード１４５のうち少なくともいずれかを通過したか否かを判定し、通過したと判定した場合はさらに、車両１０が接続リンク１４４を通過したか否かを判定することにより、走行中道路を特定する。これにより、車両１０が合流路の始点ノード１４３を通過した際に、近接する本線を走行中道路として誤認識することを抑制できる。

＜本発明の変形例について＞
本発明は上記実施形態に限定されるものではなく、様々な変形例が含まれる。例えば、上記実施形態は本発明を分かりやすく説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。また、ある実施形態の構成の一部を他の実施形態の構成に置き換えることが可能であり、また、ある実施形態の構成に他の実施形態の構成を加えることも可能である。また、各実施形態の構成の一部について、他の構成の追加・削除・置換をすることが可能である。

上記の各構成、機能、処理部、処理手段等は、それらの一部又は全部を、例えば集積回路で設計する等によりハードウェアで実現してもよい。また、上記の各構成、機能等は、プロセッサがそれぞれの機能を実現するプログラムを解釈し、実行することによりソフトウェアで実現してもよい。各機能を実現するプログラム、テーブル、ファイル等の情報は、メモリや、ハードディスク、ＳＳＤ（Ｓｏｌｉｄ Ｓｔａｔｅ Ｄｒｉｖｅ）等の記録装置、または、ＩＣカード、ＳＤカード等の記録媒体に置くことができる。また、制御線や情報線は説明上必要と考えられるものを示しており、製品上必ずしも全ての制御線や情報線を示しているとは限らない。実際には殆ど全ての構成が相互に接続されていると考えてもよい。

１００：車両制御装置、１１０：演算部、１１１：絶対位置推定部、１１２：相対位置推定部、１１３：道路特定部、１１４：レーン判定部、１２０：ＧＮＳＳチューナ、１３０：加速度センサ、１４０：高精度地図

Claims (12)

1. 車両の動作を制御する車両制御装置であって、
   前記車両の位置を推定する位置推定部、
   道路の座標を記述した地図データを記憶する地図記憶部、
   前記位置推定部が推定した位置と前記地図データを照合することにより前記車両が走行している走行中道路を特定する道路特定部、
   を備え、
   前記道路特定部は、前記地図データに記述されていない地図なし道路を前記車両が走行していると判定したときは、前記地図なし道路に隣接する隣接道路と前記地図なし道路を接続する接続路を前記地図データが記述しているか否かを判定するとともに、前記車両が前記接続路に向かって前記地図なし道路を走行しているか否かを判定し、
   前記道路特定部は、前記接続路を前記地図データが記述しており、かつ前記車両が前記接続路に向かって前記地図なし道路を走行していると判定した場合は、前記走行中道路を特定する処理を、前記接続路の始点から開始する
   ことを特徴とする車両制御装置。
2. 前記道路特定部は、前記車両の位置と前記地図データを照合することにより、前記車両からの距離が所定閾値以下の範囲内に前記隣接道路が存在するか否かを判定し、
   前記道路特定部は、前記接続路を前記地図データが記述しており、かつ前記車両が前記接続路に向かって前記地図なし道路を走行していると判定した場合は、前記車両からの距離が前記所定閾値以下の範囲内に前記隣接道路が存在すると判定した場合であっても、前記接続路の始点に前記車両が到達するまでは、前記走行中道路を特定することを留保する
   ことを特徴とする請求項１記載の車両制御装置。
3. 前記道路特定部は、前記隣接道路が存在すると判定したときは、前記地図データにしたがって、前記隣接道路が前記車両の進行方向とは反対側に延伸しているか否かを判定し、
   前記道路特定部は、前記隣接道路が前記車両の進行方向とは反対側に延伸している場合は、前記隣接道路を前記走行中道路の候補から除外する
   ことを特徴とする請求項２記載の車両制御装置。
4. 前記道路特定部は、前記始点を通過する道路が複数存在する場合は、前記始点を通過する各道路が前記隣接道路と前記地図なし道路を接続する方向に延伸しているか否かに基づき、前記接続路を特定する
   ことを特徴とする請求項１記載の車両制御装置。
5. 前記道路特定部は、前記地図データに記述されていない地図なし道路を前記車両が走行していると判定したときは、前記地図なし道路に隣接する隣接道路と前記地図なし道路を接続する接続路を前記地図データが記述しているか否かを判定し、
   前記道路特定部は、前記車両が前記地図なし道路を走行しておりかつ前記接続路を前記地図データが記述している場合はさらに、前記接続路の始点または終点のうち少なくともいずれかを前記車両が通過したか否かを判定し、
   前記道路特定部は、前記始点または前記終点のうち少なくともいずれかを前記車両が通過したと判定したときは、前記車両が前記接続路を通過したか否かの判定結果に基づき前記走行中道路を特定する
   ことを特徴とする請求項１記載の車両制御装置。
6. 前記車両制御装置はさらに、前記車両の外界の状態を表す情報を取得する外界認識部を備え、
   前記道路特定部は、前記外界認識部による認識結果を用いて、前記車両が前記接続路を通過したか否かを判定する
   ことを特徴とする請求項５記載の車両制御装置。
7. 前記外界認識部は、前記車両の周辺画像を撮影する撮像部から前記周辺画像を取得することにより前記車両の外界の状態を認識し、
   前記道路特定部は、前記周辺画像を用いて、前記車両が高低差のある道路間を接続する道路を走行したか否かを判定することにより、前記車両が前記接続路を通過したか否かを判定する
   ことを特徴とする請求項６記載の車両制御装置。
8. 前記外界認識部は、前記車両の加速度を検出する加速度センサから前記加速度を表す信号を取得することにより前記車両の外界の状態を認識し、
   前記道路特定部は、前記加速度を用いて、前記車両が高低差のある道路間を接続する道路を走行したか否かを判定することにより、前記車両が前記接続路を通過したか否かを判定する
   ことを特徴とする請求項６記載の車両制御装置。
9. 前記道路特定部は、前記車両の位置と前記地図データを照合することにより、前記始点または前記終点のうち少なくともいずれかを前記車両が通過したと判定する
   ことを特徴とする請求項５記載の車両制御装置。
10. 前記車両制御装置はさらに、
    前記車両の外界の状態を表す情報を取得する外界認識部、
    前記外界認識部による認識結果を用いて、前記走行中道路が有するレーンのうち前記車両が走行している走行中レーンを判定するレーン判定部、
    を備え、
    前記道路特定部は、前記地図データに記述されている道路から前記地図データに記述されていない分岐路へ向かって前記車両が走行しているか否かを判定し、
    前記道路特定部は、前記車両が前記分岐路へ向かって走行していると判定した場合は、前記レーン判定部による判定結果にしたがって、前記車両が前記走行中レーンを前記分岐路へ向かう側に変更したか否かを判定し、
    前記道路特定部は、前記車両が前記走行中レーンを前記分岐路へ向かう側に変更したと判定した場合は、前記車両が前記分岐路を走行していると特定する
    ことを特徴とする請求項１記載の車両制御装置。
11. 前記位置推定部は、ＧＮＳＳを介して前記車両の位置と方位を推定し、
    前記道路特定部は、前記車両の位置および方位と、前記地図データが記述している前記分岐路の位置および方位とを比較することにより、前記車両が前記分岐路へ向かって走行しているか否かを判定する
    ことを特徴とする請求項１０記載の車両制御装置。
12. 前記位置推定部は、ＧＮＳＳを介して前記車両の位置と方位を推定し、
    前記外界認識部は、前記車両の外界の状態を表す情報として、前記車両の周辺画像を取得し、
    前記レーン判定部は、前記位置推定部が推定した前記車両の位置と方位、および前記周辺画像を用いて、前記走行中レーンを判定する
    ことを特徴とする請求項１０記載の車両制御装置。

Images