移動体位置検出システム、移動体位置検出装置、移動体位置検出方法及びコンピュータプログラム
【課題】移動体の位置を正確に検出することを可能にした移動体位置検出システム、移動体位置検出装置、移動体位置検出方法及びコンピュータプログラムを提供する。
【解決手段】車両が分岐点を直進して通過する場合に、バックカメラ19で撮像した画像に基づいて車両が走行する道路上に存在する地物を検出し(S13)、検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致する場合に、分岐点の周辺に設けられた地物又は分岐点のノードとの相対位置によって移動体の位置を特定する(S18、S19)ように構成する。
【解決手段】車両が分岐点を直進して通過する場合に、バックカメラ19で撮像した画像に基づいて車両が走行する道路上に存在する地物を検出し(S13)、検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致する場合に、分岐点の周辺に設けられた地物又は分岐点のノードとの相対位置によって移動体の位置を特定する(S18、S19)ように構成する。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、移動体の位置を検出する移動体位置検出システム、移動体位置検出装置、移動体位置検出方法及びコンピュータプログラムに関する。
【背景技術】
【0002】
近年、車両の走行案内を行い、運転者が所望の目的地に容易に到着できるようにしたナビゲーション装置が車両に搭載されていることが多い。ここで、ナビゲーション装置とは、GPS受信機などにより自車の現在位置を検出し、その現在位置に対応する地図データをDVD−ROMやHDDなどの記録媒体またはネットワークを通じて取得して液晶モニタに表示することが可能な装置である。更に、かかるナビゲーション装置には、所望する目的地を入力すると、出発地から目的地までの最適経路を探索する経路探索機能を備えている。そして、探索結果に基づいて設定された案内経路をディスプレイ画面に表示するとともに、右左折等の案内の対象となる分岐点(以下、案内分岐点という)に接近した場合には音声やディスプレイ画面を用いた案内を行うことによって、ユーザを所望の目的地まで確実に案内するようになっている。また、近年は携帯電話機、PDA(Personal Digital Assistant)、パーソナルコンピュータ等においても上記ナビゲーション装置と同様の機能を有するものがある。更に、車両以外にも歩行者や二輪車を対象として上記案内を行うことも可能である。
【0003】
ここで、案内分岐点において右左折等の案内を行う場合には、案内を適切なタイミングで行うことが重要である。そして、案内を適切なタイミングで行う為には、車両等の現在位置を正確に検出することが必要となる。ここで、車両等の位置を正確に検出する方法の一つとして、例えば特開2007−309670号公報には、車両後方のカメラから取り込んだ白線や路面ペイントを画像認識により検出し、更に、白線や路面ペイントを予め記憶した地図情報DBと照合することにより、車両の詳細な現在位置を検出する技術について記載されている。
【先行技術文献】
【特許文献】
【0004】
【特許文献1】特開2007−309670号公報(第5頁)
【発明の概要】
【発明が解決しようとする課題】
【0005】
ここで、上記特許文献1の技術のように、車両が認識した白線等の地物からの相対位置に基づいて車両の現在位置を特定する技術では、検出対象とする地物の種類と地物の位置情報とを対応付けたDBが必要となる。分岐点周辺の道路に存在する地物としては、例えば停止線、横断歩道、自転車横断帯等があるが、これらの全ての地物に関するDBを作成することとすると、DBの作成に膨大な作業が必要となっていた。一方で、特定の地物、例えば停止線のみを検出対象とすればDBの作成量を削減することができるが、停止線を認識できない場合に位置補正を行うことができない問題があった。
【0006】
本発明は前記従来における問題点を解消するためになされたものであり、地物に関するDBの必要量を削減できるとともに、移動体が分岐点を通過する場合において、分岐点の形状に関わらず移動体の位置を正確に検出することを可能にした移動体位置検出システム、移動体位置検出装置、移動体位置検出方法及びコンピュータプログラムを提供することを目的とする。
【課題を解決するための手段】
【0007】
前記目的を達成するため本願の請求項1に係る移動体位置検出システム(1)は、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得手段(13)と、分岐点を前記移動体が通過することを検出する分岐点通過検出手段(13)と、前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致するか否か判定する一致判定手段(13)と、前記一致判定手段により前記検出配置パターンが前記進入側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物又は前記分岐点のノードとの相対位置によって前記移動体の位置を特定する位置特定手段(13)と、を有することを特徴とする。
尚、「移動体」としては、車両以外に、歩行者や二輪車も含む。
また、「地物の配置パターン」とは、地物の配置順序や配置間隔等が該当する。
【0008】
また、請求項2に係る移動体位置検出システム(1)は、請求項1に記載の移動体位置検出システムであって、前記位置特定手段(13)は、前記検出配置パターンが停止線(72)を含む地物の配置パターンである場合に、該停止線との相対位置によって前記移動体(75)の位置を特定することを特徴とする。
【0009】
また、請求項3に係る移動体位置検出システム(1)は、請求項1又は請求項2に記載の移動体位置検出システムであって、前記位置特定手段(13)は、前記検出配置パターンが停止線を含まない地物の配置パターンである場合に、前記分岐点のノードとの相対位置によって前記移動体(75)の位置を特定することを特徴とする。
【0010】
また、請求項4に係る移動体位置検出システム(1)は、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得手段(13)と、分岐点を前記移動体が通過することを検出する分岐点通過検出手段(13)と、前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致するか否か判定する退出側一致判定手段(13)と、前記退出側一致判定手段により前記検出配置パターンが前記退出側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する退出側位置特定手段(13)と、を有することを特徴とする。
【0011】
また、請求項5に係る移動体位置検出システム(1)は、請求項4に記載の移動体位置検出システムであって、前記検出配置パターンは横断歩道(93)を含む地物の配置パターンであって、前記退出側位置特定手段(13)は、前記移動体(75)の移動する道路上において検出された前記横断歩道に対応して前記移動体が移動する車線の対向車線の路面上に設けられた停止線(94)との相対位置によって前記移動体の位置を特定することを特徴とする。
【0012】
また、請求項6に係る移動体位置検出システム(1)は、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得手段(13)と、分岐点を前記移動体が通過することを検出する分岐点通過検出手段(13)と、前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致するか否か判定する両側一致判定手段(13)と、前記両側一致判定手段により前記検出配置パターンが前記両側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する両側位置特定手段と、を有することを特徴とする。
【0013】
また、請求項7に係る移動体位置検出システム(1)は、請求項6に記載の移動体位置検出システムであって、前記検出配置パターンは退出道路上の横断歩道(93)を含む地物の配置パターンであって、前記両側位置特定手段(13)は、前記移動体の移動する道路上において検出された前記退出道路上の横断歩道に対応して前記移動体が移動する車線の対向車線の路面上に設けられた停止線(94)との相対位置によって前記移動体の位置を特定することを特徴とする。
【0014】
また、請求項8に係る移動体位置検出システム(1)は、請求項1乃至請求項7のいずれかに記載の移動体位置検出システムであって、前記地物検出結果取得手段(13)は、前記移動体(75)に設置された撮像手段(19)より撮像した画像に基づいて前記移動体が移動する道路上に存在する地物を検出した検出結果を取得することを特徴とする。
【0015】
また、請求項9に係る移動体位置検出装置(1)は、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得手段(13)と、分岐点を前記移動体が通過することを検出する分岐点通過検出手段(13)と、前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致するか否か判定する一致判定手段(13)と、前記一致判定手段により前記検出配置パターンが前記進入側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物又は前記分岐点のノードとの相対位置によって前記移動体の位置を特定する位置特定手段(13)と、を有することを特徴とする。
【0016】
また、請求項10に係る移動案内方法は、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得ステップと、分岐点を前記移動体が通過することを検出する分岐点通過検出ステップと、前記分岐点通過ステップによって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得ステップにより取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致するか否か判定する一致判定ステップと、前記一致判定ステップにより前記検出配置パターンが前記進入側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物又は前記分岐点のノードとの相対位置によって前記移動体の位置を特定する位置特定ステップと、を有することを特徴とする。
【0017】
また、請求項11に係るコンピュータプログラムは、コンピュータに、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得機能と、分岐点を前記移動体が通過することを検出する分岐点通過検出機能と、前記分岐点通過機能によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得機能により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致するか否か判定する一致判定機能と、前記一致判定機能により前記検出配置パターンが前記進入側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物又は前記分岐点のノードとの相対位置によって前記移動体の位置を特定する位置特定機能と、を実行させることを特徴とする。
【0018】
また、請求項12に係る移動体位置検出装置(1)は、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得手段(13)と、分岐点を前記移動体が通過することを検出する分岐点通過検出手段(13)と、前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致するか否か判定する退出側一致判定手段(13)と、前記退出側一致判定手段により前記検出配置パターンが前記退出側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する退出側位置特定手段(13)と、を有することを特徴とする。
【0019】
また、請求項13に係る移動体位置検出方法(1)は、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得ステップと、分岐点を前記移動体が通過することを検出する分岐点通過検出ステップと、前記分岐点通過ステップによって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得ステップにより取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致するか否か判定する退出側一致判定ステップと、前記退出側一致判定ステップにより前記検出配置パターンが前記退出側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する退出側位置特定ステップと、を有することを特徴とする。
【0020】
また、請求項14に係るコンピュータプログラムは、コンピュータに、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得機能と、分岐点を前記移動体が通過することを検出する分岐点通過検出機能と、前記分岐点通過機能によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得機能により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致するか否か判定する退出側一致判定機能と、前記退出側一致判定機能により前記検出配置パターンが前記退出側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する退出側位置特定機能と、を実行させることを特徴とする。
【0021】
また、請求項15に係る移動体位置検出装置(1)は、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得手段(13)と、分岐点を前記移動体が通過することを検出する分岐点通過検出手段(13)と、前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致するか否か判定する両側一致判定手段(13)と、前記両側一致判定手段により前記検出配置パターンが前記両側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する両側位置特定手段と、を有することを特徴とする。
【0022】
また、請求項16に係る移動体位置検出方法は、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得ステップと、分岐点を前記移動体が通過することを検出する分岐点通過検出ステップと、前記分岐点通過ステップによって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得ステップにより取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致するか否か判定する両側一致判定ステップと、前記両側一致判定ステップにより前記検出配置パターンが前記両側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する両側位置特定ステップと、を有することを特徴とする。
【0023】
更に、請求項17に係るコンピュータプログラムは、コンピュータに、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得機能と、分岐点を前記移動体が通過することを検出する分岐点通過検出機能と、前記分岐点通過機能によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得機能により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致するか否か判定する両側一致判定機能と、前記両側一致判定機能により前記検出配置パターンが前記両側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する両側位置特定機能と、を実行させることを特徴とする。
【発明の効果】
【0024】
前記構成を有する請求項1に記載の移動体位置検出システムによれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致する場合に、分岐点の周辺に設けられた地物又は分岐点のノードとの相対位置によって移動体の位置を特定するので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出することが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0025】
また、請求項2に記載の移動体位置検出システムによれば、検出配置パターンが停止線を含む地物の配置パターンである場合に、該停止線との相対位置によって移動体の位置を特定するので、停止線に関する情報が少なくともDB化されていれば、移動体が検出した停止線に基づいて移動体の位置を正確に検出することが可能となる。
【0026】
また、請求項3に記載の移動体位置検出システムによれば、検出配置パターンが停止線を含まない地物の配置パターンである場合に、分岐点のノードとの相対位置によって移動体の位置を特定するので、停止線以外の地物に関する情報がDB化されていない場合であっても、移動体が通過した分岐点のノードに基づいて移動体の位置を正確に検出することが可能となる。
【0027】
また、請求項4に記載の移動体位置検出システムによれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって移動体の位置を特定するので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出することが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0028】
また、請求項5に記載の移動体位置検出システムによれば、検出配置パターンが退出道路上の横断歩道を含む地物の配置パターンである場合に、該横断歩道に対応して移動体が移動する車線の対向車線の路面上に設けられた停止線との相対位置によって移動体の位置を特定するので、停止線に関する情報が少なくともDB化されていれば、対向車線の停止線に基づいて移動体の位置を正確に検出することが可能となる。
【0029】
また、請求項6に記載の移動体位置検出システムによれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって移動体の位置を特定するので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出することが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0030】
また、請求項7に記載の移動体位置検出システムによれば、検出配置パターンが退出道路上の横断歩道を含む地物の配置パターンである場合に、該横断歩道に対応して移動体が移動する車線の対向車線の路面上に設けられた停止線との相対位置によって移動体の位置を特定するので、停止線に関する情報が少なくともDB化されていれば、対向車線の停止線に基づいて移動体の位置を正確に検出することが可能となる。
【0031】
また、請求項8に記載の移動体位置検出システムによれば、移動体に設置された撮像手段より撮像した画像に基づいて移動体が移動する道路上に存在する地物を検出するので、既存のシステムに用いられる撮像手段を流用して移動体の周囲にある地物を検出することが可能となる。その結果、地物を検出する為の新たな手段やシステムを設けることなく、当該システムを実現することが可能となる。
【0032】
また、請求項9に記載の移動体位置検出装置によれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致する場合に、分岐点の周辺に設けられた地物又は分岐点のノードとの相対位置によって移動体の位置を特定するので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出することが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0033】
また、請求項10に記載の移動体位置検出方法によれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致する場合に、分岐点の周辺に設けられた地物又は分岐点のノードとの相対位置によって移動体の位置を特定するので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出することが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0034】
また、請求項11に記載のコンピュータプログラムによれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致する場合に、分岐点の周辺に設けられた地物又は分岐点のノードとの相対位置によって移動体の位置を特定させるので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出させることが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0035】
また、請求項12に記載の移動体位置検出装置によれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって移動体の位置を特定するので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出することが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0036】
また、請求項13に記載の移動体位置検出方法によれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって移動体の位置を特定するので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出することが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0037】
また、請求項14に記載のコンピュータプログラムによれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって移動体の位置を特定させるので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出させることが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0038】
また、請求項15に記載の移動体位置検出装置によれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって移動体の位置を特定するので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出することが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0039】
また、請求項16に記載の移動体位置検出方法によれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって移動体の位置を特定するので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出することが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0040】
更に、請求項17に記載のコンピュータプログラムによれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって移動体の位置を特定させるので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出させることが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【図面の簡単な説明】
【0041】
【図1】本実施形態に係るナビゲーション装置を示したブロック図である。
【図2】分岐点に配置される地物の一例を示した図である。
【図3】本実施形態に係る分岐点案内処理プログラムのフローチャートである。
【図4】検出された車両の現在位置と案内分岐点の案内を開始する案内開始タイミングとの関係を示した図である。
【図5】本実施形態に係る車両位置検出処理プログラムのフローチャートである。
【図6】分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンの一例を示した図である。
【図7】分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンの一例を示した図である。
【図8】分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンの一例を示した図である。
【図9】分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンの一例を示した図である。
【図10】検出配置パターンが進入道路の停止線を含む地物の配置パターンである場合において、車両の現在位置の検出方法について説明した図である。
【図11】分岐点において設定されるノードの設定範囲を示した図である。
【図12】検出配置パターンが進入道路の停止線を含まない地物の配置パターンである場合において、車両の現在位置の検出方法について説明した図である。
【図13】検出配置パターンが進入道路の停止線を含まない地物の配置パターンである場合において、車両の現在位置の検出方法について説明した図である。
【図14】分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンの一例を示した図である。
【図15】検出配置パターンが退出道路の横断歩道を含む地物の配置パターンである場合において、車両の現在位置の検出方法について説明した図である。
【図16】検出配置パターンが退出道路の横断歩道を含む地物の配置パターンである場合において、車両の現在位置の検出方法について説明した図である。
【図17】分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンの一例を示した図である。
【発明を実施するための形態】
【0042】
以下、本発明に係る移動体位置検出システム及び移動体位置検出装置をナビゲーション装置に具体化した一実施形態に基づき図面を参照しつつ詳細に説明する。先ず、本実施形態に係るナビゲーション装置1の概略構成について図1を用いて説明する。図1は本実施形態に係るナビゲーション装置1を示したブロック図である。
【0043】
図1に示すように本実施形態に係るナビゲーション装置1は、ナビゲーション装置1が搭載された車両の現在位置を検出する現在位置検出部11と、各種のデータが記録されたデータ記録部12と、入力された情報に基づいて、各種の演算処理を行うナビゲーションECU13と、ユーザからの操作を受け付ける操作部14と、ユーザに対して車両周辺の地図や施設の関する施設情報を表示する液晶ディスプレイ15と、経路案内に関する音声ガイダンスを出力するスピーカ16と、記憶媒体であるDVDを読み取るDVDドライブ17と、プローブセンタやVICS(登録商標:Vehicle Information and Communication System)センタ等の情報センタとの間で通信を行う通信モジュール18と、から構成されている。また、ナビゲーション装置1には後述する路面標示等の地物を検出する為のバックカメラ19が接続されている。
【0044】
以下に、ナビゲーション装置1を構成する各構成要素について順に説明する。
現在位置検出部11は、GPS21、車速センサ22、ステアリングセンサ23、ジャイロセンサ24等からなり、現在の車両の位置、方位、車両の走行速度、現在時刻等を検出することが可能となっている。ここで、特に車速センサ22は、車両の移動距離や車速を検出する為のセンサであり、車両の駆動輪の回転に応じてパルスを発生させ、パルス信号をナビゲーションECU13に出力する。そして、ナビゲーションECU13は発生するパルスを計数することにより駆動輪の回転速度や移動距離を算出する。尚、上記5種類のセンサをナビゲーション装置1が全て備える必要はなく、これらの内の1又は複数種類のセンサのみをナビゲーション装置1が備える構成としても良い。
【0045】
また、データ記録部12は、外部記憶装置及び記録媒体としてのハードディスク(図示せず)と、ハードディスクに記録された地図情報DB31や所定のプログラム等を読み出すとともにハードディスクに所定のデータを書き込む為のドライバである記録ヘッド(図示せず)とを備えている。尚、データ記録部12をハードディスクの代わりにメモリーカードやCDやDVD等の光ディスクにより構成しても良い。
【0046】
ここで、地図情報DB31は、例えば、道路(リンク)に関するリンクデータ35、ノード点に関するノードデータ36、各分岐点に関する分岐点データ37、道路上に形成された地物の内、特に路面標示に関する地物データ38、施設に関する施設データ、地図を表示するための地図表示データ、経路を探索するための探索データ、地点を検索するための検索データ等が記憶された記憶手段である。
【0047】
ここで、リンクデータ35としては、例えば、該リンクを識別するリンクID、該リンクの端部に位置するノードを特定する端部ノード情報、該リンクを構成する道路の道路種別、道路幅、車線数等が記憶される。また、ノードデータ36としては、該ノードを識別するノードID、該ノードの位置座標、該ノードがリンクを介して接続される接続先ノードを特定する接続先ノード情報等が記憶される。また、分岐点データ37としては、該分岐点(交差点)を形成するノードを特定する該当ノード情報、該分岐点に接続されるリンク(以下、接続リンクという)を特定する接続リンク情報等が記憶される。
【0048】
一方、地物データ38は、道路上に形成された地物の内、特に停止線の路面標示に関する情報が記憶される。具体的には、識別IDと、停止線の位置を地図上で特定する座標データと、停止線が設置された分岐点を識別する分岐点IDとが記憶される。例えば、図2に示すように片側2車線の4本の道路51〜54が接続する分岐点55では、4箇所に停止線56〜59が設置されている。従って、地物データ38としては、停止線56〜59に関する各種情報が記憶される。
そして、ナビゲーションECU13は、車両が分岐点を通過する際に、バックカメラ19で撮像した撮像画像から路面に形成された停止線を含む地物の配置パターンを検出した場合に、検出した停止線に関連付けられた座標データに基づいて車両の詳細な現在位置を検出(又は既に検出された位置を補正)することが可能となる。そして、検出された現在位置に基づいて案内や車両制御を行う。
【0049】
一方、ナビゲーションECU(エレクトロニック・コントロール・ユニット)13は、ナビゲーション装置1の全体の制御を行う電子制御ユニットであり、演算装置及び制御装置としてのCPU41、並びにCPU41が各種の演算処理を行うにあたってワーキングメモリとして使用されるとともに、経路が探索されたときの経路データ等が記憶されるRAM42、制御用のプログラムのほか、後述の分岐点案内処理プログラム(図3参照)及び車両位置検出処理プログラム(図5参照)等が記録されたROM43、ROM43から読み出したプログラムを記憶するフラッシュメモリ44等の内部記憶装置を備えている。尚、ナビゲーションECU13は、処理アルゴリズムとしての各種手段を構成する。例えば、地物検出結果取得手段は、車両(移動体)が移動する道路上に存在する地物を検出した検出結果を取得する。分岐点通過検出手段は、車両が分岐点を通過することを検出する。一致判定手段は、車両が分岐点を通過することを検出した場合に、地物検出結果取得手段により取得された検出結果に基づいて、車両の走行する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致するか否か判定する。位置特定手段は、一致判定手段により検出配置パターンが進入側配置パターンと一致すると判定された場合に、分岐点の周辺に設けられた地物又は分岐点のノードとの相対位置によって車両の位置を特定する。退出側一致判定手段は、退出側地物パターン取得手段は、車両が分岐点を通過することを検出した場合に、地物検出結果取得手段により取得された検出結果に基づいて、車両の走行する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致するか否か判定する。退出側位置特定手段は、退出側一致判定手段により検出配置パターンが退出側配置パターンと一致すると判定された場合に、分岐点の周辺に設けられた地物との相対位置によって車両の位置を特定する。両側一致判定手段は、車両が分岐点を通過することを検出した場合に、地物検出結果取得手段により取得された検出結果に基づいて、車両の走行する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致するか否か判定する。両側位置特定手段は、両側一致判定手段により検出配置パターンが両側配置パターンと一致すると判定された場合に、分岐点の周辺に設けられた地物との相対位置によって車両の位置を特定する。
【0050】
操作部14は、走行開始地点としての出発地及び走行終了地点としての目的地を入力する際等に操作され、各種のキー、ボタン等の複数の操作スイッチ(図示せず)から構成される。そして、ナビゲーションECU13は、各スイッチの押下等により出力されるスイッチ信号に基づき、対応する各種の動作を実行すべく制御を行う。尚、操作部14は液晶ディスプレイ15の前面に設けたタッチパネルによって構成することもできる。また、マイクと音声認識装置によって構成することもできる。
【0051】
また、液晶ディスプレイ15には、道路を含む地図画像、車両の現在位置、交通情報、操作案内、操作メニュー、キーの案内、出発地から目的地までの案内経路、案内経路に沿った案内情報、ニュース、天気予報、時刻、メール、テレビ番組等が表示される。
【0052】
また、スピーカ16は、ナビゲーションECU13からの指示に基づいて案内経路に沿った走行を案内する音声ガイダンスや、交通情報の案内を出力する。
【0053】
また、DVDドライブ17は、DVDやCD等の記録媒体に記録されたデータを読み取り可能なドライブである。そして、読み取ったデータに基づいて音楽や映像の再生、地図情報DB31の更新等が行われる。
【0054】
また、通信モジュール18は、交通情報センタ、例えば、VICSセンタやプローブセンタ等から送信された渋滞情報、規制情報、交通事故情報等の各情報から成る交通情報を受信する為の通信装置であり、例えば携帯電話機やDCMが該当する。
【0055】
また、バックカメラ19は、例えばCCD等の固体撮像素子を用いたものであり、車両の後方に装着されたナンバープレートの上中央付近に取り付けられ、視線方向を水平より所定角度下方に向けて設置される。そして、走行時に車両の進行方向と逆方向となる車両後方を撮像する。そして、撮像画像の画像認識処理を行うことによって、車両の周囲にある地物の種類や位置を検出する。そして、検出された地物に基づいて、車両の詳細な現在位置を検出(又は既に検出された位置を補正)する。
【0056】
続いて、前記構成を有するナビゲーション装置1においてナビゲーションECU13が実行する分岐点案内処理プログラムについて図3に基づき説明する。図3は本実施形態に係る分岐点案内処理プログラムのフローチャートである。ここで、分岐点案内処理プログラムは車両のACCがONされた後に所定間隔(例えば車両の現在位置の検出周期毎)で繰り返し実行され、案内経路上にある案内分岐点に対する案内を行うプログラムである。尚、以下の図3及び図5にフローチャートで示されるプログラムは、ナビゲーション装置1が備えているRAM42やROM43に記憶されており、CPU41により実行される。
【0057】
先ず、分岐点案内処理プログラムではステップ(以下、Sと略記する)1において、CPU41は、ナビゲーション装置1において設定された案内経路に基づく経路案内が行われているか否か判定する。ここで、案内経路は、出発地(例えば自車の現在位置)からユーザに選択された目的地までの推奨経路であり、経路探索処理の結果に基づいて設定される。また、経路探索処理は、地図情報DB31に記憶されたリンクデータ35やノードデータ36、VICSセンタから取得した交通情報等を用いて、公知のダイクストラ法等により行われる。
【0058】
そして、ナビゲーション装置1において設定された案内経路に基づく経路案内が行われていると判定された場合(S1:YES)には、S2へと移行する。それに対して、ナビゲーション装置1において設定された案内経路に基づく経路案内が行われていないと判定された場合(S1:NO)には、当該分岐点案内処理プログラムを終了する。
【0059】
S2においてCPU41は、車両の現在位置を現在位置検出部11の検出結果や後述の車両位置検出処理プログラム(図5)の検出結果や推測航法に基づいて取得する。尚、車両の現在位置を地図データ上で特定するマップマッチング処理についても行う。ここで、車両位置検出処理プログラム(図5)は、後述のように車両が分岐点を通過する際に車両後方のバックカメラ19から取り込んだ白線や路面ペイント等の分岐点周辺にある地物を画像認識により検出し、検出した地物の配置パターンから車両の詳細な位置を検出するプログラムである。特に本実施形態では分岐点周辺にある地物として停止線、横断歩道、自転車横断帯、車線境界線を検出対象とする。また、車両の現在位置は、点では無く誤差を含む一定の範囲で特定される場合もある。
【0060】
次に、S3においてCPU41は、ナビゲーション装置1において設定されている案内経路(案内経路中の案内分岐点を含む)を取得する。
【0061】
続いて、S4においてCPU41は、前記S2で取得した車両の現在位置と前記S3で取得した案内経路に基づいて、車両の進行方向前方の所定距離以内(例えば、1.47km以内)に案内分岐点が有るか否か判定する。尚、案内分岐点とは、ナビゲーション装置1に設定された案内経路に従ってナビゲーション装置1が走行の案内を行う際に、右左折指示等の案内を行う対象となる分岐点である。
【0062】
そして、車両の進行方向前方の所定距離以内に案内分岐点が有ると判定された場合(S4:YES)には、S5へと移行する。それに対して、車両の進行方向前方の所定距離以内に案内分岐点が無いと判定された場合(S4:NO)には、当該分岐点案内処理プログラムを終了する。
【0063】
S5においてCPU41は、車両の進行方向前方にある案内分岐点に対する案内が既に行われたか否か判定する。尚、前記S5では、案内分岐点に対する案内の内、特に案内分岐点での右左折等を指示する音声案内が行われたか否かを判定する。
【0064】
そして、車両の進行方向前方にある案内分岐点に対する案内が既に行われたと判定された場合(S5:YES)には、当該分岐点案内処理プログラムを終了する。それに対して、車両の進行方向前方にある案内分岐点に対する案内が行われていないと判定された場合(S5:NO)には、S6へと移行する。
【0065】
S6においてCPU41は、車両の進行方向前方に位置する案内分岐点の案内を開始するタイミングとなったか否かを判定する。具体的には、車両が予め設定された案内開始点に到達した場合に、案内分岐点の案内を開始するタイミングとなったと判定する。尚、案内開始点は案内対象となる案内フレーズの内容に基づいて設定され、案内分岐点の手前側にある信号機や停止線から所定距離手前側の地点等に設定される。例えば、「2つ目の信号を左(右)方向です」との案内フレーズの発話を開始する案内開始地点は、案内分岐点に設置された信号機を含めて案内分岐点から2つ手前の信号機から所定距離手前の地点となる。
【0066】
尚、前記S2で取得された車両の現在位置が点でなく誤差を含む一定の範囲で特定されている場合には、特定された範囲(以下、自車位置範囲という)に基づいて案内開始地点に車両が到達したか否か判定する。具体的には、自車位置範囲内のどの位置に実際の車両が位置する場合であっても、車両が案内開始地点に到達した状態となった場合、即ち、自車位置範囲内の最も車両の進行方向の逆方向にある地点が案内開始地点と一致した場合に、案内開始地点に車両が到達したと判定する。例えば、図4に示すように、前記S2で取得された自車位置範囲61が案内経路に沿った前後10mの範囲である場合には、最も後方にある地点Xが、案内開始地点A(例えば案内分岐点62の手前側にある分岐点63の退出側信号機64の所定距離手前の地点)に一致した場合に、案内開始地点Aに車両が到達したと判定される。それによって、車両の検出位置に誤差が生じた場合であっても乗員の視界と矛盾する案内(例えば、案内分岐点まで信号機が3つ見える状態で、「2つ目の信号を左(右)方向です」との案内)が行われることを防止することが可能となる。
【0067】
そして、車両の進行方向前方に位置する案内分岐点の案内を開始するタイミングとなったと判定された場合(S6:YES)には、S7へと移行する。それに対して、車両の進行方向前方に位置する案内分岐点の案内を開始するタイミングとなってないと判定された場合(S6:NO)には、当該分岐点案内処理プログラムを終了する。
【0068】
S7においてCPU41は、案内分岐点に関する案内を行う。具体的には、案内分岐点の位置と車両の案内分岐点の退出方向とを特定する案内(即ち、車両が案内分岐点から退出する退出道路を特定させる為の案内)を行う。例えば、「2つ目の信号を左(右)方向です」とのフレーズをスピーカ16から出力する。更に、案内分岐点が車両の所定距離以内(例えば300m)に接近した場合には、案内分岐点付近の拡大図や車両の案内分岐点における進行方向について液晶ディスプレイ15に表示する。
その結果、案内分岐点及び該案内分岐点から車両が退出する道路をユーザに正確に特定させることが可能となる。
【0069】
次に、ナビゲーション装置1においてナビゲーションECU13が実行する車両位置検出処理プログラムについて図5に基づき説明する。図5は本実施形態に係る車両位置検出処理プログラムのフローチャートである。ここで、車両位置検出処理プログラムは車両のACCがONされた後に所定間隔(例えば車両の現在位置の検出周期毎)で繰り返し実行され、車両が分岐点を直進して通過する場合にバックカメラ19を用いて検出した地物の配置パターンに基づいて車両の詳細な現在位置を検出(又は既に検出された位置を補正)するプログラムである。尚、車両位置検出処理プログラムは、車両の進行方向前方の所定距離以内(例えば、1.47km以内)に案内分岐点が位置する状態のみにおいて実行する構成としても良い。
【0070】
先ず、S11においてCPU41は、車両の進行方向前方の所定距離以内(例えば100m以内)に分岐点があるか否か判定する。具体的には、車両の現在位置と分岐点データ37とに基づいて判定する。尚、車両の現在位置は、当該車両位置検出処理プログラムに加えて、現在位置検出部11の検出結果や推測航法に基づいて検出され、RAM42等に格納される。また、格納された情報は新たな車両の現在位置が検出される度に更新される。
【0071】
そして、車両の進行方向前方の所定距離以内に分岐点があると判定された場合(S11:YES)には、S12へと移行する。それに対して、車両の進行方向前方の所定距離以内に分岐点が無いと判定された場合(S11:NO)には、当該車両位置検出処理プログラムを終了する。
【0072】
次に、S12においてCPU41は、車両の進行方向前方にある分岐点が、直進で通過する対象となる分岐点か否か判定する。具体的には、ナビゲーション装置1に案内経路が設定されている場合には案内経路に基づいて判定する。また、ウィンカーランプの点灯状態や車両の走行する車線によって判定しても良い。
【0073】
そして、車両の進行方向前方にある分岐点が、直進で通過する対象となる分岐点であると判定された場合(S12:YES)には、S13へと移行する。それに対して、車両の進行方向前方にある分岐点が、直進で通過する対象となる分岐点でないと判定された場合(S12:NO)には、当該車両位置検出処理プログラムを終了する。
【0074】
S13においてCPU41は、当該車両位置検出処理プログラムと並行して所定間隔で地物認識処理を開始する。ここで、地物認識処理は、バックカメラ19で撮像した画像に対して画像処理(例えば2値化処理やパターンマッチング処理等)を施すことにより、車両の走行する道路上に形成された地物を認識(検出)する処理である。また、地物認識処理において認識(検出)された地物の種類に関する情報を取得する。特に本実施形態では分岐点周辺にある路面標示である停止線、横断歩道、自転車横断帯、車線境界線を地物認識処理による認識(検出)対象とする。
【0075】
次に、S14においてCPU41は、車速センサ22の検出結果に基づいて走行距離のカウントを開始する。
【0076】
続いて、S15においてCPU41は、前記S13で開始した地物認識処理において2以上の地物を認識(検出)したか否か判定する。
【0077】
そして、前記S13で開始した地物認識処理において2以上の地物を認識(検出)したと判定された場合(S15:YES)には、S16へと移行する。それに対して、前記S13で開始した地物認識処理において2以上の地物を認識(検出)していないと判定された場合(S15:NO)には、S24へと移行する。
【0078】
S16においてCPU41は、前記S13で開始した地物認識処理において検出した地物の配置パターン(以下、検出配置パターンという)が、進入側配置パターンと一致するか否か判定する。ここで、進入側配置パターンとは、分岐点へ進入する進入道路上に設けられた地物の配置パターンである。尚、分岐点へ進入する進入道路上に設けられた地物の配置パターンは分岐点毎に異なるが、本実施形態では進入側配置パターンとして、以下の(A)〜(D)を規定する。
(A)車線境界線と停止線又は横断歩道の一方を少なくとも含み、図6に示すように車線境界線71が存在する状態から存在しない状態へと切り替わり、車線境界線71の端部と停止線72との間隔A又は車線境界線71の端部と横断歩道73との間隔Bが所定距離以内(5m以内)であるパターン。
(B)停止線と横断歩道と自転車横断帯を少なくとも含み、図7に示すように停止線72と横断歩道73との間隔Cが所定距離範囲内(例えば1〜5m)であって、横断歩道73と自転車横断帯74との間隔Dが所定距離範囲内(例えば0〜5m)である配置パターン。
(C)停止線と横断歩道とを少なくとも含み、図8に示すように停止線72と横断歩道73との間隔Cが所定距離範囲内(例えば1〜5m)である配置パターン。
(D)停止線と自転車横断帯を少なくとも含み、図9に示すように停止線72と自転車横断帯74との間隔Eが交差道路の道路幅未満である配置パターン。
尚、上記(A)〜(D)に含まれる各所定距離は適宜変更することが可能である。
【0079】
そして、検出配置パターンが上記(A)〜(D)のいずれかの進入側配置パターンと一致すると判定された場合(S16:YES)には、S17へと移行する。それに対して、検出配置パターンが上記(A)〜(D)のいずれの進入側配置パターンとも一致しないと判定された場合(S16:NO)には、S20へと移行する。
【0080】
S17においてCPU41は、検出配置パターンが停止線を含む地物の配置パターンであるか否か判定する。
【0081】
そして検出配置パターンが停止線を含む地物の配置パターンであると判定された場合(S17:YES)には、S18へと移行する。それに対して、検出配置パターンが停止線を含む地物の配置パターンでないと判定された場合(S17:NO)には、S19へと移行する。
【0082】
S18においてCPU41は、分岐点を通過する車両の詳細な現在位置を、検出された停止線との相対位置により検出(又は既に検出された位置を補正)する。具体的には、CPU41は検出された停止線の位置座標を地物データ38から取得する。また、停止線を検出した時点からの車両の走行距離についても取得する。そして、検出された停止線の位置から取得した車両の走行距離だけ車両の進行方向に離れた地点を車両の現在位置として検出する。
【0083】
例えば、図10に示すように分岐点55を道路51から道路52へと通過する車両75が、進入道路51上に設けられた停止線56を含む複数の地物を検出し、且つ検出した地物のパターンが進入側配置パターンと一致した場合には、停止線56との相対位置によって車両75の位置が特定される。即ち、停止線56を検出してから現在までの車両75の走行距離をLとすると、停止線56の位置座標Xから車両75の進行方向に沿って距離Lだけ離間した地点Yを車両75の現在位置として検出する。
また、前記S18で検出された車両の現在位置はRAM42等に格納され、新たな車両の現在位置が検出される度に更新される。その結果、位置座標が予めDB化された停止線を用いて、分岐点の通過後の車両の詳細な現在位置を検出(又は既に検出された位置を補正)することが可能となる。そして、前記分岐点案内処理プログラム(図3)において案内分岐点の案内を開始するタイミングとなったか否かを、補正後の車両の現在位置に基づいて正確に判定することが可能となる。
【0084】
一方、S19においてCPU41は、分岐点を通過する車両の詳細な現在位置を、車両が通過する分岐点のノードとの相対位置により検出(又は既に検出された位置を補正)する。具体的には、CPU41は車両が通過する分岐点のノードの位置座標を分岐点データ37から取得する。また、車両が通過する分岐点の交差道路の道路幅をリンクデータ35から取得する。そして、分岐点のノードから交差道路の道路幅だけ車両の進行方向の逆方向に離れた地点から分岐点のノードまでの範囲を車両の現在位置として検出する。
【0085】
ここで、分岐点データ37として記憶される分岐点のノードは、道路幅員からはみ出さない位置に設定される。例えば、図11に示すように片側2車線の道路が交差する分岐点81では、分岐点81に対して上方向に接続された道路82と分岐点81に対して下方向に接続された道路83とを接続した接続領域と、分岐点81に対して左方向に接続された道路84と分岐点81に対して右方向に接続された道路85とを接続した接続領域と、が重複する領域86内のいずれかの地点に分岐点81のノードが設定される。従って、分岐点81のノードを特定する座標は、左右方向に最大距離Mの幅が生じ得る。同じく上下方向に最大距離Nの幅が生じ得る。即ち、分岐点のノードとの相対位置によって車両の現在位置を特定する場合には、交差道路の道路幅分の誤差が生じ得る。
【0086】
具体的には、分岐点を通過する車両が、進入道路に設けられた地物をバックカメラ19により検出した場合には、車両は交差点の進入端付近に位置することが推定される。従って、図12に示すように分岐点81を道路82から道路83へと通過する車両75が、進入道路82上に設けられた停止線を含まない複数の地物を検出し、且つ検出した地物のパターンが進入側配置パターンと一致した場合であって、分岐点81のノードPが最も進入道路82側に設定されている場合には、分岐点のノードPの位置が車両75の現在位置と特定できる。一方、図13に示すように分岐点のノードPが最も退出道路83側に設定されている場合には、分岐点のノードPの位置から交差道路の道路幅Tだけ車両75の進行方向の逆方向に離れた地点Yが車両75の現在位置と特定できる。従って、前記S19では、分岐点81のノードから交差道路の道路幅だけ車両75の進行方向の逆方向に離れた地点から分岐点のノードまでの範囲を車両の現在位置として検出することとなる。
また、前記S19で検出された車両の現在位置はRAM42等に格納され、新たな車両の現在位置が検出される度に更新される。その結果、停止線以外の地物がDB化されていない場合であっても、分岐点の通過後の車両の詳細な現在位置を検出(又は既に検出された位置を補正)することが可能となる。そして、前記分岐点案内処理プログラム(図3)において案内分岐点の案内を開始するタイミングとなったか否かを、補正後の車両の現在位置に基づいて正確に判定することが可能となる。
【0087】
一方、S20においてCPU41は、前記S13で開始した地物認識処理において検出した地物の配置パターン(検出配置パターン)が、退出側配置パターンと一致するか否か判定する。ここで、退出側配置パターンとは、分岐点から退出する退出道路上に設けられた地物の配置パターンである。尚、分岐点から退出する退出道路上に設けられた地物の配置パターンは分岐点毎に異なるが、本実施形態では進入側配置パターンとして、以下の(E)を規定する。
(E)車線境界線と横断歩道を少なくとも含み、図14に示すように車線境界線71が存在しない状態から存在する状態へと切り替わり、車線境界線71の端部と横断歩道73との間隔Fが所定距離以内(5m以内)であるパターン。
尚、上記(E)に含まれる所定距離は適宜変更することが可能である。
【0088】
そして、検出配置パターンが上記(E)の退出側配置パターンと一致すると判定された場合(S20:YES)には、S21へと移行する。それに対して、検出配置パターンが上記(E)の退出側配置パターンと一致しないと判定された場合(S20:NO)には、S23へと移行する。
【0089】
S21においてCPU41は、検出配置パターンが停止線を含む地物の配置パターンであるか否か判定する。
【0090】
そして検出配置パターンが停止線を含む地物の配置パターンであると判定された場合(S21:YES)には、S18へと移行する。S18においてCPU41は、前述したように分岐点を通過する車両の詳細な現在位置を、検出された停止線との相対位置により検出(又は既に検出された位置を補正)する(図10参照)。
【0091】
それに対して、検出配置パターンが停止線を含む地物の配置パターンでないと判定された場合(S21:NO)には、S22へと移行する。
【0092】
S22においてCPU41は、分岐点を通過する車両の詳細な現在位置を、退出道路の対向車線上にある停止線との相対位置により検出(又は既に検出された位置を補正)する。具体的には、CPU41は退出道路の対向車線上にある停止線の位置座標を地物データ38から取得する。そして、対向車線の停止線の位置を道路の幅方向へ車両の走行車線上に移動させた位置から分岐点側へ1〜5m離間した範囲を車両の現在位置として検出する。
【0093】
図15に示すように分岐点91を通過する車両75が、退出道路92に設けられた横断歩道93をバックカメラ19により検出した場合には、車両75は横断歩道93の退出側方向の境界付近にいると予測される。ここで、横断歩道93と対向車線の路面上に設けられた停止線94との距離間隔Hは1〜5mの範囲にあることが一般である。従って、CPU41は、図16に示すように停止線94の位置を道路の幅方向へ車両の走行車線上に移動させた位置95から分岐点側へ1〜5m離間した範囲を車両75の現在位置として検出する。
また、前記S22で検出された車両の現在位置はRAM42等に格納され、新たな車両の現在位置が検出される度に更新される。その結果、位置座標が予めDB化された停止線を用いて、分岐点の通過後の車両の詳細な現在位置を検出(又は既に検出された位置を補正)することが可能となる。そして、前記分岐点案内処理プログラム(図3)において案内分岐点の案内を開始するタイミングとなったか否かを、補正後の車両の現在位置に基づいて正確に判定することが可能となる。
【0094】
一方、S23においてCPU41は、前記S13で開始した地物認識処理において検出した地物の配置パターン(検出配置パターン)が、両側配置パターンと一致するか否か判定する。ここで、両側配置パターンとは、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである。尚、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンは分岐点毎に異なるが、本実施形態では両側配置パターンとして、以下の(F)を規定する。
(F)2つの横断歩道を少なくとも含み、図17に示すように2つの横断歩道97と横断歩道98の間隔Gが交差道路の道路幅以上であるパターン(即ち、進入道路上の横断歩道と退出道路上の横断歩道とがそれぞれ配置された配置パターン)。
【0095】
そして、検出配置パターンが上記(F)の両側配置パターンと一致すると判定された場合(S23:YES)には、S21へと移行する。そして、S21以降においてCPU41は、前述したように検出配置パターンが停止線を含む地物の配置パターンであるか否かに基づいて車両の現在位置の検出(又は既に検出された位置の補正)を行う(図10、図15、図16参照)。
【0096】
それに対して、検出配置パターンが上記(F)の両側配置パターンと一致しないと判定された場合(S23:NO)には、S24へと移行する。
【0097】
S24においてCPU41は、車両が分岐点のノードを通過して所定距離(例えば100m)以上走行したか否か、即ち、分岐点周辺に設置された地物を認識可能な範囲から車両が外れたか否かを判定する。具体的には、車両の現在位置と分岐点データ37とに基づいて判定する。
【0098】
そして、車両が分岐点のノードを通過して所定距離以上走行したと判定された場合(S24:YES)には、当該車両位置検出処理プログラムを終了する。それに対して、車両が分岐点のノードを通過して所定距離以上走行していないと判定された場合(S24:NO)にはS15へと戻り、継続して車両周辺の地物の検出を行う。
【0099】
以上詳細に説明した通り、本実施形態に係るナビゲーション装置1、ナビゲーション装置1を用いた移動体位置検出方法及びナビゲーション装置1で実行されるコンピュータプログラムによれば、車両が分岐点を直進して通過する場合に、バックカメラ19で撮像した画像に基づいて車両が走行する道路上に存在する地物を検出し(S13)、検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致する場合に、分岐点の周辺に設けられた地物又は分岐点のノードとの相対位置によって移動体の位置を特定する(S18、S19)ので、車両が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて車両の位置を正確に検出することが可能となる。その結果、正確な車両の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
また、検出配置パターンが停止線を含む地物の配置パターンである場合に、該停止線との相対位置によって車両の位置を特定する(S18)ので、停止線に関する情報が少なくともDB化されていれば、車両が検出した停止線に基づいて車両の位置を正確に検出することが可能となる。
また、検出配置パターンが停止線を含まない地物の配置パターンである場合に、分岐点のノードとの相対位置によって車両の位置を特定する(S19)ので、停止線以外の地物に関する情報がDB化されていない場合であっても、車両が通過した分岐点のノードに基づいて車両の位置を正確に検出することが可能となる。
また、検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって車両の位置を特定する(S18、S22)ので、車両が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて車両の位置を正確に検出することが可能となる。
また、検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって車両の位置を特定する(S18、S22)ので、車両が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて車両の位置を正確に検出することが可能となる。
また、検出配置パターンが退出道路上の横断歩道を含む地物の配置パターンである場合に、該横断歩道に対応して車両が走行する車線の対向車線の路面上に設けられた停止線との相対位置によって車両の位置を特定するので、停止線に関する情報が少なくともDB化されていれば、対向車線の停止線に基づいて車両の位置を正確に検出することが可能となる。
また、車両に設置されたバックカメラ19より撮像した画像に基づいて車両が走行する道路上に存在する地物を検出するので、既存のシステムに用いられるバックカメラ19を流用して車両の周囲にある地物を検出することが可能となる。その結果、地物を検出する為の新たな手段やシステムを設けることなく、当該システムを実現することが可能となる。
【0100】
尚、本発明は前記実施形態に限定されるものではなく、本発明の要旨を逸脱しない範囲内で種々の改良、変形が可能であることは勿論である。
例えば、本実施形態ではバックカメラ19により撮像した画像を用いて地物を検出する構成としているが、他の手段により地物を検出する構成としても良い。
【0101】
また、本実施形態では、車両が分岐点を直進して通過する場合に検出した分岐点の地物の配置パターンに基づいて車両の現在位置を検出(補正)する構成としているが、右左折して通過する場合に検出した分岐点の地物の配置パターンに基づいて車両の現在位置を検出(補正)する構成としても良い。
【0102】
また、本実施形態では、進入側配置パターンとして(A)〜(D)のパターンを規定し、退出側配置パターンとして(E)のパターンを規定し、両側配置パターンとして(F)のパターンを規定しているが、上記(A)〜(F)以外のパターンを規定しても良い。また、検出配置パターンが上記(A)〜(F)の配置パターンと完全に一致する場合に加えて一部のみ一致する場合であっても、分岐点の周辺に設けられた地物又は分岐点のノードとの相対位置に基づいて車両の位置を検出する(S18、S19、S22)構成としても良い。
【0103】
また、本実施形態では地物として停止線に関する情報のみを地物データ38としてDB化する構成としているが、停止線以外の地物に関する情報についてもDB化しても良い。その場合には、停止線以外の地物との相対位置によって車両の詳細な現在位置を検出することも可能である。
【0104】
また、本実施形態では分岐点周辺の地物の配置パターンとして、停止線、横断歩道、自転車横断帯、車線境界線の配置パターンを検出する構成としているが、他の地物を含む配置パターンを検出する構成としても良い。例えば、信号機、矢印の路面標示等を含む配置パターンを検出する構成としても良い。
【0105】
また、本発明はナビゲーション装置以外に、移動体の位置を検出する機能を有する装置に対して適用することが可能である。例えば、携帯電話機やPDA等の携帯端末、パーソナルコンピュータ、携帯型音楽プレイヤ等(以下、携帯端末等という)に適用することも可能である。また、サーバと携帯端末等から構成されるシステムに対しても適用することが可能となる。その場合には、上述した分岐点案内処理プログラム(図3)や車両位置検出処理プログラム(図5)の各ステップは、サーバと携帯端末等のいずれが実施する構成としても良い。また、本発明を携帯端末等に適用する場合には、車両以外の移動体、例えば、携帯端末等のユーザや2輪車等の現在位置を検出する場合もある。
【符号の説明】
【0106】
1 ナビゲーション装置
13 ナビゲーションECU
19 バックカメラ
31 地図情報DB
38 地物データ
41 CPU
42 RAM
43 ROM
71 車線境界線
72 停止線
73 横断歩道
74 自転車横断帯
75 車両
【技術分野】
【0001】
本発明は、移動体の位置を検出する移動体位置検出システム、移動体位置検出装置、移動体位置検出方法及びコンピュータプログラムに関する。
【背景技術】
【0002】
近年、車両の走行案内を行い、運転者が所望の目的地に容易に到着できるようにしたナビゲーション装置が車両に搭載されていることが多い。ここで、ナビゲーション装置とは、GPS受信機などにより自車の現在位置を検出し、その現在位置に対応する地図データをDVD−ROMやHDDなどの記録媒体またはネットワークを通じて取得して液晶モニタに表示することが可能な装置である。更に、かかるナビゲーション装置には、所望する目的地を入力すると、出発地から目的地までの最適経路を探索する経路探索機能を備えている。そして、探索結果に基づいて設定された案内経路をディスプレイ画面に表示するとともに、右左折等の案内の対象となる分岐点(以下、案内分岐点という)に接近した場合には音声やディスプレイ画面を用いた案内を行うことによって、ユーザを所望の目的地まで確実に案内するようになっている。また、近年は携帯電話機、PDA(Personal Digital Assistant)、パーソナルコンピュータ等においても上記ナビゲーション装置と同様の機能を有するものがある。更に、車両以外にも歩行者や二輪車を対象として上記案内を行うことも可能である。
【0003】
ここで、案内分岐点において右左折等の案内を行う場合には、案内を適切なタイミングで行うことが重要である。そして、案内を適切なタイミングで行う為には、車両等の現在位置を正確に検出することが必要となる。ここで、車両等の位置を正確に検出する方法の一つとして、例えば特開2007−309670号公報には、車両後方のカメラから取り込んだ白線や路面ペイントを画像認識により検出し、更に、白線や路面ペイントを予め記憶した地図情報DBと照合することにより、車両の詳細な現在位置を検出する技術について記載されている。
【先行技術文献】
【特許文献】
【0004】
【特許文献1】特開2007−309670号公報(第5頁)
【発明の概要】
【発明が解決しようとする課題】
【0005】
ここで、上記特許文献1の技術のように、車両が認識した白線等の地物からの相対位置に基づいて車両の現在位置を特定する技術では、検出対象とする地物の種類と地物の位置情報とを対応付けたDBが必要となる。分岐点周辺の道路に存在する地物としては、例えば停止線、横断歩道、自転車横断帯等があるが、これらの全ての地物に関するDBを作成することとすると、DBの作成に膨大な作業が必要となっていた。一方で、特定の地物、例えば停止線のみを検出対象とすればDBの作成量を削減することができるが、停止線を認識できない場合に位置補正を行うことができない問題があった。
【0006】
本発明は前記従来における問題点を解消するためになされたものであり、地物に関するDBの必要量を削減できるとともに、移動体が分岐点を通過する場合において、分岐点の形状に関わらず移動体の位置を正確に検出することを可能にした移動体位置検出システム、移動体位置検出装置、移動体位置検出方法及びコンピュータプログラムを提供することを目的とする。
【課題を解決するための手段】
【0007】
前記目的を達成するため本願の請求項1に係る移動体位置検出システム(1)は、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得手段(13)と、分岐点を前記移動体が通過することを検出する分岐点通過検出手段(13)と、前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致するか否か判定する一致判定手段(13)と、前記一致判定手段により前記検出配置パターンが前記進入側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物又は前記分岐点のノードとの相対位置によって前記移動体の位置を特定する位置特定手段(13)と、を有することを特徴とする。
尚、「移動体」としては、車両以外に、歩行者や二輪車も含む。
また、「地物の配置パターン」とは、地物の配置順序や配置間隔等が該当する。
【0008】
また、請求項2に係る移動体位置検出システム(1)は、請求項1に記載の移動体位置検出システムであって、前記位置特定手段(13)は、前記検出配置パターンが停止線(72)を含む地物の配置パターンである場合に、該停止線との相対位置によって前記移動体(75)の位置を特定することを特徴とする。
【0009】
また、請求項3に係る移動体位置検出システム(1)は、請求項1又は請求項2に記載の移動体位置検出システムであって、前記位置特定手段(13)は、前記検出配置パターンが停止線を含まない地物の配置パターンである場合に、前記分岐点のノードとの相対位置によって前記移動体(75)の位置を特定することを特徴とする。
【0010】
また、請求項4に係る移動体位置検出システム(1)は、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得手段(13)と、分岐点を前記移動体が通過することを検出する分岐点通過検出手段(13)と、前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致するか否か判定する退出側一致判定手段(13)と、前記退出側一致判定手段により前記検出配置パターンが前記退出側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する退出側位置特定手段(13)と、を有することを特徴とする。
【0011】
また、請求項5に係る移動体位置検出システム(1)は、請求項4に記載の移動体位置検出システムであって、前記検出配置パターンは横断歩道(93)を含む地物の配置パターンであって、前記退出側位置特定手段(13)は、前記移動体(75)の移動する道路上において検出された前記横断歩道に対応して前記移動体が移動する車線の対向車線の路面上に設けられた停止線(94)との相対位置によって前記移動体の位置を特定することを特徴とする。
【0012】
また、請求項6に係る移動体位置検出システム(1)は、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得手段(13)と、分岐点を前記移動体が通過することを検出する分岐点通過検出手段(13)と、前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致するか否か判定する両側一致判定手段(13)と、前記両側一致判定手段により前記検出配置パターンが前記両側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する両側位置特定手段と、を有することを特徴とする。
【0013】
また、請求項7に係る移動体位置検出システム(1)は、請求項6に記載の移動体位置検出システムであって、前記検出配置パターンは退出道路上の横断歩道(93)を含む地物の配置パターンであって、前記両側位置特定手段(13)は、前記移動体の移動する道路上において検出された前記退出道路上の横断歩道に対応して前記移動体が移動する車線の対向車線の路面上に設けられた停止線(94)との相対位置によって前記移動体の位置を特定することを特徴とする。
【0014】
また、請求項8に係る移動体位置検出システム(1)は、請求項1乃至請求項7のいずれかに記載の移動体位置検出システムであって、前記地物検出結果取得手段(13)は、前記移動体(75)に設置された撮像手段(19)より撮像した画像に基づいて前記移動体が移動する道路上に存在する地物を検出した検出結果を取得することを特徴とする。
【0015】
また、請求項9に係る移動体位置検出装置(1)は、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得手段(13)と、分岐点を前記移動体が通過することを検出する分岐点通過検出手段(13)と、前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致するか否か判定する一致判定手段(13)と、前記一致判定手段により前記検出配置パターンが前記進入側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物又は前記分岐点のノードとの相対位置によって前記移動体の位置を特定する位置特定手段(13)と、を有することを特徴とする。
【0016】
また、請求項10に係る移動案内方法は、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得ステップと、分岐点を前記移動体が通過することを検出する分岐点通過検出ステップと、前記分岐点通過ステップによって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得ステップにより取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致するか否か判定する一致判定ステップと、前記一致判定ステップにより前記検出配置パターンが前記進入側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物又は前記分岐点のノードとの相対位置によって前記移動体の位置を特定する位置特定ステップと、を有することを特徴とする。
【0017】
また、請求項11に係るコンピュータプログラムは、コンピュータに、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得機能と、分岐点を前記移動体が通過することを検出する分岐点通過検出機能と、前記分岐点通過機能によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得機能により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致するか否か判定する一致判定機能と、前記一致判定機能により前記検出配置パターンが前記進入側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物又は前記分岐点のノードとの相対位置によって前記移動体の位置を特定する位置特定機能と、を実行させることを特徴とする。
【0018】
また、請求項12に係る移動体位置検出装置(1)は、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得手段(13)と、分岐点を前記移動体が通過することを検出する分岐点通過検出手段(13)と、前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致するか否か判定する退出側一致判定手段(13)と、前記退出側一致判定手段により前記検出配置パターンが前記退出側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する退出側位置特定手段(13)と、を有することを特徴とする。
【0019】
また、請求項13に係る移動体位置検出方法(1)は、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得ステップと、分岐点を前記移動体が通過することを検出する分岐点通過検出ステップと、前記分岐点通過ステップによって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得ステップにより取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致するか否か判定する退出側一致判定ステップと、前記退出側一致判定ステップにより前記検出配置パターンが前記退出側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する退出側位置特定ステップと、を有することを特徴とする。
【0020】
また、請求項14に係るコンピュータプログラムは、コンピュータに、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得機能と、分岐点を前記移動体が通過することを検出する分岐点通過検出機能と、前記分岐点通過機能によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得機能により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致するか否か判定する退出側一致判定機能と、前記退出側一致判定機能により前記検出配置パターンが前記退出側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する退出側位置特定機能と、を実行させることを特徴とする。
【0021】
また、請求項15に係る移動体位置検出装置(1)は、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得手段(13)と、分岐点を前記移動体が通過することを検出する分岐点通過検出手段(13)と、前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致するか否か判定する両側一致判定手段(13)と、前記両側一致判定手段により前記検出配置パターンが前記両側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する両側位置特定手段と、を有することを特徴とする。
【0022】
また、請求項16に係る移動体位置検出方法は、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得ステップと、分岐点を前記移動体が通過することを検出する分岐点通過検出ステップと、前記分岐点通過ステップによって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得ステップにより取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致するか否か判定する両側一致判定ステップと、前記両側一致判定ステップにより前記検出配置パターンが前記両側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する両側位置特定ステップと、を有することを特徴とする。
【0023】
更に、請求項17に係るコンピュータプログラムは、コンピュータに、移動体(75)が移動する道路上に存在する地物(71〜74)を検出した検出結果を取得する地物検出結果取得機能と、分岐点を前記移動体が通過することを検出する分岐点通過検出機能と、前記分岐点通過機能によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得機能により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致するか否か判定する両側一致判定機能と、前記両側一致判定機能により前記検出配置パターンが前記両側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する両側位置特定機能と、を実行させることを特徴とする。
【発明の効果】
【0024】
前記構成を有する請求項1に記載の移動体位置検出システムによれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致する場合に、分岐点の周辺に設けられた地物又は分岐点のノードとの相対位置によって移動体の位置を特定するので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出することが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0025】
また、請求項2に記載の移動体位置検出システムによれば、検出配置パターンが停止線を含む地物の配置パターンである場合に、該停止線との相対位置によって移動体の位置を特定するので、停止線に関する情報が少なくともDB化されていれば、移動体が検出した停止線に基づいて移動体の位置を正確に検出することが可能となる。
【0026】
また、請求項3に記載の移動体位置検出システムによれば、検出配置パターンが停止線を含まない地物の配置パターンである場合に、分岐点のノードとの相対位置によって移動体の位置を特定するので、停止線以外の地物に関する情報がDB化されていない場合であっても、移動体が通過した分岐点のノードに基づいて移動体の位置を正確に検出することが可能となる。
【0027】
また、請求項4に記載の移動体位置検出システムによれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって移動体の位置を特定するので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出することが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0028】
また、請求項5に記載の移動体位置検出システムによれば、検出配置パターンが退出道路上の横断歩道を含む地物の配置パターンである場合に、該横断歩道に対応して移動体が移動する車線の対向車線の路面上に設けられた停止線との相対位置によって移動体の位置を特定するので、停止線に関する情報が少なくともDB化されていれば、対向車線の停止線に基づいて移動体の位置を正確に検出することが可能となる。
【0029】
また、請求項6に記載の移動体位置検出システムによれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって移動体の位置を特定するので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出することが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0030】
また、請求項7に記載の移動体位置検出システムによれば、検出配置パターンが退出道路上の横断歩道を含む地物の配置パターンである場合に、該横断歩道に対応して移動体が移動する車線の対向車線の路面上に設けられた停止線との相対位置によって移動体の位置を特定するので、停止線に関する情報が少なくともDB化されていれば、対向車線の停止線に基づいて移動体の位置を正確に検出することが可能となる。
【0031】
また、請求項8に記載の移動体位置検出システムによれば、移動体に設置された撮像手段より撮像した画像に基づいて移動体が移動する道路上に存在する地物を検出するので、既存のシステムに用いられる撮像手段を流用して移動体の周囲にある地物を検出することが可能となる。その結果、地物を検出する為の新たな手段やシステムを設けることなく、当該システムを実現することが可能となる。
【0032】
また、請求項9に記載の移動体位置検出装置によれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致する場合に、分岐点の周辺に設けられた地物又は分岐点のノードとの相対位置によって移動体の位置を特定するので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出することが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0033】
また、請求項10に記載の移動体位置検出方法によれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致する場合に、分岐点の周辺に設けられた地物又は分岐点のノードとの相対位置によって移動体の位置を特定するので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出することが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0034】
また、請求項11に記載のコンピュータプログラムによれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致する場合に、分岐点の周辺に設けられた地物又は分岐点のノードとの相対位置によって移動体の位置を特定させるので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出させることが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0035】
また、請求項12に記載の移動体位置検出装置によれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって移動体の位置を特定するので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出することが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0036】
また、請求項13に記載の移動体位置検出方法によれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって移動体の位置を特定するので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出することが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0037】
また、請求項14に記載のコンピュータプログラムによれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって移動体の位置を特定させるので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出させることが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0038】
また、請求項15に記載の移動体位置検出装置によれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって移動体の位置を特定するので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出することが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0039】
また、請求項16に記載の移動体位置検出方法によれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって移動体の位置を特定するので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出することが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【0040】
更に、請求項17に記載のコンピュータプログラムによれば、移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって移動体の位置を特定させるので、移動体が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて移動体の位置を正確に検出させることが可能となる。その結果、正確な移動体の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
【図面の簡単な説明】
【0041】
【図1】本実施形態に係るナビゲーション装置を示したブロック図である。
【図2】分岐点に配置される地物の一例を示した図である。
【図3】本実施形態に係る分岐点案内処理プログラムのフローチャートである。
【図4】検出された車両の現在位置と案内分岐点の案内を開始する案内開始タイミングとの関係を示した図である。
【図5】本実施形態に係る車両位置検出処理プログラムのフローチャートである。
【図6】分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンの一例を示した図である。
【図7】分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンの一例を示した図である。
【図8】分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンの一例を示した図である。
【図9】分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンの一例を示した図である。
【図10】検出配置パターンが進入道路の停止線を含む地物の配置パターンである場合において、車両の現在位置の検出方法について説明した図である。
【図11】分岐点において設定されるノードの設定範囲を示した図である。
【図12】検出配置パターンが進入道路の停止線を含まない地物の配置パターンである場合において、車両の現在位置の検出方法について説明した図である。
【図13】検出配置パターンが進入道路の停止線を含まない地物の配置パターンである場合において、車両の現在位置の検出方法について説明した図である。
【図14】分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンの一例を示した図である。
【図15】検出配置パターンが退出道路の横断歩道を含む地物の配置パターンである場合において、車両の現在位置の検出方法について説明した図である。
【図16】検出配置パターンが退出道路の横断歩道を含む地物の配置パターンである場合において、車両の現在位置の検出方法について説明した図である。
【図17】分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンの一例を示した図である。
【発明を実施するための形態】
【0042】
以下、本発明に係る移動体位置検出システム及び移動体位置検出装置をナビゲーション装置に具体化した一実施形態に基づき図面を参照しつつ詳細に説明する。先ず、本実施形態に係るナビゲーション装置1の概略構成について図1を用いて説明する。図1は本実施形態に係るナビゲーション装置1を示したブロック図である。
【0043】
図1に示すように本実施形態に係るナビゲーション装置1は、ナビゲーション装置1が搭載された車両の現在位置を検出する現在位置検出部11と、各種のデータが記録されたデータ記録部12と、入力された情報に基づいて、各種の演算処理を行うナビゲーションECU13と、ユーザからの操作を受け付ける操作部14と、ユーザに対して車両周辺の地図や施設の関する施設情報を表示する液晶ディスプレイ15と、経路案内に関する音声ガイダンスを出力するスピーカ16と、記憶媒体であるDVDを読み取るDVDドライブ17と、プローブセンタやVICS(登録商標:Vehicle Information and Communication System)センタ等の情報センタとの間で通信を行う通信モジュール18と、から構成されている。また、ナビゲーション装置1には後述する路面標示等の地物を検出する為のバックカメラ19が接続されている。
【0044】
以下に、ナビゲーション装置1を構成する各構成要素について順に説明する。
現在位置検出部11は、GPS21、車速センサ22、ステアリングセンサ23、ジャイロセンサ24等からなり、現在の車両の位置、方位、車両の走行速度、現在時刻等を検出することが可能となっている。ここで、特に車速センサ22は、車両の移動距離や車速を検出する為のセンサであり、車両の駆動輪の回転に応じてパルスを発生させ、パルス信号をナビゲーションECU13に出力する。そして、ナビゲーションECU13は発生するパルスを計数することにより駆動輪の回転速度や移動距離を算出する。尚、上記5種類のセンサをナビゲーション装置1が全て備える必要はなく、これらの内の1又は複数種類のセンサのみをナビゲーション装置1が備える構成としても良い。
【0045】
また、データ記録部12は、外部記憶装置及び記録媒体としてのハードディスク(図示せず)と、ハードディスクに記録された地図情報DB31や所定のプログラム等を読み出すとともにハードディスクに所定のデータを書き込む為のドライバである記録ヘッド(図示せず)とを備えている。尚、データ記録部12をハードディスクの代わりにメモリーカードやCDやDVD等の光ディスクにより構成しても良い。
【0046】
ここで、地図情報DB31は、例えば、道路(リンク)に関するリンクデータ35、ノード点に関するノードデータ36、各分岐点に関する分岐点データ37、道路上に形成された地物の内、特に路面標示に関する地物データ38、施設に関する施設データ、地図を表示するための地図表示データ、経路を探索するための探索データ、地点を検索するための検索データ等が記憶された記憶手段である。
【0047】
ここで、リンクデータ35としては、例えば、該リンクを識別するリンクID、該リンクの端部に位置するノードを特定する端部ノード情報、該リンクを構成する道路の道路種別、道路幅、車線数等が記憶される。また、ノードデータ36としては、該ノードを識別するノードID、該ノードの位置座標、該ノードがリンクを介して接続される接続先ノードを特定する接続先ノード情報等が記憶される。また、分岐点データ37としては、該分岐点(交差点)を形成するノードを特定する該当ノード情報、該分岐点に接続されるリンク(以下、接続リンクという)を特定する接続リンク情報等が記憶される。
【0048】
一方、地物データ38は、道路上に形成された地物の内、特に停止線の路面標示に関する情報が記憶される。具体的には、識別IDと、停止線の位置を地図上で特定する座標データと、停止線が設置された分岐点を識別する分岐点IDとが記憶される。例えば、図2に示すように片側2車線の4本の道路51〜54が接続する分岐点55では、4箇所に停止線56〜59が設置されている。従って、地物データ38としては、停止線56〜59に関する各種情報が記憶される。
そして、ナビゲーションECU13は、車両が分岐点を通過する際に、バックカメラ19で撮像した撮像画像から路面に形成された停止線を含む地物の配置パターンを検出した場合に、検出した停止線に関連付けられた座標データに基づいて車両の詳細な現在位置を検出(又は既に検出された位置を補正)することが可能となる。そして、検出された現在位置に基づいて案内や車両制御を行う。
【0049】
一方、ナビゲーションECU(エレクトロニック・コントロール・ユニット)13は、ナビゲーション装置1の全体の制御を行う電子制御ユニットであり、演算装置及び制御装置としてのCPU41、並びにCPU41が各種の演算処理を行うにあたってワーキングメモリとして使用されるとともに、経路が探索されたときの経路データ等が記憶されるRAM42、制御用のプログラムのほか、後述の分岐点案内処理プログラム(図3参照)及び車両位置検出処理プログラム(図5参照)等が記録されたROM43、ROM43から読み出したプログラムを記憶するフラッシュメモリ44等の内部記憶装置を備えている。尚、ナビゲーションECU13は、処理アルゴリズムとしての各種手段を構成する。例えば、地物検出結果取得手段は、車両(移動体)が移動する道路上に存在する地物を検出した検出結果を取得する。分岐点通過検出手段は、車両が分岐点を通過することを検出する。一致判定手段は、車両が分岐点を通過することを検出した場合に、地物検出結果取得手段により取得された検出結果に基づいて、車両の走行する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致するか否か判定する。位置特定手段は、一致判定手段により検出配置パターンが進入側配置パターンと一致すると判定された場合に、分岐点の周辺に設けられた地物又は分岐点のノードとの相対位置によって車両の位置を特定する。退出側一致判定手段は、退出側地物パターン取得手段は、車両が分岐点を通過することを検出した場合に、地物検出結果取得手段により取得された検出結果に基づいて、車両の走行する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致するか否か判定する。退出側位置特定手段は、退出側一致判定手段により検出配置パターンが退出側配置パターンと一致すると判定された場合に、分岐点の周辺に設けられた地物との相対位置によって車両の位置を特定する。両側一致判定手段は、車両が分岐点を通過することを検出した場合に、地物検出結果取得手段により取得された検出結果に基づいて、車両の走行する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致するか否か判定する。両側位置特定手段は、両側一致判定手段により検出配置パターンが両側配置パターンと一致すると判定された場合に、分岐点の周辺に設けられた地物との相対位置によって車両の位置を特定する。
【0050】
操作部14は、走行開始地点としての出発地及び走行終了地点としての目的地を入力する際等に操作され、各種のキー、ボタン等の複数の操作スイッチ(図示せず)から構成される。そして、ナビゲーションECU13は、各スイッチの押下等により出力されるスイッチ信号に基づき、対応する各種の動作を実行すべく制御を行う。尚、操作部14は液晶ディスプレイ15の前面に設けたタッチパネルによって構成することもできる。また、マイクと音声認識装置によって構成することもできる。
【0051】
また、液晶ディスプレイ15には、道路を含む地図画像、車両の現在位置、交通情報、操作案内、操作メニュー、キーの案内、出発地から目的地までの案内経路、案内経路に沿った案内情報、ニュース、天気予報、時刻、メール、テレビ番組等が表示される。
【0052】
また、スピーカ16は、ナビゲーションECU13からの指示に基づいて案内経路に沿った走行を案内する音声ガイダンスや、交通情報の案内を出力する。
【0053】
また、DVDドライブ17は、DVDやCD等の記録媒体に記録されたデータを読み取り可能なドライブである。そして、読み取ったデータに基づいて音楽や映像の再生、地図情報DB31の更新等が行われる。
【0054】
また、通信モジュール18は、交通情報センタ、例えば、VICSセンタやプローブセンタ等から送信された渋滞情報、規制情報、交通事故情報等の各情報から成る交通情報を受信する為の通信装置であり、例えば携帯電話機やDCMが該当する。
【0055】
また、バックカメラ19は、例えばCCD等の固体撮像素子を用いたものであり、車両の後方に装着されたナンバープレートの上中央付近に取り付けられ、視線方向を水平より所定角度下方に向けて設置される。そして、走行時に車両の進行方向と逆方向となる車両後方を撮像する。そして、撮像画像の画像認識処理を行うことによって、車両の周囲にある地物の種類や位置を検出する。そして、検出された地物に基づいて、車両の詳細な現在位置を検出(又は既に検出された位置を補正)する。
【0056】
続いて、前記構成を有するナビゲーション装置1においてナビゲーションECU13が実行する分岐点案内処理プログラムについて図3に基づき説明する。図3は本実施形態に係る分岐点案内処理プログラムのフローチャートである。ここで、分岐点案内処理プログラムは車両のACCがONされた後に所定間隔(例えば車両の現在位置の検出周期毎)で繰り返し実行され、案内経路上にある案内分岐点に対する案内を行うプログラムである。尚、以下の図3及び図5にフローチャートで示されるプログラムは、ナビゲーション装置1が備えているRAM42やROM43に記憶されており、CPU41により実行される。
【0057】
先ず、分岐点案内処理プログラムではステップ(以下、Sと略記する)1において、CPU41は、ナビゲーション装置1において設定された案内経路に基づく経路案内が行われているか否か判定する。ここで、案内経路は、出発地(例えば自車の現在位置)からユーザに選択された目的地までの推奨経路であり、経路探索処理の結果に基づいて設定される。また、経路探索処理は、地図情報DB31に記憶されたリンクデータ35やノードデータ36、VICSセンタから取得した交通情報等を用いて、公知のダイクストラ法等により行われる。
【0058】
そして、ナビゲーション装置1において設定された案内経路に基づく経路案内が行われていると判定された場合(S1:YES)には、S2へと移行する。それに対して、ナビゲーション装置1において設定された案内経路に基づく経路案内が行われていないと判定された場合(S1:NO)には、当該分岐点案内処理プログラムを終了する。
【0059】
S2においてCPU41は、車両の現在位置を現在位置検出部11の検出結果や後述の車両位置検出処理プログラム(図5)の検出結果や推測航法に基づいて取得する。尚、車両の現在位置を地図データ上で特定するマップマッチング処理についても行う。ここで、車両位置検出処理プログラム(図5)は、後述のように車両が分岐点を通過する際に車両後方のバックカメラ19から取り込んだ白線や路面ペイント等の分岐点周辺にある地物を画像認識により検出し、検出した地物の配置パターンから車両の詳細な位置を検出するプログラムである。特に本実施形態では分岐点周辺にある地物として停止線、横断歩道、自転車横断帯、車線境界線を検出対象とする。また、車両の現在位置は、点では無く誤差を含む一定の範囲で特定される場合もある。
【0060】
次に、S3においてCPU41は、ナビゲーション装置1において設定されている案内経路(案内経路中の案内分岐点を含む)を取得する。
【0061】
続いて、S4においてCPU41は、前記S2で取得した車両の現在位置と前記S3で取得した案内経路に基づいて、車両の進行方向前方の所定距離以内(例えば、1.47km以内)に案内分岐点が有るか否か判定する。尚、案内分岐点とは、ナビゲーション装置1に設定された案内経路に従ってナビゲーション装置1が走行の案内を行う際に、右左折指示等の案内を行う対象となる分岐点である。
【0062】
そして、車両の進行方向前方の所定距離以内に案内分岐点が有ると判定された場合(S4:YES)には、S5へと移行する。それに対して、車両の進行方向前方の所定距離以内に案内分岐点が無いと判定された場合(S4:NO)には、当該分岐点案内処理プログラムを終了する。
【0063】
S5においてCPU41は、車両の進行方向前方にある案内分岐点に対する案内が既に行われたか否か判定する。尚、前記S5では、案内分岐点に対する案内の内、特に案内分岐点での右左折等を指示する音声案内が行われたか否かを判定する。
【0064】
そして、車両の進行方向前方にある案内分岐点に対する案内が既に行われたと判定された場合(S5:YES)には、当該分岐点案内処理プログラムを終了する。それに対して、車両の進行方向前方にある案内分岐点に対する案内が行われていないと判定された場合(S5:NO)には、S6へと移行する。
【0065】
S6においてCPU41は、車両の進行方向前方に位置する案内分岐点の案内を開始するタイミングとなったか否かを判定する。具体的には、車両が予め設定された案内開始点に到達した場合に、案内分岐点の案内を開始するタイミングとなったと判定する。尚、案内開始点は案内対象となる案内フレーズの内容に基づいて設定され、案内分岐点の手前側にある信号機や停止線から所定距離手前側の地点等に設定される。例えば、「2つ目の信号を左(右)方向です」との案内フレーズの発話を開始する案内開始地点は、案内分岐点に設置された信号機を含めて案内分岐点から2つ手前の信号機から所定距離手前の地点となる。
【0066】
尚、前記S2で取得された車両の現在位置が点でなく誤差を含む一定の範囲で特定されている場合には、特定された範囲(以下、自車位置範囲という)に基づいて案内開始地点に車両が到達したか否か判定する。具体的には、自車位置範囲内のどの位置に実際の車両が位置する場合であっても、車両が案内開始地点に到達した状態となった場合、即ち、自車位置範囲内の最も車両の進行方向の逆方向にある地点が案内開始地点と一致した場合に、案内開始地点に車両が到達したと判定する。例えば、図4に示すように、前記S2で取得された自車位置範囲61が案内経路に沿った前後10mの範囲である場合には、最も後方にある地点Xが、案内開始地点A(例えば案内分岐点62の手前側にある分岐点63の退出側信号機64の所定距離手前の地点)に一致した場合に、案内開始地点Aに車両が到達したと判定される。それによって、車両の検出位置に誤差が生じた場合であっても乗員の視界と矛盾する案内(例えば、案内分岐点まで信号機が3つ見える状態で、「2つ目の信号を左(右)方向です」との案内)が行われることを防止することが可能となる。
【0067】
そして、車両の進行方向前方に位置する案内分岐点の案内を開始するタイミングとなったと判定された場合(S6:YES)には、S7へと移行する。それに対して、車両の進行方向前方に位置する案内分岐点の案内を開始するタイミングとなってないと判定された場合(S6:NO)には、当該分岐点案内処理プログラムを終了する。
【0068】
S7においてCPU41は、案内分岐点に関する案内を行う。具体的には、案内分岐点の位置と車両の案内分岐点の退出方向とを特定する案内(即ち、車両が案内分岐点から退出する退出道路を特定させる為の案内)を行う。例えば、「2つ目の信号を左(右)方向です」とのフレーズをスピーカ16から出力する。更に、案内分岐点が車両の所定距離以内(例えば300m)に接近した場合には、案内分岐点付近の拡大図や車両の案内分岐点における進行方向について液晶ディスプレイ15に表示する。
その結果、案内分岐点及び該案内分岐点から車両が退出する道路をユーザに正確に特定させることが可能となる。
【0069】
次に、ナビゲーション装置1においてナビゲーションECU13が実行する車両位置検出処理プログラムについて図5に基づき説明する。図5は本実施形態に係る車両位置検出処理プログラムのフローチャートである。ここで、車両位置検出処理プログラムは車両のACCがONされた後に所定間隔(例えば車両の現在位置の検出周期毎)で繰り返し実行され、車両が分岐点を直進して通過する場合にバックカメラ19を用いて検出した地物の配置パターンに基づいて車両の詳細な現在位置を検出(又は既に検出された位置を補正)するプログラムである。尚、車両位置検出処理プログラムは、車両の進行方向前方の所定距離以内(例えば、1.47km以内)に案内分岐点が位置する状態のみにおいて実行する構成としても良い。
【0070】
先ず、S11においてCPU41は、車両の進行方向前方の所定距離以内(例えば100m以内)に分岐点があるか否か判定する。具体的には、車両の現在位置と分岐点データ37とに基づいて判定する。尚、車両の現在位置は、当該車両位置検出処理プログラムに加えて、現在位置検出部11の検出結果や推測航法に基づいて検出され、RAM42等に格納される。また、格納された情報は新たな車両の現在位置が検出される度に更新される。
【0071】
そして、車両の進行方向前方の所定距離以内に分岐点があると判定された場合(S11:YES)には、S12へと移行する。それに対して、車両の進行方向前方の所定距離以内に分岐点が無いと判定された場合(S11:NO)には、当該車両位置検出処理プログラムを終了する。
【0072】
次に、S12においてCPU41は、車両の進行方向前方にある分岐点が、直進で通過する対象となる分岐点か否か判定する。具体的には、ナビゲーション装置1に案内経路が設定されている場合には案内経路に基づいて判定する。また、ウィンカーランプの点灯状態や車両の走行する車線によって判定しても良い。
【0073】
そして、車両の進行方向前方にある分岐点が、直進で通過する対象となる分岐点であると判定された場合(S12:YES)には、S13へと移行する。それに対して、車両の進行方向前方にある分岐点が、直進で通過する対象となる分岐点でないと判定された場合(S12:NO)には、当該車両位置検出処理プログラムを終了する。
【0074】
S13においてCPU41は、当該車両位置検出処理プログラムと並行して所定間隔で地物認識処理を開始する。ここで、地物認識処理は、バックカメラ19で撮像した画像に対して画像処理(例えば2値化処理やパターンマッチング処理等)を施すことにより、車両の走行する道路上に形成された地物を認識(検出)する処理である。また、地物認識処理において認識(検出)された地物の種類に関する情報を取得する。特に本実施形態では分岐点周辺にある路面標示である停止線、横断歩道、自転車横断帯、車線境界線を地物認識処理による認識(検出)対象とする。
【0075】
次に、S14においてCPU41は、車速センサ22の検出結果に基づいて走行距離のカウントを開始する。
【0076】
続いて、S15においてCPU41は、前記S13で開始した地物認識処理において2以上の地物を認識(検出)したか否か判定する。
【0077】
そして、前記S13で開始した地物認識処理において2以上の地物を認識(検出)したと判定された場合(S15:YES)には、S16へと移行する。それに対して、前記S13で開始した地物認識処理において2以上の地物を認識(検出)していないと判定された場合(S15:NO)には、S24へと移行する。
【0078】
S16においてCPU41は、前記S13で開始した地物認識処理において検出した地物の配置パターン(以下、検出配置パターンという)が、進入側配置パターンと一致するか否か判定する。ここで、進入側配置パターンとは、分岐点へ進入する進入道路上に設けられた地物の配置パターンである。尚、分岐点へ進入する進入道路上に設けられた地物の配置パターンは分岐点毎に異なるが、本実施形態では進入側配置パターンとして、以下の(A)〜(D)を規定する。
(A)車線境界線と停止線又は横断歩道の一方を少なくとも含み、図6に示すように車線境界線71が存在する状態から存在しない状態へと切り替わり、車線境界線71の端部と停止線72との間隔A又は車線境界線71の端部と横断歩道73との間隔Bが所定距離以内(5m以内)であるパターン。
(B)停止線と横断歩道と自転車横断帯を少なくとも含み、図7に示すように停止線72と横断歩道73との間隔Cが所定距離範囲内(例えば1〜5m)であって、横断歩道73と自転車横断帯74との間隔Dが所定距離範囲内(例えば0〜5m)である配置パターン。
(C)停止線と横断歩道とを少なくとも含み、図8に示すように停止線72と横断歩道73との間隔Cが所定距離範囲内(例えば1〜5m)である配置パターン。
(D)停止線と自転車横断帯を少なくとも含み、図9に示すように停止線72と自転車横断帯74との間隔Eが交差道路の道路幅未満である配置パターン。
尚、上記(A)〜(D)に含まれる各所定距離は適宜変更することが可能である。
【0079】
そして、検出配置パターンが上記(A)〜(D)のいずれかの進入側配置パターンと一致すると判定された場合(S16:YES)には、S17へと移行する。それに対して、検出配置パターンが上記(A)〜(D)のいずれの進入側配置パターンとも一致しないと判定された場合(S16:NO)には、S20へと移行する。
【0080】
S17においてCPU41は、検出配置パターンが停止線を含む地物の配置パターンであるか否か判定する。
【0081】
そして検出配置パターンが停止線を含む地物の配置パターンであると判定された場合(S17:YES)には、S18へと移行する。それに対して、検出配置パターンが停止線を含む地物の配置パターンでないと判定された場合(S17:NO)には、S19へと移行する。
【0082】
S18においてCPU41は、分岐点を通過する車両の詳細な現在位置を、検出された停止線との相対位置により検出(又は既に検出された位置を補正)する。具体的には、CPU41は検出された停止線の位置座標を地物データ38から取得する。また、停止線を検出した時点からの車両の走行距離についても取得する。そして、検出された停止線の位置から取得した車両の走行距離だけ車両の進行方向に離れた地点を車両の現在位置として検出する。
【0083】
例えば、図10に示すように分岐点55を道路51から道路52へと通過する車両75が、進入道路51上に設けられた停止線56を含む複数の地物を検出し、且つ検出した地物のパターンが進入側配置パターンと一致した場合には、停止線56との相対位置によって車両75の位置が特定される。即ち、停止線56を検出してから現在までの車両75の走行距離をLとすると、停止線56の位置座標Xから車両75の進行方向に沿って距離Lだけ離間した地点Yを車両75の現在位置として検出する。
また、前記S18で検出された車両の現在位置はRAM42等に格納され、新たな車両の現在位置が検出される度に更新される。その結果、位置座標が予めDB化された停止線を用いて、分岐点の通過後の車両の詳細な現在位置を検出(又は既に検出された位置を補正)することが可能となる。そして、前記分岐点案内処理プログラム(図3)において案内分岐点の案内を開始するタイミングとなったか否かを、補正後の車両の現在位置に基づいて正確に判定することが可能となる。
【0084】
一方、S19においてCPU41は、分岐点を通過する車両の詳細な現在位置を、車両が通過する分岐点のノードとの相対位置により検出(又は既に検出された位置を補正)する。具体的には、CPU41は車両が通過する分岐点のノードの位置座標を分岐点データ37から取得する。また、車両が通過する分岐点の交差道路の道路幅をリンクデータ35から取得する。そして、分岐点のノードから交差道路の道路幅だけ車両の進行方向の逆方向に離れた地点から分岐点のノードまでの範囲を車両の現在位置として検出する。
【0085】
ここで、分岐点データ37として記憶される分岐点のノードは、道路幅員からはみ出さない位置に設定される。例えば、図11に示すように片側2車線の道路が交差する分岐点81では、分岐点81に対して上方向に接続された道路82と分岐点81に対して下方向に接続された道路83とを接続した接続領域と、分岐点81に対して左方向に接続された道路84と分岐点81に対して右方向に接続された道路85とを接続した接続領域と、が重複する領域86内のいずれかの地点に分岐点81のノードが設定される。従って、分岐点81のノードを特定する座標は、左右方向に最大距離Mの幅が生じ得る。同じく上下方向に最大距離Nの幅が生じ得る。即ち、分岐点のノードとの相対位置によって車両の現在位置を特定する場合には、交差道路の道路幅分の誤差が生じ得る。
【0086】
具体的には、分岐点を通過する車両が、進入道路に設けられた地物をバックカメラ19により検出した場合には、車両は交差点の進入端付近に位置することが推定される。従って、図12に示すように分岐点81を道路82から道路83へと通過する車両75が、進入道路82上に設けられた停止線を含まない複数の地物を検出し、且つ検出した地物のパターンが進入側配置パターンと一致した場合であって、分岐点81のノードPが最も進入道路82側に設定されている場合には、分岐点のノードPの位置が車両75の現在位置と特定できる。一方、図13に示すように分岐点のノードPが最も退出道路83側に設定されている場合には、分岐点のノードPの位置から交差道路の道路幅Tだけ車両75の進行方向の逆方向に離れた地点Yが車両75の現在位置と特定できる。従って、前記S19では、分岐点81のノードから交差道路の道路幅だけ車両75の進行方向の逆方向に離れた地点から分岐点のノードまでの範囲を車両の現在位置として検出することとなる。
また、前記S19で検出された車両の現在位置はRAM42等に格納され、新たな車両の現在位置が検出される度に更新される。その結果、停止線以外の地物がDB化されていない場合であっても、分岐点の通過後の車両の詳細な現在位置を検出(又は既に検出された位置を補正)することが可能となる。そして、前記分岐点案内処理プログラム(図3)において案内分岐点の案内を開始するタイミングとなったか否かを、補正後の車両の現在位置に基づいて正確に判定することが可能となる。
【0087】
一方、S20においてCPU41は、前記S13で開始した地物認識処理において検出した地物の配置パターン(検出配置パターン)が、退出側配置パターンと一致するか否か判定する。ここで、退出側配置パターンとは、分岐点から退出する退出道路上に設けられた地物の配置パターンである。尚、分岐点から退出する退出道路上に設けられた地物の配置パターンは分岐点毎に異なるが、本実施形態では進入側配置パターンとして、以下の(E)を規定する。
(E)車線境界線と横断歩道を少なくとも含み、図14に示すように車線境界線71が存在しない状態から存在する状態へと切り替わり、車線境界線71の端部と横断歩道73との間隔Fが所定距離以内(5m以内)であるパターン。
尚、上記(E)に含まれる所定距離は適宜変更することが可能である。
【0088】
そして、検出配置パターンが上記(E)の退出側配置パターンと一致すると判定された場合(S20:YES)には、S21へと移行する。それに対して、検出配置パターンが上記(E)の退出側配置パターンと一致しないと判定された場合(S20:NO)には、S23へと移行する。
【0089】
S21においてCPU41は、検出配置パターンが停止線を含む地物の配置パターンであるか否か判定する。
【0090】
そして検出配置パターンが停止線を含む地物の配置パターンであると判定された場合(S21:YES)には、S18へと移行する。S18においてCPU41は、前述したように分岐点を通過する車両の詳細な現在位置を、検出された停止線との相対位置により検出(又は既に検出された位置を補正)する(図10参照)。
【0091】
それに対して、検出配置パターンが停止線を含む地物の配置パターンでないと判定された場合(S21:NO)には、S22へと移行する。
【0092】
S22においてCPU41は、分岐点を通過する車両の詳細な現在位置を、退出道路の対向車線上にある停止線との相対位置により検出(又は既に検出された位置を補正)する。具体的には、CPU41は退出道路の対向車線上にある停止線の位置座標を地物データ38から取得する。そして、対向車線の停止線の位置を道路の幅方向へ車両の走行車線上に移動させた位置から分岐点側へ1〜5m離間した範囲を車両の現在位置として検出する。
【0093】
図15に示すように分岐点91を通過する車両75が、退出道路92に設けられた横断歩道93をバックカメラ19により検出した場合には、車両75は横断歩道93の退出側方向の境界付近にいると予測される。ここで、横断歩道93と対向車線の路面上に設けられた停止線94との距離間隔Hは1〜5mの範囲にあることが一般である。従って、CPU41は、図16に示すように停止線94の位置を道路の幅方向へ車両の走行車線上に移動させた位置95から分岐点側へ1〜5m離間した範囲を車両75の現在位置として検出する。
また、前記S22で検出された車両の現在位置はRAM42等に格納され、新たな車両の現在位置が検出される度に更新される。その結果、位置座標が予めDB化された停止線を用いて、分岐点の通過後の車両の詳細な現在位置を検出(又は既に検出された位置を補正)することが可能となる。そして、前記分岐点案内処理プログラム(図3)において案内分岐点の案内を開始するタイミングとなったか否かを、補正後の車両の現在位置に基づいて正確に判定することが可能となる。
【0094】
一方、S23においてCPU41は、前記S13で開始した地物認識処理において検出した地物の配置パターン(検出配置パターン)が、両側配置パターンと一致するか否か判定する。ここで、両側配置パターンとは、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである。尚、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンは分岐点毎に異なるが、本実施形態では両側配置パターンとして、以下の(F)を規定する。
(F)2つの横断歩道を少なくとも含み、図17に示すように2つの横断歩道97と横断歩道98の間隔Gが交差道路の道路幅以上であるパターン(即ち、進入道路上の横断歩道と退出道路上の横断歩道とがそれぞれ配置された配置パターン)。
【0095】
そして、検出配置パターンが上記(F)の両側配置パターンと一致すると判定された場合(S23:YES)には、S21へと移行する。そして、S21以降においてCPU41は、前述したように検出配置パターンが停止線を含む地物の配置パターンであるか否かに基づいて車両の現在位置の検出(又は既に検出された位置の補正)を行う(図10、図15、図16参照)。
【0096】
それに対して、検出配置パターンが上記(F)の両側配置パターンと一致しないと判定された場合(S23:NO)には、S24へと移行する。
【0097】
S24においてCPU41は、車両が分岐点のノードを通過して所定距離(例えば100m)以上走行したか否か、即ち、分岐点周辺に設置された地物を認識可能な範囲から車両が外れたか否かを判定する。具体的には、車両の現在位置と分岐点データ37とに基づいて判定する。
【0098】
そして、車両が分岐点のノードを通過して所定距離以上走行したと判定された場合(S24:YES)には、当該車両位置検出処理プログラムを終了する。それに対して、車両が分岐点のノードを通過して所定距離以上走行していないと判定された場合(S24:NO)にはS15へと戻り、継続して車両周辺の地物の検出を行う。
【0099】
以上詳細に説明した通り、本実施形態に係るナビゲーション装置1、ナビゲーション装置1を用いた移動体位置検出方法及びナビゲーション装置1で実行されるコンピュータプログラムによれば、車両が分岐点を直進して通過する場合に、バックカメラ19で撮像した画像に基づいて車両が走行する道路上に存在する地物を検出し(S13)、検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致する場合に、分岐点の周辺に設けられた地物又は分岐点のノードとの相対位置によって移動体の位置を特定する(S18、S19)ので、車両が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて車両の位置を正確に検出することが可能となる。その結果、正確な車両の位置に基づいて、移動体に対する案内や制御を適切なタイミングで実行することが可能となる。また、地物に関する情報を記憶したDBの必要量についても削減することができる。
また、検出配置パターンが停止線を含む地物の配置パターンである場合に、該停止線との相対位置によって車両の位置を特定する(S18)ので、停止線に関する情報が少なくともDB化されていれば、車両が検出した停止線に基づいて車両の位置を正確に検出することが可能となる。
また、検出配置パターンが停止線を含まない地物の配置パターンである場合に、分岐点のノードとの相対位置によって車両の位置を特定する(S19)ので、停止線以外の地物に関する情報がDB化されていない場合であっても、車両が通過した分岐点のノードに基づいて車両の位置を正確に検出することが可能となる。
また、検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって車両の位置を特定する(S18、S22)ので、車両が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて車両の位置を正確に検出することが可能となる。
また、検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致する場合に、分岐点の周辺に設けられた地物との相対位置によって車両の位置を特定する(S18、S22)ので、車両が分岐点を通過する場合に、分岐点の形状に関わらず分岐点の周辺に配置された地物に基づいて車両の位置を正確に検出することが可能となる。
また、検出配置パターンが退出道路上の横断歩道を含む地物の配置パターンである場合に、該横断歩道に対応して車両が走行する車線の対向車線の路面上に設けられた停止線との相対位置によって車両の位置を特定するので、停止線に関する情報が少なくともDB化されていれば、対向車線の停止線に基づいて車両の位置を正確に検出することが可能となる。
また、車両に設置されたバックカメラ19より撮像した画像に基づいて車両が走行する道路上に存在する地物を検出するので、既存のシステムに用いられるバックカメラ19を流用して車両の周囲にある地物を検出することが可能となる。その結果、地物を検出する為の新たな手段やシステムを設けることなく、当該システムを実現することが可能となる。
【0100】
尚、本発明は前記実施形態に限定されるものではなく、本発明の要旨を逸脱しない範囲内で種々の改良、変形が可能であることは勿論である。
例えば、本実施形態ではバックカメラ19により撮像した画像を用いて地物を検出する構成としているが、他の手段により地物を検出する構成としても良い。
【0101】
また、本実施形態では、車両が分岐点を直進して通過する場合に検出した分岐点の地物の配置パターンに基づいて車両の現在位置を検出(補正)する構成としているが、右左折して通過する場合に検出した分岐点の地物の配置パターンに基づいて車両の現在位置を検出(補正)する構成としても良い。
【0102】
また、本実施形態では、進入側配置パターンとして(A)〜(D)のパターンを規定し、退出側配置パターンとして(E)のパターンを規定し、両側配置パターンとして(F)のパターンを規定しているが、上記(A)〜(F)以外のパターンを規定しても良い。また、検出配置パターンが上記(A)〜(F)の配置パターンと完全に一致する場合に加えて一部のみ一致する場合であっても、分岐点の周辺に設けられた地物又は分岐点のノードとの相対位置に基づいて車両の位置を検出する(S18、S19、S22)構成としても良い。
【0103】
また、本実施形態では地物として停止線に関する情報のみを地物データ38としてDB化する構成としているが、停止線以外の地物に関する情報についてもDB化しても良い。その場合には、停止線以外の地物との相対位置によって車両の詳細な現在位置を検出することも可能である。
【0104】
また、本実施形態では分岐点周辺の地物の配置パターンとして、停止線、横断歩道、自転車横断帯、車線境界線の配置パターンを検出する構成としているが、他の地物を含む配置パターンを検出する構成としても良い。例えば、信号機、矢印の路面標示等を含む配置パターンを検出する構成としても良い。
【0105】
また、本発明はナビゲーション装置以外に、移動体の位置を検出する機能を有する装置に対して適用することが可能である。例えば、携帯電話機やPDA等の携帯端末、パーソナルコンピュータ、携帯型音楽プレイヤ等(以下、携帯端末等という)に適用することも可能である。また、サーバと携帯端末等から構成されるシステムに対しても適用することが可能となる。その場合には、上述した分岐点案内処理プログラム(図3)や車両位置検出処理プログラム(図5)の各ステップは、サーバと携帯端末等のいずれが実施する構成としても良い。また、本発明を携帯端末等に適用する場合には、車両以外の移動体、例えば、携帯端末等のユーザや2輪車等の現在位置を検出する場合もある。
【符号の説明】
【0106】
1 ナビゲーション装置
13 ナビゲーションECU
19 バックカメラ
31 地図情報DB
38 地物データ
41 CPU
42 RAM
43 ROM
71 車線境界線
72 停止線
73 横断歩道
74 自転車横断帯
75 車両
【特許請求の範囲】
【請求項1】
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得手段と、
分岐点を前記移動体が通過することを検出する分岐点通過検出手段と、
前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致するか否か判定する一致判定手段と、
前記一致判定手段により前記検出配置パターンが前記進入側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物又は前記分岐点のノードとの相対位置に基づいて前記移動体の位置を特定する位置特定手段と、を有することを特徴とする移動体位置検出システム。
【請求項2】
前記位置特定手段は、前記検出配置パターンが停止線を含む地物の配置パターンである場合に、該停止線との相対位置によって前記移動体の位置を特定することを特徴とする請求項1に記載の移動体位置検出システム。
【請求項3】
前記位置特定手段は、前記検出配置パターンが停止線を含まない地物の配置パターンである場合に、前記分岐点のノードとの相対位置によって前記移動体の位置を特定することを特徴とする請求項1又は請求項2に記載の移動体位置検出システム。
【請求項4】
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得手段と、
分岐点を前記移動体が通過することを検出する分岐点通過検出手段と、
前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致するか否か判定する退出側一致判定手段と、
前記退出側一致判定手段により前記検出配置パターンが前記退出側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する退出側位置特定手段と、を有することを特徴とする移動体位置検出システム。
【請求項5】
前記検出配置パターンは横断歩道を含む地物の配置パターンであって、
前記退出側位置特定手段は、前記移動体の移動する道路上において検出された前記横断歩道に対応して前記移動体が移動する車線の対向車線の路面上に設けられた停止線との相対位置によって前記移動体の位置を特定することを特徴とする請求項4に記載の移動体位置検出システム。
【請求項6】
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得手段と、
分岐点を前記移動体が通過することを検出する分岐点通過検出手段と、
前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致するか否か判定する両側一致判定手段と、
前記両側一致判定手段により前記検出配置パターンが前記両側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する両側位置特定手段と、を有することを特徴とする移動体位置検出システム。
【請求項7】
前記検出配置パターンは退出道路上の横断歩道を含む地物の配置パターンであって、
前記両側位置特定手段は、前記移動体の移動する道路上において検出された前記退出道路上の横断歩道に対応して前記移動体が移動する車線の対向車線の路面上に設けられた停止線との相対位置によって前記移動体の位置を特定することを特徴とする請求項6に記載の移動体位置検出システム。
【請求項8】
前記地物検出結果取得手段は、前記移動体に設置された撮像手段より撮像した画像に基づいて前記移動体が移動する道路上に存在する地物を検出した検出結果を取得することを特徴とする請求項1乃至請求項7のいずれかに記載の移動体位置検出システム。
【請求項9】
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得手段と、
分岐点を前記移動体が通過することを検出する分岐点通過検出手段と、
前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致するか否か判定する一致判定手段と、
前記一致判定手段により前記検出配置パターンが前記進入側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物又は前記分岐点のノードとの相対位置によって前記移動体の位置を特定する位置特定手段と、を有することを特徴とする移動体位置検出装置。
【請求項10】
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得ステップと、
分岐点を前記移動体が通過することを検出する分岐点通過検出ステップと、
前記分岐点通過ステップによって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得ステップにより取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致するか否か判定する一致判定ステップと、
前記一致判定ステップにより前記検出配置パターンが前記進入側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物又は前記分岐点のノードとの相対位置によって前記移動体の位置を特定する位置特定ステップと、を有することを特徴とする移動体位置検出方法。
【請求項11】
コンピュータに、
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得機能と、
分岐点を前記移動体が通過することを検出する分岐点通過検出機能と、
前記分岐点通過機能によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得機能により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致するか否か判定する一致判定機能と、
前記一致判定機能により前記検出配置パターンが前記進入側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物又は前記分岐点のノードとの相対位置によって前記移動体の位置を特定する位置特定機能と、
を実行させることを特徴とするコンピュータプログラム。
【請求項12】
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得手段と、
分岐点を前記移動体が通過することを検出する分岐点通過検出手段と、
前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致するか否か判定する退出側一致判定手段と、
前記退出側一致判定手段により前記検出配置パターンが前記退出側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する退出側位置特定手段と、を有することを特徴とする移動体位置検出装置。
【請求項13】
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得ステップと、
分岐点を前記移動体が通過することを検出する分岐点通過検出ステップと、
前記分岐点通過ステップによって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得ステップにより取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致するか否か判定する退出側一致判定ステップと、
前記退出側一致判定ステップにより前記検出配置パターンが前記退出側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する退出側位置特定ステップと、を有することを特徴とする移動体位置検出方法。
【請求項14】
コンピュータに、
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得機能と、
分岐点を前記移動体が通過することを検出する分岐点通過検出機能と、
前記分岐点通過機能によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得機能により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致するか否か判定する退出側一致判定機能と、
前記退出側一致判定機能により前記検出配置パターンが前記退出側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する退出側位置特定機能と、
を実行させることを特徴とするコンピュータプログラム。
【請求項15】
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得手段と、
分岐点を前記移動体が通過することを検出する分岐点通過検出手段と、
前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致するか否か判定する両側一致判定手段と、
前記両側一致判定手段により前記検出配置パターンが前記両側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する両側位置特定手段と、を有することを特徴とする移動体位置検出装置。
【請求項16】
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得ステップと、
分岐点を前記移動体が通過することを検出する分岐点通過検出ステップと、
前記分岐点通過ステップによって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得ステップにより取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致するか否か判定する両側一致判定ステップと、
前記両側一致判定ステップにより前記検出配置パターンが前記両側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する両側位置特定ステップと、を有することを特徴とする移動体位置検出方法。
【請求項17】
コンピュータに、
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得機能と、
分岐点を前記移動体が通過することを検出する分岐点通過検出機能と、
前記分岐点通過機能によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得機能により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致するか否か判定する両側一致判定機能と、
前記両側一致判定機能により前記検出配置パターンが前記両側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する両側位置特定機能と、
を実行させることを特徴とするコンピュータプログラム。
【請求項1】
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得手段と、
分岐点を前記移動体が通過することを検出する分岐点通過検出手段と、
前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致するか否か判定する一致判定手段と、
前記一致判定手段により前記検出配置パターンが前記進入側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物又は前記分岐点のノードとの相対位置に基づいて前記移動体の位置を特定する位置特定手段と、を有することを特徴とする移動体位置検出システム。
【請求項2】
前記位置特定手段は、前記検出配置パターンが停止線を含む地物の配置パターンである場合に、該停止線との相対位置によって前記移動体の位置を特定することを特徴とする請求項1に記載の移動体位置検出システム。
【請求項3】
前記位置特定手段は、前記検出配置パターンが停止線を含まない地物の配置パターンである場合に、前記分岐点のノードとの相対位置によって前記移動体の位置を特定することを特徴とする請求項1又は請求項2に記載の移動体位置検出システム。
【請求項4】
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得手段と、
分岐点を前記移動体が通過することを検出する分岐点通過検出手段と、
前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致するか否か判定する退出側一致判定手段と、
前記退出側一致判定手段により前記検出配置パターンが前記退出側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する退出側位置特定手段と、を有することを特徴とする移動体位置検出システム。
【請求項5】
前記検出配置パターンは横断歩道を含む地物の配置パターンであって、
前記退出側位置特定手段は、前記移動体の移動する道路上において検出された前記横断歩道に対応して前記移動体が移動する車線の対向車線の路面上に設けられた停止線との相対位置によって前記移動体の位置を特定することを特徴とする請求項4に記載の移動体位置検出システム。
【請求項6】
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得手段と、
分岐点を前記移動体が通過することを検出する分岐点通過検出手段と、
前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致するか否か判定する両側一致判定手段と、
前記両側一致判定手段により前記検出配置パターンが前記両側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する両側位置特定手段と、を有することを特徴とする移動体位置検出システム。
【請求項7】
前記検出配置パターンは退出道路上の横断歩道を含む地物の配置パターンであって、
前記両側位置特定手段は、前記移動体の移動する道路上において検出された前記退出道路上の横断歩道に対応して前記移動体が移動する車線の対向車線の路面上に設けられた停止線との相対位置によって前記移動体の位置を特定することを特徴とする請求項6に記載の移動体位置検出システム。
【請求項8】
前記地物検出結果取得手段は、前記移動体に設置された撮像手段より撮像した画像に基づいて前記移動体が移動する道路上に存在する地物を検出した検出結果を取得することを特徴とする請求項1乃至請求項7のいずれかに記載の移動体位置検出システム。
【請求項9】
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得手段と、
分岐点を前記移動体が通過することを検出する分岐点通過検出手段と、
前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致するか否か判定する一致判定手段と、
前記一致判定手段により前記検出配置パターンが前記進入側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物又は前記分岐点のノードとの相対位置によって前記移動体の位置を特定する位置特定手段と、を有することを特徴とする移動体位置検出装置。
【請求項10】
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得ステップと、
分岐点を前記移動体が通過することを検出する分岐点通過検出ステップと、
前記分岐点通過ステップによって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得ステップにより取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致するか否か判定する一致判定ステップと、
前記一致判定ステップにより前記検出配置パターンが前記進入側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物又は前記分岐点のノードとの相対位置によって前記移動体の位置を特定する位置特定ステップと、を有することを特徴とする移動体位置検出方法。
【請求項11】
コンピュータに、
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得機能と、
分岐点を前記移動体が通過することを検出する分岐点通過検出機能と、
前記分岐点通過機能によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得機能により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物の配置パターンである進入側配置パターンと一致するか否か判定する一致判定機能と、
前記一致判定機能により前記検出配置パターンが前記進入側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物又は前記分岐点のノードとの相対位置によって前記移動体の位置を特定する位置特定機能と、
を実行させることを特徴とするコンピュータプログラム。
【請求項12】
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得手段と、
分岐点を前記移動体が通過することを検出する分岐点通過検出手段と、
前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致するか否か判定する退出側一致判定手段と、
前記退出側一致判定手段により前記検出配置パターンが前記退出側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する退出側位置特定手段と、を有することを特徴とする移動体位置検出装置。
【請求項13】
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得ステップと、
分岐点を前記移動体が通過することを検出する分岐点通過検出ステップと、
前記分岐点通過ステップによって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得ステップにより取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致するか否か判定する退出側一致判定ステップと、
前記退出側一致判定ステップにより前記検出配置パターンが前記退出側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する退出側位置特定ステップと、を有することを特徴とする移動体位置検出方法。
【請求項14】
コンピュータに、
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得機能と、
分岐点を前記移動体が通過することを検出する分岐点通過検出機能と、
前記分岐点通過機能によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得機能により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点から退出する退出道路上に設けられた地物の配置パターンである退出側配置パターンと一致するか否か判定する退出側一致判定機能と、
前記退出側一致判定機能により前記検出配置パターンが前記退出側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する退出側位置特定機能と、
を実行させることを特徴とするコンピュータプログラム。
【請求項15】
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得手段と、
分岐点を前記移動体が通過することを検出する分岐点通過検出手段と、
前記分岐点通過手段によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得手段により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致するか否か判定する両側一致判定手段と、
前記両側一致判定手段により前記検出配置パターンが前記両側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する両側位置特定手段と、を有することを特徴とする移動体位置検出装置。
【請求項16】
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得ステップと、
分岐点を前記移動体が通過することを検出する分岐点通過検出ステップと、
前記分岐点通過ステップによって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得ステップにより取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致するか否か判定する両側一致判定ステップと、
前記両側一致判定ステップにより前記検出配置パターンが前記両側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する両側位置特定ステップと、を有することを特徴とする移動体位置検出方法。
【請求項17】
コンピュータに、
移動体が移動する道路上に存在する地物を検出した検出結果を取得する地物検出結果取得機能と、
分岐点を前記移動体が通過することを検出する分岐点通過検出機能と、
前記分岐点通過機能によって前記移動体が前記分岐点を通過することを検出した場合に、前記地物検出結果取得機能により取得された検出結果に基づいて、前記移動体の移動する道路上において検出された地物の配置パターンである検出配置パターンが、分岐点へ進入する進入道路上に設けられた地物及び分岐点から退出する退出道路上に設けられた地物の配置パターンである両側配置パターンと一致するか否か判定する両側一致判定機能と、
前記両側一致判定機能により前記検出配置パターンが前記両側配置パターンと一致すると判定された場合に、前記分岐点の周辺に設けられた地物との相対位置によって前記移動体の位置を特定する両側位置特定機能と、
を実行させることを特徴とするコンピュータプログラム。
【図1】
【図2】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】
【図9】
【図10】
【図11】
【図12】
【図13】
【図14】
【図15】
【図16】
【図17】
【図2】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】
【図9】
【図10】
【図11】
【図12】
【図13】
【図14】
【図15】
【図16】
【図17】
【公開番号】特開2013−72792(P2013−72792A)
【公開日】平成25年4月22日(2013.4.22)
【国際特許分類】
【出願番号】特願2011−213067(P2011−213067)
【出願日】平成23年9月28日(2011.9.28)
【出願人】(000100768)アイシン・エィ・ダブリュ株式会社 (3,717)
【Fターム(参考)】
【公開日】平成25年4月22日(2013.4.22)
【国際特許分類】
【出願日】平成23年9月28日(2011.9.28)
【出願人】(000100768)アイシン・エィ・ダブリュ株式会社 (3,717)
【Fターム(参考)】
[ Back to top ]