ナビゲーション装置および車両の走行安全装置
【課題】道路の分岐点において適切なマップマッチングをおこない、適切に安全装置を作動させる。
【解決手段】ナビゲーション装置１３は、現在位置検出部２１から出力される位置信号に基づいて地図データ記憶部２３の道路データのうち自車両が存在する走行路を判定するナビゲーション処理部２２と、撮影装置１６から出力される画像データに基づいて道路の走行区分線を認識する道路形状認識部６５とを備え、ナビゲーション処理部２２は、道路形状認識部６５により認識された走行区分線に基づいて、自車両が分岐点を通過する前後において同一の道路を継続して走行しているか否かを判定し、同一の道路を継続して走行していると判定した場合に、自車両が存在する走行路を、この時点までに判定した走行路から分岐点に接続された他の走行路へと変更することを禁止する。
【解決手段】ナビゲーション装置１３は、現在位置検出部２１から出力される位置信号に基づいて地図データ記憶部２３の道路データのうち自車両が存在する走行路を判定するナビゲーション処理部２２と、撮影装置１６から出力される画像データに基づいて道路の走行区分線を認識する道路形状認識部６５とを備え、ナビゲーション処理部２２は、道路形状認識部６５により認識された走行区分線に基づいて、自車両が分岐点を通過する前後において同一の道路を継続して走行しているか否かを判定し、同一の道路を継続して走行していると判定した場合に、自車両が存在する走行路を、この時点までに判定した走行路から分岐点に接続された他の走行路へと変更することを禁止する。
【発明の詳細な説明】
【技術分野】
【０００１】
この発明は、ナビゲーション装置および車両の走行安全装置に関するものである。
【背景技術】
【０００２】
従来、例えば、撮像装置により道路の走行区分線を認識し、道路の分岐点において走行区分線を跨いで走行した場合に、分岐路に分岐したことを検出する装置が知られている（例えば、特許文献１、特許文献２参照）。
【特許文献１】特開２００７−６２６５１号公報
【特許文献２】特開２００７−３２８６号公報
【発明の開示】
【発明が解決しようとする課題】
【０００３】
ところで、上記従来技術に係る装置をナビゲーション装置と共に車両に搭載した場合において、ナビゲーション装置は、地図の道路データと自車両の位置とに基づくマップマッチングをおこなう際に、道路の分岐点において自車両が実際に走行する道路とは異なる走行路の道路データに自車両の位置がマッチングされてしまうミスマッチングが生じた場合であっても、走行路の道路データと自車両の位置との位置ずれが所定値以上に増大するまでは、ミスマッチングの有無を適切に判定することができず、撮像装置に基づく道路の認識結果とナビゲーション装置の演算結果との間の不整合が増大してしまういつ問題が生じる。
本発明は上記事情に鑑みてなされたもので、道路の分岐点において適切なマップマッチングをおこなうことが可能なナビゲーション装置および道路の分岐点において適切に安全装置を作動させることが可能な車両の走行安全装置を提供することを目的としている。
【課題を解決するための手段】
【０００４】
上記課題を解決して係る目的を達成するために、本発明の第１態様に係るナビゲーション装置は、道路データを記憶する記憶手段（実施の形態での地図データ記憶部２３）と、自車両の位置を検出して位置信号を出力する自車位置検出手段（実施の形態での現在位置検出部２１）と、前記道路データおよび前記自車位置検出手段から出力される前記位置信号に基づいて前記道路データのうち自車両が存在する走行路を判定する走行路判定手段（実施の形態でのナビゲーション処理部２２）とを備えるナビゲーション装置であって、自車両の外界を撮像して画像信号を出力する撮像手段（実施の形態での撮影装置１６）と、前記撮像手段から出力される前記画像信号に基づいて道路の走行区分線を認識する走行区分線認識手段（実施の形態での道路形状認識部６５）と、前記道路データに基づいて道路の分岐点を取得する分岐点取得手段（実施の形態でのナビゲーション処理部２２）とを備え、前記走行路判定手段は、前記走行区分線認識手段により認識された前記走行区分線に基づいて、自車両が前記分岐点取得手段により取得された前記分岐点を通過する前後において同一の前記道路を継続して走行しているか否かを判定し、自車両が前記分岐点を通過する前後において同一の前記道路を継続して走行していると判定した場合に、自車両が存在する走行路を、この時点までに判定した走行路から前記分岐点に接続された他の走行路へと変更することを禁止する。
【０００５】
さらに、本発明の第２態様に係るナビゲーション装置では、前記走行路判定手段は、自車両が前記分岐点を通過する前後において前記走行区分線認識手段により認識された同一の左右の前記走行区分線の間に継続して存在する場合に、同一の前記道路を継続して走行していると判定する。
【０００６】
さらに、本発明の第３態様に係るナビゲーション装置では、前記走行路判定手段は、自車両が前記分岐点に到達する以前において前記道路の右側車線または左側車線の何れの車線を継続して走行しているかを認識したか否かを判定し、自車両が前記分岐点に到達する以前において前記道路の右側車線または左側車線の何れの車線を継続して走行しているかを認識したと判定した場合には、自車両が存在する走行路を、この時点までに判定した走行路から前記分岐点に接続された他の走行路へと変更することを許可する。
【０００７】
また、本発明の第４態様に係る車両の走行安全装置は、道路データを記憶する記憶手段（実施の形態での地図データ記憶部２３）と、自車両の位置を検出して位置信号を出力する自車位置検出手段（実施の形態での現在位置検出部２１）と、前記道路データおよび前記自車位置検出手段から出力される前記位置信号に基づいて前記道路データのうち自車両が存在する走行路を判定する走行路判定手段（実施の形態でのナビゲーション処理部２２）と、自車両の車両状態を検出して車両状態信号を出力するする車両状態検出手段（実施の形態での現在位置検出部２１）と、前記走行路判定手段により判定された自車両が存在する走行路および前記車両状態検出手段から出力される前記走行状態信号に基づいて、自車両に設けられた安全装置（実施の形態での安全装置１５）を作動させる作動手段（実施の形態での作動部６４）とを備える車両の走行安全装置であって、自車両の外界を撮像して画像信号を出力する撮像手段（実施の形態での撮影装置１６）と、前記撮像手段から出力される前記画像信号に基づいて道路の走行区分線を認識する走行区分線認識手段（実施の形態での道路形状認識部６５）とを備え、前記作動手段は、前記走行区分線認識手段により認識された前記走行区分線に基づいて、自車両が同一の前記道路を継続して走行しているか否かを判定し、自車両が同一の前記道路を継続して走行していると判定した場合に、前記走行路判定手段により自車両が存在する走行路の変更がおこなわれたときに、前記安全装置の作動を禁止する。
【発明の効果】
【０００８】
本発明の第１態様に係るナビゲーション装置によれば、撮像手段から出力される画像信号に基づいて、自車両が分岐点を通過する前後において同一の道路を継続して走行していると判定される場合には、道路データおよび自車両の位置に基づき自車両が存在する走行路が変更されることを禁止することから、自車両が実際に走行する道路とは異なる走行路の道路データに自車両の位置がマッチングされてしまうミスマッチングが生じることを防止することができる。
【０００９】
さらに、本発明の第２態様に係るナビゲーション装置によれば、自車両が分岐点を通過する前後において同一の左右の走行区分線の間に継続して存在する場合に、同一の道路を継続して走行していると判定することにより、判定精度および判定結果の信頼性を向上させることができる。
【００１０】
さらに、本発明の第３態様に係るナビゲーション装置によれば、分岐点の手前位置から継続して道路の右側車線または左側車線の何れの車線を走行していることを認識した場合には、自車両が実際に走行する道路とは異なる走行路の道路データに自車両の位置がマッチングされてしまうミスマッチングが生じる可能性が低いと判断して、道路データおよび自車両の位置に基づき自車両が存在する走行路が変更されることを許可することから、判定処理が過剰に複雑化することを防止することができる。
【００１１】
また、本発明の第４態様に係る車両の走行安全装置によれば、撮像手段から出力される画像信号に基づいて、自車両が同一の道路を継続して走行していると判定される状態で、自車両が存在する走行路の変更がおこなわれたときに、安全装置の作動を禁止することから、自車両が実際に走行する道路とは異なる走行路の道路データに応じて不必要に安全装置が作動することを防止することができる。
【発明を実施するための最良の形態】
【００１２】
以下、本発明の一実施形態に係るナビゲーション装置および車両の走行安全装置について添付図面を参照しながら説明する。
【００１３】
図１に示すように、本実施の形態による車両の走行安全装置１０は、例えば、内燃機関１１の駆動力を、オートマチックトランスミッション（ＡＴ）あるいは無段自動変速機（ＣＶＴ）などのトランスミッション（Ｔ／Ｍ）１２を介して車両の駆動輪に伝達する車両に搭載され、ナビゲーション装置１３と、制御装置１４と、ブレーキアクチュエータ１５ａおよび警報装置１５ｂを具備する安全装置１５と、外界センサをなす撮影装置１６とを備えて構成されている。
【００１４】
なお、撮影装置１６は、例えば可視光領域や赤外線領域にて撮像可能なカメラ１６ａおよび画像処理部１６ｂを備えて構成され、カメラ１６ａは、例えばフロントウィンドウの車室内側に配置され、フロントウィンドウ越しに自車両の進行方向前方の所定検知範囲の外界を撮影する。画像処理部１６ｂは、カメラ１６ａにより撮影して得た画像に対して、例えばフィルタリングや二値化処理等の所定の画像処理を行い、画像データを生成して制御装置１４へ出力する。
【００１５】
ナビゲーション装置１３は、例えば現在位置検出部２１と、ナビゲーション処理部２２と、地図データ記憶部２３と、入力部２４と、出力部２５とを備えて構成されている。
【００１６】
さらに、現在位置検出部２１は、例えば人工衛星を利用して車両の位置を測定するためのＧＰＳ（Global Positioning System）信号などの測位信号を受信する測位信号受信部３１と、水平面内での自車両の向きや鉛直方向に対する傾斜角度（例えば、車両の前後方向軸の鉛直方向に対する傾斜角度や車両重心の上下方向軸回りの回転角であるヨー角など）および傾斜角度の変化量（例えば、ヨーレートなど）を検出するジャイロセンサ３２と、車両の速度（車速）を検出する車速センサ３３とを備えて構成され、受信した測位信号によって、あるいは、車速やヨーレートなどの検出信号に基づく自律航法の算出処理によって、車両の現在位置を算出する。
【００１７】
地図データ記憶部２３は、例えばナビゲーション処理などにおいて出力部２５の表示装置（図示略）に地図を表示するための地図表示用のデータおよび自車両の現在位置に基づくマップマッチングの処理に必要とされる道路座標データに加えて、経路探索や経路誘導などの処理に必要とされるデータ、例えば交差点および分岐点などの所定位置の緯度および経度からなる点であるノードと各ノード間を結ぶ線であるリンクとからなる道路データを地図データとして備えており、さらに、ノードおよびリンクには各種の情報が付加されている。
例えば、各ノードに対しては、緯度および経度および標高に加えて、信号機の有無や複数の道路の交差角度や形状などの交差点情報や、分岐点での分岐路の形状あるいはジャンクションでの道路の形状などの情報が付加され、各リンクには、道路種別（例えば、高速道路、一般道など）などの情報が付加されている。
【００１８】
ナビゲーション処理部２２は、例えば、地図データ記憶部２３から取得される道路データに対して、現在位置検出部２１における測位信号および自律航法の算出処理のそれぞれ、又は、何れか一方から得られる自車両の現在位置の情報に基づいてマップマッチングを行い、位置検出の結果を補正すると共に、道路データに具備される複数の走行路のうち、自車両が存在する走行路を判定する。そして、検出された車両の現在位置、あるいは、各種スイッチやキーボード等からなる入力部２４を介して操作者により入力された適宜の車両の位置に対して、出力部２５の表示装置での地図表示およびスピーカ（図示略）からの音声出力などを制御する。
また、ナビゲーション処理部２２は、例えば車両の経路探索や経路誘導などの処理を実行し、地図データ記憶部２３から取得される道路データと共に、例えば目的地までの経路情報や各種の付加情報を出力部２５へ出力する。
【００１９】
制御装置１４は、速度制御部４１と、エンジン制御部４２と、変速制御部４３と、ブレーキ制御部４４と、警報制御部４５とを備えて構成され、運転者によるアクセルペダルの操作量に係るアクセル開度を検出するアクセルペダル開度センサ５１と、運転者によるブレーキペダルの操作量を検出するブレーキペダルセンサ５２と、スロットル開度を検出するスロットル開度センサ５３とから出力される各検出信号が入力されている。
【００２０】
速度制御部４１は、カーブ認識部６１と、適正車速設定部６２と、比較部６３と、作動部６４と、道路形状認識部６５とを備えて構成されている。
【００２１】
カーブ認識部６１は、地図データ記憶部２３に記憶された道路データを取得し、この道路データに基づいて自車両の進行方向の道路形状として道路に存在するカーブを検出する。
例えばカーブ認識部６１は、道路データの基礎となるノードつまり道路形状を把握するための点と、リンクつまり各ノードを結ぶ線とに基づいて、カーブの形状を認識する。そして、例えばカーブの径や曲率および極性、カーブの長さ（カーブの深さ）、カーブの通過に要する旋回角などからなるカーブ形状値を算出し、適正車速設定部６２へ出力する。
【００２２】
適正車速設定部６２は、カーブ認識部６１にて認識されたカーブ形状値に基づいて、カーブを適正に通過可能な車両の速度（適正速度ＶＳ）を算出する。そして、適正車速設定部６２は設定した適正速度ＶＳのデータを比較部６３へ出力する。
ここで、適正車速設定部６２は、カーブ通過時に車両の横方向に発生する加速度（横加速度）を算出する横加速度算出部６２ａを備えている。すなわち、先ず、横加速度算出部６２ａは、カーブ認識部６１にて認識されたカーブの形状に基づいて、このカーブを適正に通過する際に許容される横加速度を算出する。次に、適正車速設定部６２は、この横加速度を車両に発生させる車両の速度を算出し、この速度を適正速度ＶＳとして設定する。
なお、カーブ通過時に自車両に許容される横加速度は、路面状況、タイヤの状況、積載の状態などにより変化するため、これらを更に考慮して適正速度ＶＳを設定するようにしてもよい。
また、認識されたカーブの形状の手前に上り勾配あるいは下り勾配などが存在する場合には、これらの勾配の大きさに応じて適正速度ＶＳが設定される。
【００２３】
比較部６３は、現在位置検出部２１の車速センサ３３にて検出した車両の速度（現在速度）ＶＰと、適正車速設定部６２にて設定した適正速度ＶＳとを比較して、この比較結果を作動部６４へ出力する。
作動部６４は、比較部６３での比較結果に基づいてエンジン制御部４２および変速制御部４３およびブレーキ制御部４４および警報制御部４５の作動を制御する。例えば、比較部６３での比較結果において、車速センサ３３にて検出した現在速度ＶＰと適正車速設定部６２にて設定した適正速度ＶＳとが異なる場合、例えば検出された車両の現在速度ＶＰが適正速度ＶＳよりも高い状態等のように車両が適正車両状態にない場合には、警報制御部４５を介して警報装置１５ｂを作動させて運転者の注意を喚起したり、ブレーキ制御部４４を介してブレーキアクチュエータ１５ａを作動させて自動的に車両を減速させる。
【００２４】
道路形状認識部６５は、例えば撮影装置１６から入力される画像データに基づき、画像データ上において自車両の走行車線に対する走行区分線（つまり、自車両が走行する道路の走行区分線）を検知することで自車両の進行方向の道路形状を認識する。
この道路形状認識部６５により認識された自車両が走行する道路の走行区分線のデータは、制御装置１４の作動部６４およびナビゲーション装置１３のナビゲーション処理部２２へ出力されている。
【００２５】
ナビゲーション処理部２２は、地図データ記憶部２３に記憶された道路データに基づいて、マップマッチングの処理において判定された自車両が存在する走行路上に設けられた分岐点および分岐路を取得し、道路形状認識部６５により認識された走行区分線に基づいて、自車両が分岐点を通過する前後において、同一の道路を継続して走行しているか否かを判定する。この判定処理では、例えば、自車両が分岐点を通過する前後において、道路形状認識部６５により認識された同一の１対の左右の走行区分線の間に自車両が継続して存在する場合（つまり、走行区分線を跨がずに走行する場合）に、自車両が同一の道路を継続して走行していると判定する。
【００２６】
そして、ナビゲーション処理部２２は、自車両が分岐点を通過する前後において、同一の道路を継続して走行していると判定した場合に、マップマッチングの処理において判定される自車両が存在する走行路を、この時点までに判定した走行路から分岐点に接続された他の走行路へと変更することを禁止する。
【００２７】
例えば図２に示すように、本線Ｒａを走行する自車両Ｐの進行方向前方に分岐点Ｄにおいて本線Ｒａから分岐する分岐路Ｒｂが存在する場合に、先ず、この分岐点Ｄの手前位置では、ナビゲーション処理部２２によって設定される誘導経路Ａ（つまり、適宜の目的地に対する経路探索や経路誘導などの処理で用いられる経路）と予測経路Ｂ（つまり、自車両の走行制御の処理やマップマッチングの処理などで用いられる経路）とは一致しており、かつ、マップマッチングの処理で判定される自車両が存在する走行路と予測経路Ｂとは一致している。
【００２８】
そして、分岐点Ｄ付近以降において、例えば、誘導経路Ａが分岐路Ｒｂに設定され、かつ、予測経路Ｂが本線Ｒａに設定されることで、誘導経路Ａと予測経路Ｂとが一致しないと判定されると、誘導経路Ａと一致するようにして予測経路Ｂが変更されることになり、これに伴い、マップマッチングの処理で判定される自車両が存在する走行路の変更を指示する指令が出力される。
しかしながら、実際には、自車両Ｐが本線Ｒａを継続して走行することに伴い、道路形状認識部６５により認識された走行区分線に基づいて、自車両が分岐点Ｄを通過する前後において同一の１対の左右の走行区分線の間に継続して存在すると判定され、自車両が同一の道路（つまり、本線Ｒａ）を継続して走行していると判定されることから、マップマッチングの処理において判定される自車両が存在する走行路を、この時点までに判定した走行路（つまり、本線Ｒａ）から分岐点Ｄに接続された他の走行路（つまり、分岐路Ｒｂ）へと変更することは禁止される。
【００２９】
また、作動部６４は、道路形状認識部６５により認識された走行区分線に基づいて、自車両が分岐点を通過する前後において、同一の道路を継続して走行しているか否かを判定する。この判定処理では、例えば、自車両が分岐点を通過する前後において、道路形状認識部６５により認識された同一の１対の左右の走行区分線の間に自車両が継続して存在する場合に、自車両が同一の道路を継続して走行していると判定する。
【００３０】
そして、作動部６４は、自車両が分岐点を通過する前後において、同一の道路を継続して走行していると判定した場合に、ナビゲーション処理部２２によってマップマッチングの処理において判定される自車両が存在する走行路が変更されたときに、安全装置１５の作動を禁止する。
【００３１】
本実施の形態による車両の走行安全装置１０は上記構成を備えており、次に、この車両の走行安全装置１０の動作について添付図面を参照しながら説明する。
【００３２】
先ず、以下に、作動部６４およびブレーキ制御部４４による作動判断処理について説明する。
例えば図３に示すステップＳ０１においては、地図データ記憶部２３に格納された自車両の進行方向前方の道路データを取得する。
次に、ステップＳ０２おいては、自車両の現在位置および車速を取得する。
そして、ステップＳ０３においては、道路データに基づき、進行方向前方にカーブを認識したか否かを判定する。
この判定結果が「ＮＯ」の場合には、一連の処理を終了する。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ０４に進む。
【００３３】
そして、ステップＳ０４においては、認識したカーブ（認識カーブ）までの距離が所定距離以下であるか否かを判定する。
この判定結果が「ＮＯ」の場合には、一連の処理を終了する。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ０５に進む。
そして、ステップＳ０５においては、認識カーブにおける適正通過車速を算出する。
そして、ステップＳ０６においては、自車両の車速が適正通過車速よりも大きいか否かを判定する。
この判定結果が「ＮＯ」の場合には、一連の処理を終了する。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ０７に進む。
【００３４】
そして、ステップＳ０７においては、自車両の車速から適正通過車速を減算して速度差ΔＶを算出する。
そして、ステップＳ０８においては、速度差ΔＶに応じてブレーキアシスト量を算出する。
そして、ステップＳ０９においては、運転者によるブレーキ操作があるか否かを判定する。
この判定結果が「ＮＯ」の場合には、一連の処理を終了する。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ１０に進む。
そして、ステップＳ１０においては、算出したブレーキアシスト量に応じたブレーキアシストを実行し、一連の処理を終了する。
【００３５】
以下に、ナビゲーション処理部２２の動作、自車両が存在する走行路を判定する処理について説明する。
例えば図４に示すステップＳ２１においては、地図データ記憶部２３から取得される道路データと現在位置検出部２１により検出される自車両の現在位置とに基づき、ナビゲーション処理部２２のマップマッチングの処理において自車両が存在する走行路が認識されているか否かを判定する。
この判定結果が「ＮＯ」の場合には、リターンに進む。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ２２に進む。
【００３６】
そして、ステップＳ２２においては、ナビゲーション処理部２２のマップマッチングの処理において自車両が存在する走行路として同一の走行路が継続してマッチングされているか否かを判定する。
この判定結果が「ＮＯ」の場合には、リターンに進む。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ２３に進む。
【００３７】
そして、ステップＳ２３においては、ナビゲーション処理部２２によって誘導経路、つまり適宜の目的地に対する経路探索や経路誘導などの処理で用いられる経路が設定されているか否かを判定する。
この判定結果が「ＹＥＳ」の場合には、ステップＳ２４に進み、このステップＳ２４においては、予測経路（つまり、自車両の走行制御の処理やマップマッチングの処理などで用いられる経路）として誘導経路が設定される。
一方、この判定結果が「ＮＯ」の場合には、ステップＳ２５に進み、このステップＳ２５においては、例えば車速やヨーレートなどの検出信号に基づき、予測経路を作成する。
【００３８】
そして、ステップＳ２６においては、例えば自車両が分岐点を通過する場合などにおいて、ナビゲーション処理部２２のマップマッチングの処理で判定される自車両が存在する走行路の変更を指示する指令が出力されているか否かを判定する。
この判定結果が「ＮＯ」の場合には、リターンに進む。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ２７に進む。
そして、ステップＳ２７においては、道路形状認識部６５により認識された走行区分線に基づいて、自車両が同一の道路を継続して走行しているか否かを判定する。
この判定結果が「ＹＥＳ」の場合には、後述するステップＳ３０に進む。
一方、この判定結果が「ＮＯ」の場合には、ステップＳ２８に進む。
【００３９】
そして、ステップＳ２８においては、自車両が走行中の道路が継続して認識されずに認識に断絶が生じたと判断する。
そして、ステップＳ２９においては、マップマッチングの処理において判定される自車両が存在する走行路を、この時点までに判定した走行路から分岐点に接続された他の走行路へと変更することを許可し、リターンに進む。
【００４０】
また、ステップＳ３０においては、マップマッチングの処理において判定される自車両が存在する走行路を、この時点までに判定した走行路から分岐点に接続された他の走行路へと変更することを禁止する。
そして、ステップＳ３１においては、マップマッチングの処理において判定される自車両が存在する走行路と、予測経路とが一致するか否かを判定する。
この判定結果が「ＹＥＳ」の場合には、この時点で設定されている予測経路を維持し、リターンに進む。
一方、この判定結果が「ＮＯ」の場合には、ステップＳ３３に進み、新たな予測経路（新規予測経路）を生成し、リターンに進む。
【００４１】
以下に、作動部６４の動作、安全装置１５の作動を制御する処理について説明する。
例えば図５に示すステップＳ４１においては、地図データ記憶部２３から取得される道路データと現在位置検出部２１により検出される自車両の現在位置とに基づき、ナビゲーション処理部２２のマップマッチングの処理において自車両が存在する走行路が認識されているか否かを判定する。
この判定結果が「ＮＯ」の場合には、ステップＳ４２に進む。
一方、この判定結果が「ＹＥＳ」の場合には、後述するステップＳ４４に進む。
【００４２】
そして、ステップＳ４２においては、ナビゲーション処理部２２のマップマッチングの処理において自車両が存在する走行路として設定される走行路対象が実際に存在しないか否かを判定する。
この判定結果が「ＹＥＳ」の場合には、リターンに進む。
一方、この判定結果が「ＮＯ」の場合には、自車両が実際に走行中の道路の道路データが地図データ記憶部２３に存在しないと判断し、後述するステップＳ４７に進む。
【００４３】
また、ステップＳ４４においては、道路形状認識部６５により認識された走行区分線に基づいて、自車両が同一の道路を継続して走行しているか否かを判定する。
この判定結果が「ＮＯ」の場合には、ステップＳ４５に進み、このステップＳ４５においては、自車両が走行中の道路が継続して認識されずに認識に断絶が生じたと判断し、リターンに進む。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ４６に進む。
【００４４】
そして、ステップＳ４６においては、ナビゲーション処理部２２のマップマッチングの処理において自車両が存在する走行路として同一の走行路が継続してマッチングされているか否かを判定する。
この判定結果が「ＮＯ」の場合には、リターンに進む。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ４７に進む。
【００４５】
そして、ステップＳ４７においては、例えば自車両が分岐点を通過する場合などにおいて、ナビゲーション処理部２２のマップマッチングの処理で判定される自車両が存在する走行路の変更を指示する指令が出力されているか否かを判定する。
この判定結果が「ＮＯ」の場合には、リターンに進む。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ４８に進む。
そして、ステップＳ４８においては、マップマッチングの処理で判定される自車両が存在する走行路により予測経路を生成する。
【００４６】
そして、ステップＳ４９においては、安全装置１５の作動要求があるか否かを判定する。
この判定結果が「ＮＯ」の場合には、リターンに進む。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ５０に進む。
そして、ステップＳ５０においては、道路形状認識部６５により認識された走行区分線に基づいて、自車両が同一の道路を継続して走行しているか否かを判定する。
この判定結果が「ＹＥＳ」の場合には、ステップＳ５１に進み、このステップＳ５１においては、安全装置１５の作動を禁止し、リターンに進む。
一方、この判定結果が「ＮＯ」の場合には、リターンに進む。
【００４７】
上述したように、本実施の形態によるナビゲーション装置１３によれば、撮影装置１６から出力される画像データに基づいて、自車両が分岐点を通過する前後において同一の道路を継続して走行していると判定される場合には、道路データおよび自車両の現在位置に基づき自車両が存在する走行路が変更されることを禁止することから、自車両が実際に走行する道路とは異なる走行路の道路データに自車両の位置がマッチングされてしまうミスマッチングが生じることを防止することができる。
また、自車両が分岐点を通過する前後において同一の左右の走行区分線の間に継続して存在する場合（つまり、走行区分線を跨がずに走行する場合）に、同一の道路を継続して走行していると判定することにより、判定精度および判定結果の信頼性を向上させることができる。
【００４８】
また、本実施の形態による車両の走行安全装置１０によれば、撮影装置１６から出力される画像データに基づいて、自車両が同一の道路を継続して走行していると判定される状態で、自車両が存在する走行路の変更がおこなわれたときに、安全装置１５の作動を禁止することから、自車両が実際に走行する道路とは異なる走行路の道路データに応じて不必要に安全装置１５が作動することを防止することができる。
【００４９】
なお、上述した実施の形態においては、例えば図２に示すように、自車両が本線を走行して分岐点を通過する前後において、同一の道路を継続して走行していると判定した場合に、マップマッチングの処理において判定される自車両が存在する走行路を、この時点までに判定した走行路（つまり本線）から分岐点に接続された他の走行路（つまり、本線に取り付けられた分岐路）へと変更することを禁止するとしたが、これに限定されず、例えば図６に示すように、自車両の進行方向前方に分岐点としてジャンクションが存在する場合には、このジャンクションの手前位置から継続して道路の右側車線または左側車線の何れの車線を走行しているか否かを判定し、この判定結果に応じて自車両が存在する走行路の変更を許可してもよい。
【００５０】
例えば図６に示すように、自車両ＰがジャンクションＪの手前位置から継続して道路の左側車線を走行していると判定した場合には、ナビゲーション処理部２２によって設定される誘導経路Ａと予測経路Ｂとは一致する可能性が高く、自車両が実際に走行する道路とは異なる走行路の道路データに自車両の位置がマッチングされてしまうミスマッチングが生じる可能性が低いと判断して、道路データおよび自車両の位置に基づき自車両が存在する走行路が変更されることを許可する。これにより、判定処理が過剰に複雑化することを防止することができる。
【図面の簡単な説明】
【００５１】
【図１】本発明の一実施形態に係る車両の走行安全装置の構成を示す機能ブロック図である。
【図２】本発明の一実施形態に係る分岐点を有する道路での誘導経路および予測経路の一例を示す図である。
【図３】本発明の一実施形態に係る車両の走行安全装置の作動部およびブレーキ制御部による作動判断処理の一例を示すフローチャートである。
【図４】本発明の一実施形態に係る車両の走行安全装置のナビゲーション処理部の動作の一例を示すフローチャートである。
【図５】本発明の一実施形態に係る車両の走行安全装置の作動部の動作の一例を示すフローチャートである。
【図６】本発明の一実施形態に係るジャンクションを有する道路での誘導経路および予測経路の一例を示す図である。
【符号の説明】
【００５２】
１０ 車両の走行安全装置
１５ 安全装置
１６ 撮影装置（撮像手段）
２１ 現在位置検出部（自車位置検出手段）
２２ ナビゲーション処理部（走行路判定手段、分岐点取得手段）
２３ 地図データ記憶部（記憶手段）
６４ 作動部（作動手段）
６５ 道路形状認識部（走行区分線認識手段）
【技術分野】
【０００１】
この発明は、ナビゲーション装置および車両の走行安全装置に関するものである。
【背景技術】
【０００２】
従来、例えば、撮像装置により道路の走行区分線を認識し、道路の分岐点において走行区分線を跨いで走行した場合に、分岐路に分岐したことを検出する装置が知られている（例えば、特許文献１、特許文献２参照）。
【特許文献１】特開２００７−６２６５１号公報
【特許文献２】特開２００７−３２８６号公報
【発明の開示】
【発明が解決しようとする課題】
【０００３】
ところで、上記従来技術に係る装置をナビゲーション装置と共に車両に搭載した場合において、ナビゲーション装置は、地図の道路データと自車両の位置とに基づくマップマッチングをおこなう際に、道路の分岐点において自車両が実際に走行する道路とは異なる走行路の道路データに自車両の位置がマッチングされてしまうミスマッチングが生じた場合であっても、走行路の道路データと自車両の位置との位置ずれが所定値以上に増大するまでは、ミスマッチングの有無を適切に判定することができず、撮像装置に基づく道路の認識結果とナビゲーション装置の演算結果との間の不整合が増大してしまういつ問題が生じる。
本発明は上記事情に鑑みてなされたもので、道路の分岐点において適切なマップマッチングをおこなうことが可能なナビゲーション装置および道路の分岐点において適切に安全装置を作動させることが可能な車両の走行安全装置を提供することを目的としている。
【課題を解決するための手段】
【０００４】
上記課題を解決して係る目的を達成するために、本発明の第１態様に係るナビゲーション装置は、道路データを記憶する記憶手段（実施の形態での地図データ記憶部２３）と、自車両の位置を検出して位置信号を出力する自車位置検出手段（実施の形態での現在位置検出部２１）と、前記道路データおよび前記自車位置検出手段から出力される前記位置信号に基づいて前記道路データのうち自車両が存在する走行路を判定する走行路判定手段（実施の形態でのナビゲーション処理部２２）とを備えるナビゲーション装置であって、自車両の外界を撮像して画像信号を出力する撮像手段（実施の形態での撮影装置１６）と、前記撮像手段から出力される前記画像信号に基づいて道路の走行区分線を認識する走行区分線認識手段（実施の形態での道路形状認識部６５）と、前記道路データに基づいて道路の分岐点を取得する分岐点取得手段（実施の形態でのナビゲーション処理部２２）とを備え、前記走行路判定手段は、前記走行区分線認識手段により認識された前記走行区分線に基づいて、自車両が前記分岐点取得手段により取得された前記分岐点を通過する前後において同一の前記道路を継続して走行しているか否かを判定し、自車両が前記分岐点を通過する前後において同一の前記道路を継続して走行していると判定した場合に、自車両が存在する走行路を、この時点までに判定した走行路から前記分岐点に接続された他の走行路へと変更することを禁止する。
【０００５】
さらに、本発明の第２態様に係るナビゲーション装置では、前記走行路判定手段は、自車両が前記分岐点を通過する前後において前記走行区分線認識手段により認識された同一の左右の前記走行区分線の間に継続して存在する場合に、同一の前記道路を継続して走行していると判定する。
【０００６】
さらに、本発明の第３態様に係るナビゲーション装置では、前記走行路判定手段は、自車両が前記分岐点に到達する以前において前記道路の右側車線または左側車線の何れの車線を継続して走行しているかを認識したか否かを判定し、自車両が前記分岐点に到達する以前において前記道路の右側車線または左側車線の何れの車線を継続して走行しているかを認識したと判定した場合には、自車両が存在する走行路を、この時点までに判定した走行路から前記分岐点に接続された他の走行路へと変更することを許可する。
【０００７】
また、本発明の第４態様に係る車両の走行安全装置は、道路データを記憶する記憶手段（実施の形態での地図データ記憶部２３）と、自車両の位置を検出して位置信号を出力する自車位置検出手段（実施の形態での現在位置検出部２１）と、前記道路データおよび前記自車位置検出手段から出力される前記位置信号に基づいて前記道路データのうち自車両が存在する走行路を判定する走行路判定手段（実施の形態でのナビゲーション処理部２２）と、自車両の車両状態を検出して車両状態信号を出力するする車両状態検出手段（実施の形態での現在位置検出部２１）と、前記走行路判定手段により判定された自車両が存在する走行路および前記車両状態検出手段から出力される前記走行状態信号に基づいて、自車両に設けられた安全装置（実施の形態での安全装置１５）を作動させる作動手段（実施の形態での作動部６４）とを備える車両の走行安全装置であって、自車両の外界を撮像して画像信号を出力する撮像手段（実施の形態での撮影装置１６）と、前記撮像手段から出力される前記画像信号に基づいて道路の走行区分線を認識する走行区分線認識手段（実施の形態での道路形状認識部６５）とを備え、前記作動手段は、前記走行区分線認識手段により認識された前記走行区分線に基づいて、自車両が同一の前記道路を継続して走行しているか否かを判定し、自車両が同一の前記道路を継続して走行していると判定した場合に、前記走行路判定手段により自車両が存在する走行路の変更がおこなわれたときに、前記安全装置の作動を禁止する。
【発明の効果】
【０００８】
本発明の第１態様に係るナビゲーション装置によれば、撮像手段から出力される画像信号に基づいて、自車両が分岐点を通過する前後において同一の道路を継続して走行していると判定される場合には、道路データおよび自車両の位置に基づき自車両が存在する走行路が変更されることを禁止することから、自車両が実際に走行する道路とは異なる走行路の道路データに自車両の位置がマッチングされてしまうミスマッチングが生じることを防止することができる。
【０００９】
さらに、本発明の第２態様に係るナビゲーション装置によれば、自車両が分岐点を通過する前後において同一の左右の走行区分線の間に継続して存在する場合に、同一の道路を継続して走行していると判定することにより、判定精度および判定結果の信頼性を向上させることができる。
【００１０】
さらに、本発明の第３態様に係るナビゲーション装置によれば、分岐点の手前位置から継続して道路の右側車線または左側車線の何れの車線を走行していることを認識した場合には、自車両が実際に走行する道路とは異なる走行路の道路データに自車両の位置がマッチングされてしまうミスマッチングが生じる可能性が低いと判断して、道路データおよび自車両の位置に基づき自車両が存在する走行路が変更されることを許可することから、判定処理が過剰に複雑化することを防止することができる。
【００１１】
また、本発明の第４態様に係る車両の走行安全装置によれば、撮像手段から出力される画像信号に基づいて、自車両が同一の道路を継続して走行していると判定される状態で、自車両が存在する走行路の変更がおこなわれたときに、安全装置の作動を禁止することから、自車両が実際に走行する道路とは異なる走行路の道路データに応じて不必要に安全装置が作動することを防止することができる。
【発明を実施するための最良の形態】
【００１２】
以下、本発明の一実施形態に係るナビゲーション装置および車両の走行安全装置について添付図面を参照しながら説明する。
【００１３】
図１に示すように、本実施の形態による車両の走行安全装置１０は、例えば、内燃機関１１の駆動力を、オートマチックトランスミッション（ＡＴ）あるいは無段自動変速機（ＣＶＴ）などのトランスミッション（Ｔ／Ｍ）１２を介して車両の駆動輪に伝達する車両に搭載され、ナビゲーション装置１３と、制御装置１４と、ブレーキアクチュエータ１５ａおよび警報装置１５ｂを具備する安全装置１５と、外界センサをなす撮影装置１６とを備えて構成されている。
【００１４】
なお、撮影装置１６は、例えば可視光領域や赤外線領域にて撮像可能なカメラ１６ａおよび画像処理部１６ｂを備えて構成され、カメラ１６ａは、例えばフロントウィンドウの車室内側に配置され、フロントウィンドウ越しに自車両の進行方向前方の所定検知範囲の外界を撮影する。画像処理部１６ｂは、カメラ１６ａにより撮影して得た画像に対して、例えばフィルタリングや二値化処理等の所定の画像処理を行い、画像データを生成して制御装置１４へ出力する。
【００１５】
ナビゲーション装置１３は、例えば現在位置検出部２１と、ナビゲーション処理部２２と、地図データ記憶部２３と、入力部２４と、出力部２５とを備えて構成されている。
【００１６】
さらに、現在位置検出部２１は、例えば人工衛星を利用して車両の位置を測定するためのＧＰＳ（Global Positioning System）信号などの測位信号を受信する測位信号受信部３１と、水平面内での自車両の向きや鉛直方向に対する傾斜角度（例えば、車両の前後方向軸の鉛直方向に対する傾斜角度や車両重心の上下方向軸回りの回転角であるヨー角など）および傾斜角度の変化量（例えば、ヨーレートなど）を検出するジャイロセンサ３２と、車両の速度（車速）を検出する車速センサ３３とを備えて構成され、受信した測位信号によって、あるいは、車速やヨーレートなどの検出信号に基づく自律航法の算出処理によって、車両の現在位置を算出する。
【００１７】
地図データ記憶部２３は、例えばナビゲーション処理などにおいて出力部２５の表示装置（図示略）に地図を表示するための地図表示用のデータおよび自車両の現在位置に基づくマップマッチングの処理に必要とされる道路座標データに加えて、経路探索や経路誘導などの処理に必要とされるデータ、例えば交差点および分岐点などの所定位置の緯度および経度からなる点であるノードと各ノード間を結ぶ線であるリンクとからなる道路データを地図データとして備えており、さらに、ノードおよびリンクには各種の情報が付加されている。
例えば、各ノードに対しては、緯度および経度および標高に加えて、信号機の有無や複数の道路の交差角度や形状などの交差点情報や、分岐点での分岐路の形状あるいはジャンクションでの道路の形状などの情報が付加され、各リンクには、道路種別（例えば、高速道路、一般道など）などの情報が付加されている。
【００１８】
ナビゲーション処理部２２は、例えば、地図データ記憶部２３から取得される道路データに対して、現在位置検出部２１における測位信号および自律航法の算出処理のそれぞれ、又は、何れか一方から得られる自車両の現在位置の情報に基づいてマップマッチングを行い、位置検出の結果を補正すると共に、道路データに具備される複数の走行路のうち、自車両が存在する走行路を判定する。そして、検出された車両の現在位置、あるいは、各種スイッチやキーボード等からなる入力部２４を介して操作者により入力された適宜の車両の位置に対して、出力部２５の表示装置での地図表示およびスピーカ（図示略）からの音声出力などを制御する。
また、ナビゲーション処理部２２は、例えば車両の経路探索や経路誘導などの処理を実行し、地図データ記憶部２３から取得される道路データと共に、例えば目的地までの経路情報や各種の付加情報を出力部２５へ出力する。
【００１９】
制御装置１４は、速度制御部４１と、エンジン制御部４２と、変速制御部４３と、ブレーキ制御部４４と、警報制御部４５とを備えて構成され、運転者によるアクセルペダルの操作量に係るアクセル開度を検出するアクセルペダル開度センサ５１と、運転者によるブレーキペダルの操作量を検出するブレーキペダルセンサ５２と、スロットル開度を検出するスロットル開度センサ５３とから出力される各検出信号が入力されている。
【００２０】
速度制御部４１は、カーブ認識部６１と、適正車速設定部６２と、比較部６３と、作動部６４と、道路形状認識部６５とを備えて構成されている。
【００２１】
カーブ認識部６１は、地図データ記憶部２３に記憶された道路データを取得し、この道路データに基づいて自車両の進行方向の道路形状として道路に存在するカーブを検出する。
例えばカーブ認識部６１は、道路データの基礎となるノードつまり道路形状を把握するための点と、リンクつまり各ノードを結ぶ線とに基づいて、カーブの形状を認識する。そして、例えばカーブの径や曲率および極性、カーブの長さ（カーブの深さ）、カーブの通過に要する旋回角などからなるカーブ形状値を算出し、適正車速設定部６２へ出力する。
【００２２】
適正車速設定部６２は、カーブ認識部６１にて認識されたカーブ形状値に基づいて、カーブを適正に通過可能な車両の速度（適正速度ＶＳ）を算出する。そして、適正車速設定部６２は設定した適正速度ＶＳのデータを比較部６３へ出力する。
ここで、適正車速設定部６２は、カーブ通過時に車両の横方向に発生する加速度（横加速度）を算出する横加速度算出部６２ａを備えている。すなわち、先ず、横加速度算出部６２ａは、カーブ認識部６１にて認識されたカーブの形状に基づいて、このカーブを適正に通過する際に許容される横加速度を算出する。次に、適正車速設定部６２は、この横加速度を車両に発生させる車両の速度を算出し、この速度を適正速度ＶＳとして設定する。
なお、カーブ通過時に自車両に許容される横加速度は、路面状況、タイヤの状況、積載の状態などにより変化するため、これらを更に考慮して適正速度ＶＳを設定するようにしてもよい。
また、認識されたカーブの形状の手前に上り勾配あるいは下り勾配などが存在する場合には、これらの勾配の大きさに応じて適正速度ＶＳが設定される。
【００２３】
比較部６３は、現在位置検出部２１の車速センサ３３にて検出した車両の速度（現在速度）ＶＰと、適正車速設定部６２にて設定した適正速度ＶＳとを比較して、この比較結果を作動部６４へ出力する。
作動部６４は、比較部６３での比較結果に基づいてエンジン制御部４２および変速制御部４３およびブレーキ制御部４４および警報制御部４５の作動を制御する。例えば、比較部６３での比較結果において、車速センサ３３にて検出した現在速度ＶＰと適正車速設定部６２にて設定した適正速度ＶＳとが異なる場合、例えば検出された車両の現在速度ＶＰが適正速度ＶＳよりも高い状態等のように車両が適正車両状態にない場合には、警報制御部４５を介して警報装置１５ｂを作動させて運転者の注意を喚起したり、ブレーキ制御部４４を介してブレーキアクチュエータ１５ａを作動させて自動的に車両を減速させる。
【００２４】
道路形状認識部６５は、例えば撮影装置１６から入力される画像データに基づき、画像データ上において自車両の走行車線に対する走行区分線（つまり、自車両が走行する道路の走行区分線）を検知することで自車両の進行方向の道路形状を認識する。
この道路形状認識部６５により認識された自車両が走行する道路の走行区分線のデータは、制御装置１４の作動部６４およびナビゲーション装置１３のナビゲーション処理部２２へ出力されている。
【００２５】
ナビゲーション処理部２２は、地図データ記憶部２３に記憶された道路データに基づいて、マップマッチングの処理において判定された自車両が存在する走行路上に設けられた分岐点および分岐路を取得し、道路形状認識部６５により認識された走行区分線に基づいて、自車両が分岐点を通過する前後において、同一の道路を継続して走行しているか否かを判定する。この判定処理では、例えば、自車両が分岐点を通過する前後において、道路形状認識部６５により認識された同一の１対の左右の走行区分線の間に自車両が継続して存在する場合（つまり、走行区分線を跨がずに走行する場合）に、自車両が同一の道路を継続して走行していると判定する。
【００２６】
そして、ナビゲーション処理部２２は、自車両が分岐点を通過する前後において、同一の道路を継続して走行していると判定した場合に、マップマッチングの処理において判定される自車両が存在する走行路を、この時点までに判定した走行路から分岐点に接続された他の走行路へと変更することを禁止する。
【００２７】
例えば図２に示すように、本線Ｒａを走行する自車両Ｐの進行方向前方に分岐点Ｄにおいて本線Ｒａから分岐する分岐路Ｒｂが存在する場合に、先ず、この分岐点Ｄの手前位置では、ナビゲーション処理部２２によって設定される誘導経路Ａ（つまり、適宜の目的地に対する経路探索や経路誘導などの処理で用いられる経路）と予測経路Ｂ（つまり、自車両の走行制御の処理やマップマッチングの処理などで用いられる経路）とは一致しており、かつ、マップマッチングの処理で判定される自車両が存在する走行路と予測経路Ｂとは一致している。
【００２８】
そして、分岐点Ｄ付近以降において、例えば、誘導経路Ａが分岐路Ｒｂに設定され、かつ、予測経路Ｂが本線Ｒａに設定されることで、誘導経路Ａと予測経路Ｂとが一致しないと判定されると、誘導経路Ａと一致するようにして予測経路Ｂが変更されることになり、これに伴い、マップマッチングの処理で判定される自車両が存在する走行路の変更を指示する指令が出力される。
しかしながら、実際には、自車両Ｐが本線Ｒａを継続して走行することに伴い、道路形状認識部６５により認識された走行区分線に基づいて、自車両が分岐点Ｄを通過する前後において同一の１対の左右の走行区分線の間に継続して存在すると判定され、自車両が同一の道路（つまり、本線Ｒａ）を継続して走行していると判定されることから、マップマッチングの処理において判定される自車両が存在する走行路を、この時点までに判定した走行路（つまり、本線Ｒａ）から分岐点Ｄに接続された他の走行路（つまり、分岐路Ｒｂ）へと変更することは禁止される。
【００２９】
また、作動部６４は、道路形状認識部６５により認識された走行区分線に基づいて、自車両が分岐点を通過する前後において、同一の道路を継続して走行しているか否かを判定する。この判定処理では、例えば、自車両が分岐点を通過する前後において、道路形状認識部６５により認識された同一の１対の左右の走行区分線の間に自車両が継続して存在する場合に、自車両が同一の道路を継続して走行していると判定する。
【００３０】
そして、作動部６４は、自車両が分岐点を通過する前後において、同一の道路を継続して走行していると判定した場合に、ナビゲーション処理部２２によってマップマッチングの処理において判定される自車両が存在する走行路が変更されたときに、安全装置１５の作動を禁止する。
【００３１】
本実施の形態による車両の走行安全装置１０は上記構成を備えており、次に、この車両の走行安全装置１０の動作について添付図面を参照しながら説明する。
【００３２】
先ず、以下に、作動部６４およびブレーキ制御部４４による作動判断処理について説明する。
例えば図３に示すステップＳ０１においては、地図データ記憶部２３に格納された自車両の進行方向前方の道路データを取得する。
次に、ステップＳ０２おいては、自車両の現在位置および車速を取得する。
そして、ステップＳ０３においては、道路データに基づき、進行方向前方にカーブを認識したか否かを判定する。
この判定結果が「ＮＯ」の場合には、一連の処理を終了する。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ０４に進む。
【００３３】
そして、ステップＳ０４においては、認識したカーブ（認識カーブ）までの距離が所定距離以下であるか否かを判定する。
この判定結果が「ＮＯ」の場合には、一連の処理を終了する。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ０５に進む。
そして、ステップＳ０５においては、認識カーブにおける適正通過車速を算出する。
そして、ステップＳ０６においては、自車両の車速が適正通過車速よりも大きいか否かを判定する。
この判定結果が「ＮＯ」の場合には、一連の処理を終了する。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ０７に進む。
【００３４】
そして、ステップＳ０７においては、自車両の車速から適正通過車速を減算して速度差ΔＶを算出する。
そして、ステップＳ０８においては、速度差ΔＶに応じてブレーキアシスト量を算出する。
そして、ステップＳ０９においては、運転者によるブレーキ操作があるか否かを判定する。
この判定結果が「ＮＯ」の場合には、一連の処理を終了する。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ１０に進む。
そして、ステップＳ１０においては、算出したブレーキアシスト量に応じたブレーキアシストを実行し、一連の処理を終了する。
【００３５】
以下に、ナビゲーション処理部２２の動作、自車両が存在する走行路を判定する処理について説明する。
例えば図４に示すステップＳ２１においては、地図データ記憶部２３から取得される道路データと現在位置検出部２１により検出される自車両の現在位置とに基づき、ナビゲーション処理部２２のマップマッチングの処理において自車両が存在する走行路が認識されているか否かを判定する。
この判定結果が「ＮＯ」の場合には、リターンに進む。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ２２に進む。
【００３６】
そして、ステップＳ２２においては、ナビゲーション処理部２２のマップマッチングの処理において自車両が存在する走行路として同一の走行路が継続してマッチングされているか否かを判定する。
この判定結果が「ＮＯ」の場合には、リターンに進む。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ２３に進む。
【００３７】
そして、ステップＳ２３においては、ナビゲーション処理部２２によって誘導経路、つまり適宜の目的地に対する経路探索や経路誘導などの処理で用いられる経路が設定されているか否かを判定する。
この判定結果が「ＹＥＳ」の場合には、ステップＳ２４に進み、このステップＳ２４においては、予測経路（つまり、自車両の走行制御の処理やマップマッチングの処理などで用いられる経路）として誘導経路が設定される。
一方、この判定結果が「ＮＯ」の場合には、ステップＳ２５に進み、このステップＳ２５においては、例えば車速やヨーレートなどの検出信号に基づき、予測経路を作成する。
【００３８】
そして、ステップＳ２６においては、例えば自車両が分岐点を通過する場合などにおいて、ナビゲーション処理部２２のマップマッチングの処理で判定される自車両が存在する走行路の変更を指示する指令が出力されているか否かを判定する。
この判定結果が「ＮＯ」の場合には、リターンに進む。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ２７に進む。
そして、ステップＳ２７においては、道路形状認識部６５により認識された走行区分線に基づいて、自車両が同一の道路を継続して走行しているか否かを判定する。
この判定結果が「ＹＥＳ」の場合には、後述するステップＳ３０に進む。
一方、この判定結果が「ＮＯ」の場合には、ステップＳ２８に進む。
【００３９】
そして、ステップＳ２８においては、自車両が走行中の道路が継続して認識されずに認識に断絶が生じたと判断する。
そして、ステップＳ２９においては、マップマッチングの処理において判定される自車両が存在する走行路を、この時点までに判定した走行路から分岐点に接続された他の走行路へと変更することを許可し、リターンに進む。
【００４０】
また、ステップＳ３０においては、マップマッチングの処理において判定される自車両が存在する走行路を、この時点までに判定した走行路から分岐点に接続された他の走行路へと変更することを禁止する。
そして、ステップＳ３１においては、マップマッチングの処理において判定される自車両が存在する走行路と、予測経路とが一致するか否かを判定する。
この判定結果が「ＹＥＳ」の場合には、この時点で設定されている予測経路を維持し、リターンに進む。
一方、この判定結果が「ＮＯ」の場合には、ステップＳ３３に進み、新たな予測経路（新規予測経路）を生成し、リターンに進む。
【００４１】
以下に、作動部６４の動作、安全装置１５の作動を制御する処理について説明する。
例えば図５に示すステップＳ４１においては、地図データ記憶部２３から取得される道路データと現在位置検出部２１により検出される自車両の現在位置とに基づき、ナビゲーション処理部２２のマップマッチングの処理において自車両が存在する走行路が認識されているか否かを判定する。
この判定結果が「ＮＯ」の場合には、ステップＳ４２に進む。
一方、この判定結果が「ＹＥＳ」の場合には、後述するステップＳ４４に進む。
【００４２】
そして、ステップＳ４２においては、ナビゲーション処理部２２のマップマッチングの処理において自車両が存在する走行路として設定される走行路対象が実際に存在しないか否かを判定する。
この判定結果が「ＹＥＳ」の場合には、リターンに進む。
一方、この判定結果が「ＮＯ」の場合には、自車両が実際に走行中の道路の道路データが地図データ記憶部２３に存在しないと判断し、後述するステップＳ４７に進む。
【００４３】
また、ステップＳ４４においては、道路形状認識部６５により認識された走行区分線に基づいて、自車両が同一の道路を継続して走行しているか否かを判定する。
この判定結果が「ＮＯ」の場合には、ステップＳ４５に進み、このステップＳ４５においては、自車両が走行中の道路が継続して認識されずに認識に断絶が生じたと判断し、リターンに進む。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ４６に進む。
【００４４】
そして、ステップＳ４６においては、ナビゲーション処理部２２のマップマッチングの処理において自車両が存在する走行路として同一の走行路が継続してマッチングされているか否かを判定する。
この判定結果が「ＮＯ」の場合には、リターンに進む。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ４７に進む。
【００４５】
そして、ステップＳ４７においては、例えば自車両が分岐点を通過する場合などにおいて、ナビゲーション処理部２２のマップマッチングの処理で判定される自車両が存在する走行路の変更を指示する指令が出力されているか否かを判定する。
この判定結果が「ＮＯ」の場合には、リターンに進む。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ４８に進む。
そして、ステップＳ４８においては、マップマッチングの処理で判定される自車両が存在する走行路により予測経路を生成する。
【００４６】
そして、ステップＳ４９においては、安全装置１５の作動要求があるか否かを判定する。
この判定結果が「ＮＯ」の場合には、リターンに進む。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ５０に進む。
そして、ステップＳ５０においては、道路形状認識部６５により認識された走行区分線に基づいて、自車両が同一の道路を継続して走行しているか否かを判定する。
この判定結果が「ＹＥＳ」の場合には、ステップＳ５１に進み、このステップＳ５１においては、安全装置１５の作動を禁止し、リターンに進む。
一方、この判定結果が「ＮＯ」の場合には、リターンに進む。
【００４７】
上述したように、本実施の形態によるナビゲーション装置１３によれば、撮影装置１６から出力される画像データに基づいて、自車両が分岐点を通過する前後において同一の道路を継続して走行していると判定される場合には、道路データおよび自車両の現在位置に基づき自車両が存在する走行路が変更されることを禁止することから、自車両が実際に走行する道路とは異なる走行路の道路データに自車両の位置がマッチングされてしまうミスマッチングが生じることを防止することができる。
また、自車両が分岐点を通過する前後において同一の左右の走行区分線の間に継続して存在する場合（つまり、走行区分線を跨がずに走行する場合）に、同一の道路を継続して走行していると判定することにより、判定精度および判定結果の信頼性を向上させることができる。
【００４８】
また、本実施の形態による車両の走行安全装置１０によれば、撮影装置１６から出力される画像データに基づいて、自車両が同一の道路を継続して走行していると判定される状態で、自車両が存在する走行路の変更がおこなわれたときに、安全装置１５の作動を禁止することから、自車両が実際に走行する道路とは異なる走行路の道路データに応じて不必要に安全装置１５が作動することを防止することができる。
【００４９】
なお、上述した実施の形態においては、例えば図２に示すように、自車両が本線を走行して分岐点を通過する前後において、同一の道路を継続して走行していると判定した場合に、マップマッチングの処理において判定される自車両が存在する走行路を、この時点までに判定した走行路（つまり本線）から分岐点に接続された他の走行路（つまり、本線に取り付けられた分岐路）へと変更することを禁止するとしたが、これに限定されず、例えば図６に示すように、自車両の進行方向前方に分岐点としてジャンクションが存在する場合には、このジャンクションの手前位置から継続して道路の右側車線または左側車線の何れの車線を走行しているか否かを判定し、この判定結果に応じて自車両が存在する走行路の変更を許可してもよい。
【００５０】
例えば図６に示すように、自車両ＰがジャンクションＪの手前位置から継続して道路の左側車線を走行していると判定した場合には、ナビゲーション処理部２２によって設定される誘導経路Ａと予測経路Ｂとは一致する可能性が高く、自車両が実際に走行する道路とは異なる走行路の道路データに自車両の位置がマッチングされてしまうミスマッチングが生じる可能性が低いと判断して、道路データおよび自車両の位置に基づき自車両が存在する走行路が変更されることを許可する。これにより、判定処理が過剰に複雑化することを防止することができる。
【図面の簡単な説明】
【００５１】
【図１】本発明の一実施形態に係る車両の走行安全装置の構成を示す機能ブロック図である。
【図２】本発明の一実施形態に係る分岐点を有する道路での誘導経路および予測経路の一例を示す図である。
【図３】本発明の一実施形態に係る車両の走行安全装置の作動部およびブレーキ制御部による作動判断処理の一例を示すフローチャートである。
【図４】本発明の一実施形態に係る車両の走行安全装置のナビゲーション処理部の動作の一例を示すフローチャートである。
【図５】本発明の一実施形態に係る車両の走行安全装置の作動部の動作の一例を示すフローチャートである。
【図６】本発明の一実施形態に係るジャンクションを有する道路での誘導経路および予測経路の一例を示す図である。
【符号の説明】
【００５２】
１０ 車両の走行安全装置
１５ 安全装置
１６ 撮影装置（撮像手段）
２１ 現在位置検出部（自車位置検出手段）
２２ ナビゲーション処理部（走行路判定手段、分岐点取得手段）
２３ 地図データ記憶部（記憶手段）
６４ 作動部（作動手段）
６５ 道路形状認識部（走行区分線認識手段）
【特許請求の範囲】
【請求項１】
道路データを記憶する記憶手段と、
自車両の位置を検出して位置信号を出力する自車位置検出手段と、
前記道路データおよび前記自車位置検出手段から出力される前記位置信号に基づいて前記道路データのうち自車両が存在する走行路を判定する走行路判定手段とを備えるナビゲーション装置であって、
自車両の外界を撮像して画像信号を出力する撮像手段と、
前記撮像手段から出力される前記画像信号に基づいて道路の走行区分線を認識する走行区分線認識手段と、
前記道路データに基づいて道路の分岐点を取得する分岐点取得手段とを備え、
前記走行路判定手段は、
前記走行区分線認識手段により認識された前記走行区分線に基づいて、自車両が前記分岐点取得手段により取得された前記分岐点を通過する前後において同一の前記道路を継続して走行しているか否かを判定し、
自車両が前記分岐点を通過する前後において同一の前記道路を継続して走行していると判定した場合に、自車両が存在する走行路を、この時点までに判定した走行路から前記分岐点に接続された他の走行路へと変更することを禁止することを特徴とするナビゲーション装置。
【請求項２】
前記走行路判定手段は、
自車両が前記分岐点を通過する前後において前記走行区分線認識手段により認識された同一の左右の前記走行区分線の間に継続して存在する場合に、同一の前記道路を継続して走行していると判定することを特徴とする請求項１に記載のナビゲーション装置。
【請求項３】
前記走行路判定手段は、
自車両が前記分岐点に到達する以前において前記道路の右側車線または左側車線の何れの車線を継続して走行しているかを認識したか否かを判定し、
自車両が前記分岐点に到達する以前において前記道路の右側車線または左側車線の何れの車線を継続して走行しているかを認識したと判定した場合には、自車両が存在する走行路を、この時点までに判定した走行路から前記分岐点に接続された他の走行路へと変更することを許可することを特徴とする請求項１または請求項２に記載のナビゲーション装置。
【請求項４】
道路データを記憶する記憶手段と、
自車両の位置を検出して位置信号を出力する自車位置検出手段と、
前記道路データおよび前記自車位置検出手段から出力される前記位置信号に基づいて前記道路データのうち自車両が存在する走行路を判定する走行路判定手段と、
自車両の車両状態を検出して車両状態信号を出力するする車両状態検出手段と、
前記走行路判定手段により判定された自車両が存在する走行路および前記車両状態検出手段から出力される前記走行状態信号に基づいて、自車両に設けられた安全装置を作動させる作動手段とを備える車両の走行安全装置であって、
自車両の外界を撮像して画像信号を出力する撮像手段と、
前記撮像手段から出力される前記画像信号に基づいて道路の走行区分線を認識する走行区分線認識手段とを備え、
前記作動手段は、前記走行区分線認識手段により認識された前記走行区分線に基づいて、自車両が同一の前記道路を継続して走行しているか否かを判定し、
自車両が同一の前記道路を継続して走行していると判定した場合に、前記走行路判定手段により自車両が存在する走行路の変更がおこなわれたときに、前記安全装置の作動を禁止することを特徴とする車両の走行安全装置。
【請求項１】
道路データを記憶する記憶手段と、
自車両の位置を検出して位置信号を出力する自車位置検出手段と、
前記道路データおよび前記自車位置検出手段から出力される前記位置信号に基づいて前記道路データのうち自車両が存在する走行路を判定する走行路判定手段とを備えるナビゲーション装置であって、
自車両の外界を撮像して画像信号を出力する撮像手段と、
前記撮像手段から出力される前記画像信号に基づいて道路の走行区分線を認識する走行区分線認識手段と、
前記道路データに基づいて道路の分岐点を取得する分岐点取得手段とを備え、
前記走行路判定手段は、
前記走行区分線認識手段により認識された前記走行区分線に基づいて、自車両が前記分岐点取得手段により取得された前記分岐点を通過する前後において同一の前記道路を継続して走行しているか否かを判定し、
自車両が前記分岐点を通過する前後において同一の前記道路を継続して走行していると判定した場合に、自車両が存在する走行路を、この時点までに判定した走行路から前記分岐点に接続された他の走行路へと変更することを禁止することを特徴とするナビゲーション装置。
【請求項２】
前記走行路判定手段は、
自車両が前記分岐点を通過する前後において前記走行区分線認識手段により認識された同一の左右の前記走行区分線の間に継続して存在する場合に、同一の前記道路を継続して走行していると判定することを特徴とする請求項１に記載のナビゲーション装置。
【請求項３】
前記走行路判定手段は、
自車両が前記分岐点に到達する以前において前記道路の右側車線または左側車線の何れの車線を継続して走行しているかを認識したか否かを判定し、
自車両が前記分岐点に到達する以前において前記道路の右側車線または左側車線の何れの車線を継続して走行しているかを認識したと判定した場合には、自車両が存在する走行路を、この時点までに判定した走行路から前記分岐点に接続された他の走行路へと変更することを許可することを特徴とする請求項１または請求項２に記載のナビゲーション装置。
【請求項４】
道路データを記憶する記憶手段と、
自車両の位置を検出して位置信号を出力する自車位置検出手段と、
前記道路データおよび前記自車位置検出手段から出力される前記位置信号に基づいて前記道路データのうち自車両が存在する走行路を判定する走行路判定手段と、
自車両の車両状態を検出して車両状態信号を出力するする車両状態検出手段と、
前記走行路判定手段により判定された自車両が存在する走行路および前記車両状態検出手段から出力される前記走行状態信号に基づいて、自車両に設けられた安全装置を作動させる作動手段とを備える車両の走行安全装置であって、
自車両の外界を撮像して画像信号を出力する撮像手段と、
前記撮像手段から出力される前記画像信号に基づいて道路の走行区分線を認識する走行区分線認識手段とを備え、
前記作動手段は、前記走行区分線認識手段により認識された前記走行区分線に基づいて、自車両が同一の前記道路を継続して走行しているか否かを判定し、
自車両が同一の前記道路を継続して走行していると判定した場合に、前記走行路判定手段により自車両が存在する走行路の変更がおこなわれたときに、前記安全装置の作動を禁止することを特徴とする車両の走行安全装置。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図２】
【図３】
【図４】
【図５】
【図６】
【公開番号】特開２０１０−１９６２８（Ｐ２０１０−１９６２８Ａ）
【公開日】平成２２年１月２８日（２０１０．１．２８）
【国際特許分類】
【出願番号】特願２００８−１７９１７７（Ｐ２００８−１７９１７７）
【出願日】平成２０年７月９日（２００８．７．９）
【出願人】（０００００５３２６）本田技研工業株式会社 (23,863)
【Ｆターム（参考）】
【公開日】平成２２年１月２８日（２０１０．１．２８）
【国際特許分類】
【出願日】平成２０年７月９日（２００８．７．９）
【出願人】（０００００５３２６）本田技研工業株式会社 (23,863)
【Ｆターム（参考）】
[ Back to top ]