曲率半径算定装置、曲率半径算定方法、及び曲率半径算定プログラム
【課題】各形状補間点が実際の道路形状に合致する位置に設定されていない場合であっても、曲率半径の算定精度を向上させることができる、曲率半径算定装置、曲率半径算定方法、及び曲率半径算定プログラムを提供すること。
【解決手段】曲率半径算定装置５０は、地図情報ＤＢ５２ａと、形状補間点情報を取得する形状補間点情報取得部５１ａと、曲率半径の算定の対象とするコーナー区間を検出するコーナー区間検出部５１ｂと、形状補間点の相互間の距離に基づいて基準距離を設定する基準距離設定部５１ｃと、コーナー区間の仮の曲率半径を算定する仮曲率半径算定部５１ｄと、コーナー区間の道路種別と仮の曲率半径とに基づいて補正係数を特定する補正係数特定部５１ｅと、補正係数と基準距離とに基づいて３点の形状補間点を抽出する形状補間点抽出部５１ｆと、３点の形状補間点に基づいてコーナー区間の曲率半径を算定する曲率半径算定部５１ｇとを備える。
【解決手段】曲率半径算定装置５０は、地図情報ＤＢ５２ａと、形状補間点情報を取得する形状補間点情報取得部５１ａと、曲率半径の算定の対象とするコーナー区間を検出するコーナー区間検出部５１ｂと、形状補間点の相互間の距離に基づいて基準距離を設定する基準距離設定部５１ｃと、コーナー区間の仮の曲率半径を算定する仮曲率半径算定部５１ｄと、コーナー区間の道路種別と仮の曲率半径とに基づいて補正係数を特定する補正係数特定部５１ｅと、補正係数と基準距離とに基づいて３点の形状補間点を抽出する形状補間点抽出部５１ｆと、３点の形状補間点に基づいてコーナー区間の曲率半径を算定する曲率半径算定部５１ｇとを備える。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、曲率半径算定装置、曲率半径算定方法、及び曲率半径算定プログラムに関する。
【背景技術】
【０００２】
従来、カーナビゲーション装置には、車両が走行する際に走行経路の道路形状に応じた各種の運転支援等を行うため、道路形状を推定するための道路形状推定装置が組み込まれている。この道路形状推定装置は、地図情報データベースを備えており、この地図情報データベースには、道路形状を複数の点で表すために設定された形状補間点が記憶されている。そして、道路形状推定装置は、道路形状の推定対象となっている道路に設定された形状補間点の中で、互いに隣接する３つの形状補間点を用いて道路の曲率半径を算出し、当該算出した曲率半径に基づいてクロソイドフィッティング処理を行うことで、道路形状を推定していた（例えば、特許文献１参照。）。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開２００５−２１４８３９号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
しかしながら、互いに隣接する３つの形状補間点を用いて道路の曲率半径を算出する場合、これら各形状補間点が実際の道路形状に合致する位置に設定されている場合には、道路の曲率半径を正しく算出することができるが、現実的には、各形状補間点が実際の道路形状に合致する位置に設定されていない場合があり、この場合には、道路の曲率半径の算出精度が低下する可能性があった。
【０００５】
本発明は、上記に鑑みてなされたものであって、各形状補間点が実際の道路形状に合致する位置に設定されていない場合であっても、道路の曲率半径の算出精度を向上させることができる、曲率半径算定装置、曲率半径算定方法、及び曲率半径算定プログラムを提供することを目的とする。
【課題を解決するための手段】
【０００６】
上述した課題を解決し、目的を達成するために、請求項１に記載の曲率半径算定装置は、道路種別を含む地図情報を格納する地図情報格納手段と、道路に沿って設定された複数の形状補間点の各々の位置を特定する形状補間点情報を取得する形状補間点情報取得手段と、前記形状補間点情報取得手段にて取得された形状補間点情報に基づいて、曲率半径の算定の対象とするコーナー区間を検出するコーナー区間検出手段と、前記形状補間点情報取得手段にて取得された形状補間点情報に基づいて、前記コーナー区間検出手段にて検出されたコーナー区間に含まれる複数の形状補間点の相互間の距離を算定し、当該算定した距離に基づいて基準距離を設定する基準距離設定手段と、前記形状補間点情報取得手段にて取得された形状補間点情報に基づいて、前記コーナー区間に含まれる３つの形状補間点を抽出し、当該抽出した３つの形状補間点に基づいて、当該コーナー区間の仮の曲率半径を算定する仮曲率半径算定手段と、前記地図情報格納手段にて格納された地図情報から取得した前記コーナー区間の道路種別と、前記仮曲率半径算定手段にて算定された仮の曲率半径とに基づいて、前記基準距離設定手段にて設定された基準距離を補正するための補正係数を特定する補正係数特定手段と、前記補正係数特定手段にて特定された補正係数と、前記基準距離設定手段にて設定された基準距離とに基づいて、前記コーナー区間に含まれる形状補間点の中から取得すべき３点の形状補間点の相互間距離を算定し、当該算定された相互間距離だけ相互に離れた３点を前記コーナー区間に含まれる形状補間点の中から抽出する形状補間点抽出手段と、前記形状補間点抽出手段にて抽出された３点の形状補間点に基づいて、前記コーナー区間の曲率半径を算定する曲率半径算定手段とを備える。
【０００７】
請求項２に記載の曲率半径算定装置は、請求項１に記載の曲率半径算定装置において、前記基準距離設定手段は、前記コーナー区間に含まれる形状補間点の相互間の平均距離を算定し、当該算定した平均距離を前記基準距離として設定する。
【０００８】
請求項３に記載の曲率半径算定装置は、請求項１又は２に記載の曲率半径算定装置において、前記補正係数を道路の種別毎及び道路の曲率半径毎に格納する補正係数格納手段を備え、前記補正係数特定手段は、前記地図情報格納手段にて格納された地図情報から取得した前記コーナー区間の道路種別と、前記仮曲率半径算定手段にて算定された仮の曲率半径とに対応する補正係数を、前記補正係数格納手段から取得する。
【０００９】
請求項４に記載の曲率半径算定方法は、道路に沿って設定された複数の形状補間点の各々の位置を特定する形状補間点情報を取得する形状補間点情報取得ステップと、前記形状補間点情報取得ステップにて取得された形状補間点情報に基づいて、曲率半径の算定の対象とするコーナー区間を検出するコーナー区間検出ステップと、前記形状補間点情報取得ステップにて取得された形状補間点情報に基づいて、前記コーナー区間検出ステップにて検出されたコーナー区間に含まれる複数の形状補間点の相互間の距離を算定し、当該算定した距離に基づいて基準距離を設定する基準距離設定ステップと、前記形状補間点情報取得ステップにて取得された形状補間点情報に基づいて、前記コーナー区間に含まれる３つの形状補間点を抽出し、当該抽出した３つの形状補間点に基づいて、当該コーナー区間の仮の曲率半径を算定する仮曲率半径算定ステップと、道路種別を含む地図情報を格納する地図情報格納手段から取得した前記コーナー区間の道路種別と、前記仮曲率半径算定ステップにて算定された仮の曲率半径とに基づいて、前記基準距離設定ステップにて設定された基準距離を補正するための補正係数を特定する補正係数特定ステップと、前記補正係数特定ステップにて特定された補正係数と、前記基準距離設定ステップにて設定された基準距離とに基づいて、前記コーナー区間に含まれる形状補間点の中から取得すべき３点の形状補間点の相互間距離を算定し、当該算定された相互間距離だけ相互に離れた３点を前記コーナー区間に含まれる形状補間点の中から抽出する形状補間点抽出ステップと、前記形状補間点抽出ステップにて抽出された３点の形状補間点に基づいて、前記コーナー区間の曲率半径を算定する曲率半径算定ステップとを含む。
【００１０】
請求項５に記載の曲率半径算定プログラムは、請求項４に記載の方法をコンピュータに実行させる。
【発明の効果】
【００１１】
請求項１に記載の曲率半径算定装置、請求項４に記載の曲率半径算定方法、及び請求項５に記載の曲率半径算定プログラムによれば、コーナー区間の道路種別と仮の曲率半径とに基づいて補正係数を特定し、この補正係数と基準距離とに基づいて３点の形状補間点の相互間距離を算定し、この相互間距離だけ相互に離れた３つの形状補間点を用いてコーナー区間の曲率半径を算定するので、コーナー区間の道路種別と曲率半径に応じた距離だけ離れた形状補間点を用いてコーナー区間の形状を推定することができ、形状補間点が実際の道路形状に合致する位置に設定されていない場合であっても、曲率半径の算定精度を向上させることができる。
【００１２】
請求項２に記載の曲率半径算定装置によれば、複数の形状補間点の相互間の平均距離を算定し、当該算定した平均距離を基準距離として設定するので、複数の形状補間点の代表的な距離を基準距離とし、この基準距離に基づいて３点の形状補間点の相互間距離が算定されるので、曲率半径の算定精度を向上させることができる。
【００１３】
請求項３に記載の曲率半径算定装置置によれば、コーナー区間の道路種別と仮の曲率半径とに対応する補正係数が取得されるので、形状推定の対象になり得る各道路の種別と曲率半径に応じて補正係数を設定しておくことで、道路種別と曲率半径に応じて適切な相互間距離を算定することが可能となる。
【図面の簡単な説明】
【００１４】
【図１】本実施の形態に係るカーナビゲーションシステムを例示するブロック図である。
【図２】補正係数テーブルを例示する図である。
【図３】道路形状推定処理のフローチャートである。
【図４】道路形状推定処理による推定結果を示す図であり、（ａ）は従来の道路形状推定結果を示す図、（ｂ）は本発明の実施の形態による道路形状推定結果を示す図である。
【発明を実施するための形態】
【００１５】
以下、本発明に係る曲率半径算定装置、曲率半径算定方法、及び曲率半径算定プログラムの実施の形態について図面を参照しつつ詳細に説明する。ただし、この実施の形態によって本発明が限定されるものではない。なお、なお、本発明に係る曲率半径算定装置、曲率半径算定方法、及び曲率半径算定プログラムは、任意の目的に使用することができるが、この実施の形態では、カーナビゲーションシステムにおける道路形状の推定に適用した例を示す。
【００１６】
（構成）
まず、本実施の形態に係るカーナビゲーションシステムの構成を説明する。図１は、本実施の形態に係るカーナビゲーションシステムを例示するブロック図である。図１に示すように、カーナビゲーションシステム１は、現在位置検出処理部１０、車速センサ２０、ディスプレイ３０、スピーカ４０、及び曲率半径算定装置５０を備えている。
【００１７】
（構成−現在位置検出処理部）
現在位置検出処理部１０は、カーナビゲーションシステム１が取り付けられた車両（以下、自車両）の現在位置を検出する現在位置検出手段である。具体的には、現在位置検出処理部１０は、ＧＰＳ、地磁気センサ、距離センサ、又はジャイロセンサ（いずれも図示省略）の少なくとも一つを有し、現在の自車両の位置（座標）及び方位等を公知の方法にて検出する。
【００１８】
（構成−車速センサ）
車速センサ２０は、自車両の車輪の回転速度等を曲率半径算定装置５０に出力するものであり、公知の車速センサを用いることができる。
【００１９】
（構成−ディスプレイ）
ディスプレイ３０は、曲率半径算定装置５０によって案内された画像を表示する表示手段である。ディスプレイ３０の具体的な構成は任意であり、公知の液晶ディスプレイや有機ＥＬディスプレイの如きフラットパネルディスプレイを使用することができる。
【００２０】
（構成−スピーカ）
スピーカ４０は、曲率半径算定装置５０の制御に基づいて各種の音声を出力する出力手段である。スピーカ４０より出力される音声の具体的な態様は任意であり、必要に応じて生成された合成音声や、予め録音された音声を出力することができる。
【００２１】
（構成−曲率半径算定装置）
曲率半径算定装置５０は、曲率半径の算定を行う曲率半径算定手段であり、制御部５１及びデータ記録部５２を備えている。
【００２２】
（構成−曲率半径算定装置−制御部）
制御部５１は、曲率半径算定装置５０を制御する制御手段であり、具体的には、ＣＰＵ、当該ＣＰＵ上で解釈実行される各種のプログラム（ＯＳなどの基本制御プログラムや、ＯＳ上で起動され特定機能を実現するアプリケーションプログラムを含む）、及びプログラムや各種のデータを格納するためのＲＡＭの如き内部メモリを備えて構成されるコンピュータである。特に、本実施の形態に係る曲率半径算定プログラムは、任意の記録媒体又はネットワークを介して曲率半径算定装置５０にインストールされることで、制御部５１の各部を実質的に構成する。
【００２３】
この制御部５１は、機能概念的に、形状補間点情報取得部５１ａ、コーナー区間検出部５１ｂ、基準距離設定部５１ｃ、仮曲率半径算定部５１ｄ、補正係数特定部５１ｅ、形状補間点抽出部５１ｆ、及び曲率半径算定部５１ｇを備える。形状補間点情報取得部５１ａは、道路に沿って設定された複数の形状補間点の各々の位置を特定する形状補間点情報を取得する形状補間点情報取得手段である。コーナー区間検出部５１ｂは、形状補間点情報取得部５１ａにて取得された形状補間点情報に基づいて、曲率半径の算定の対象とするコーナー区間を検出するコーナー区間検出手段である。基準距離設定部５１ｃは、形状補間点情報取得部５１ａにて取得された形状補間点情報に基づいて、コーナー区間検出部５１ｂにて検出されたコーナー区間に含まれる複数の形状補間点の相互間の距離を算定し、当該算定した距離に基づいて基準距離を設定する基準距離設定手段である。仮曲率半径算定部５１ｄは、形状補間点情報取得部５１ａにて取得された形状補間点情報に基づいて、コーナー区間に含まれる３つの形状補間点を抽出し、当該抽出した３つの形状補間点に基づいて、当該コーナー区間の仮の曲率半径を算定する仮曲率半径算定手段である。補正係数特定部５１ｅは、後述する地図情報ＤＢ５２ａにて格納された地図情報から取得したコーナー区間の道路種別と、仮曲率半径算定部５１ｄにて算定された仮の曲率半径とに基づいて、基準距離設定部５１ｃにて設定された基準距離を補正するための補正係数を特定する補正係数特定手段である。形状補間点抽出部５１ｆは、補正係数特定部５１ｅにて特定された補正係数と、基準距離設定部５１ｃにて設定された基準距離とに基づいて、コーナー区間に含まれる形状補間点の中から取得すべき３点の形状補間点の相互間距離を算定し、当該算定された相互間距離だけ相互に離れた３点をコーナー区間に含まれる形状補間点の中から抽出する形状補間点抽出手段である。曲率半径算定部５１ｇは、形状補間点抽出部５１ｆにて抽出された３点の形状補間点に基づいて、コーナー区間の曲率半径を算定する曲率半径算定手段である。これらの制御部５１の各構成要素によって実行される処理の詳細については後述する。また、補正係数、基準距離、及び仮の曲率半径についても後述する。
【００２４】
（構成−曲率半径算定装置−データ記録部）
図１において、データ記録部５２は、曲率半径算定装置５０の動作に必要なプログラム及び各種のデータを記録する記録手段であり、例えば、外部記録装置としてのハードディスク（図示省略）を用いて構成されている。ただし、ハードディスクに代えてあるいはハードディスクと共に、磁気ディスクの如き磁気的記録媒体、又はＤＶＤやブルーレイディスクの如き光学的記録媒体を含む、その他の任意の記録媒体を用いることができる。
【００２５】
このデータ記録部５２は、地図情報データベース（以下、データベースを「ＤＢ」と称する）５２ａと補正係数テーブル５２ｂを備えている。地図情報ＤＢ５２ａは、地図情報を格納する地図情報格納手段である。「地図情報」とは、交差点や一時停止地点を含む各種の位置の特定に必要な情報であり、例えば、交差点データ（交差点座標等）や、地図をディスプレイ３０に表示するための地図表示データ等を含んで構成されている。また、地図情報には、各道路の道路種別（高速道路、一般道、細街路、山岳路等）、各道路の始点から終点までの道路リンクを表すデータ、及び道路リンク上において道路形状を表すために道路に略沿って設定された形状補間点のデータ（以下、形状補間点データ）が含まれる。形状補間点データには、各形状補間点の番号及び座標等が含まれる。なお、各ノードは、道路リンク上の始点又は終点を表すものであるため、形状補間点としても機能する。
【００２６】
補正係数テーブル５２ｂは、補正係数を道路の種別毎及び道路の曲率半径毎に格納する補正係数格納手段である。この補正係数テーブル５２ｂを図２に例示する。この図２に示すように、補正係数テーブル５２ｂは、項目「道路の曲率半径」と項目「道路種別」を含んでおり、項目「道路種別」は、さらに項目「高速道路」、項目「一般道」、項目「細街路、山岳路」を含んでいる。項目「道路の曲率半径」に対応する情報としては、「０〜１００未満」、「１００〜２００未満」、「２００〜３００未満」、「３００〜４００未満」、「４００〜５００未満」、「５００以上」が格納されており、項目「高速道路」、項目「一般道」、項目「細街路又は山岳路」に対応する情報としては、補正係数Ｓ１〜Ｓ３のいずれか、あるいは当該補正係数Ｓ１〜Ｓ３に数値を乗算したものが格納されている。
【００２７】
ここで、補正係数について説明する。本実施の形態では、概略的に、道路形状を推定する際、３点の形状補間点を用いたクロソイドフィッティング処理を行う。ただし、従来のように相互に隣接した３点の形状補間点に限定せず、必要に応じて、相互に一定な距離だけ隔てて配置された３点の形状補間点を抽出して使用する。ただし、一定な距離とは、厳密に同一な距離を意味するものではなく、同一とみなせる程度のある程度幅をもった距離を意味する。以下、この距離を「抽出距離」と称する。
【００２８】
この抽出距離は、「基準距離」に「補正係数」を乗じることで算定する。「基準距離」とは、抽出距離を算定するための基礎となる距離である。以下の説明では、基準距離として「平均距離」を用いた例について説明する。平均距離とは、曲率半径の算定の対象になるコーナー区間に含まれる形状補間点を対象として算定された距離であって、相互に隣接する形状補間点の各距離の平均である。「補正係数」とは、基準距離を補正して抽出距離を算定するための係数である。この補正係数は、道路の種別と、道路の曲率半径とに基づいて、補正係数テーブル５２ｂに予め設定されている。この補正係数の概略的な設定方針としては、例えば、上述のように基準距離として平均距離を用いた場合において、道路種別＝高速道路である場合には、形状補間点が比較的長い距離を隔てて配置されており、相互に隣接する３点の形状補間点を用いて曲率半径を算定しても実際の道路の曲率半径との間でずれが生じる可能性は低いと考えられることから、平均距離に近い距離を抽出距離として設定することができるので、補正係数を比較的小さくする（例えば１に近い係数とする）。一方、道路種別＝細街路又は山岳路である場合には、形状補間点が比較的間短い距離を隔てて配置されており、相互に隣接する３点の形状補間点を用いて曲率半径を算定すると実際の道路の曲率半径との間でずれが生じる可能性があると考えられることから、平均距離よりも長い距離を抽出距離として設定することが好ましいため、補正係数を比較的大きくする（例えば１より大きい係数とする）。また、道路の曲率半径に関して、道路の曲率半径が小さい場合には、比較的近い形状補間点を使用してもコーナーを直線と推定してしまう可能性が低いため、抽出距離を短くするため、補正係数を比較的小さくし（あるいは１とし）、道路の曲率半径が大きい場合には、比較的近い形状補間点を使用するとコーナーを直線と推定してしまうことで推定精度が低下する可能性があるため、道路の曲率半径が小さい場合に比べて抽出距離を長くするため、補正係数を比較的大きくする。なお、このように、補正係数を決定する上で、道路の曲率半径を使用しているが、道路形状の推定が終了するまでは、最終的な曲率半径は特定することができない。このため、本実施の形態においては、補正係数を決定するために使用する暫定的な曲率半径を算定し、当該算定した暫定的な曲率半径を用いて補正係数を決定することとしている。このように暫定的に算定された曲率半径を、「仮の曲率半径」と称する。
【００２９】
このような設定方針に基づき、図２の補正係数テーブル５２ｂの内容が設定されている。すなわち、道路種別に関して、道路種別＝高速道路の場合にはパラメータ＝Ｓ３、道路種別＝一般道の場合にはパラメータ＝Ｓ２、道路種別＝細街路又は山岳路の場合にはパラメータ＝Ｓ１をそれぞれ用いるものとして、Ｓ３＜Ｓ２＜Ｓ１となるように、これらパラメータＳ１〜Ｓ３を決定している。この条件に合致する限りにおいて、パラメータの具体的数値は任意であるが、例えば、Ｓ３＝１．４、Ｓ２＝１．８、Ｓ１＝２．０として設定される。また、道路の曲率半径に関して、道路の曲率半径が大きい場合には、補正係数が大きくなるように、１．２又は１．５が乗算される。なお、この条件に合致する限りにおいて、これらの数値も任意に変更することができ、例えば、パラメータＳ１〜Ｓ３と同様に、各数値をパラメータとして設定することもできる。なお、道路種別＝一般道の場合であって、道路の曲率半径＝４００〜５００未満及び５００以上の場合と、道路種別＝細街路又は山岳路の場合であって、道路の曲率半径＝３００〜４００未満、４００〜５００未満、及び５００以上の場合は、対応する補正係数が設定されていない。この理由は、これらの各場合には、道路形状をコーナーであるとみなさない（直線とみなす）ことができる場合であり、補正係数による補正を行う必要性が低いためである。ただし、これらの各場合に対しても、補正係数を設定するようにしてもよい。
【００３０】
（処理）
次に、このように構成される曲率半径算定装置５０によって実行される道路形状推定処理について説明する。図３は、道路形状推定処理のフローチャートである（以下の各処理の説明ではステップを「Ｓ」と略記する）。この道路形状推定処理は、例えば、自車両の走行開始後に自動的に起動されて所定間隔で繰り返し実行される。
【００３１】
まず、制御部５１は、現在位置検出処理部１０から自車両の現在位置を取得する（ＳＡ１）。次いで、コーナー区間検出部５１ｂは、曲率半径の算定の対象とするコーナー区間を検出する（ＳＡ２）。具体的には、形状補間点情報取得部５１ａが、道路に沿って設定された複数の形状補間点の各々の位置を特定する形状補間点情報を取得し、当該取得された形状補間点情報に基づいて、コーナー区間検出部５１ｂが、曲率半径の算定の対象とするコーナー区間を検出する。例えば、形状補間点情報取得部５１ａは、ＳＡ１で取得した自車両の現在位置から、当該自車両の走行道路上における当該自車両の進行方向前方の所定範囲（例えば、１ｋｍ以内）を、推定対象範囲として設定し、地図情報ＤＢ５２ａに格納されている地図情報から、当該推定対象範囲内に含まれる全ての形状補間点を取得する。次いで、コーナー区間検出部５１ｂは、形状補間点情報取得部５１ａにて取得された全ての形状補間点を対象に、相互に隣接する３点の形状補間点の半径（以下、３点半径）と、相互に隣接する形状補間点同士を結ぶ線分の相互角度（屈曲角）をそれぞれ算定する。そして、３点半径が所定半径以下となる区間であって、屈曲角が所定角度以上であり、かつ、屈曲角が同一方向に形成される区間を、コーナー区間として特定する。また、コーナー区間検出部５１ｂは、当該特定したコーナー区間に含まれる形状補間点の中で、最も手前にある形状補間点を、当該特定したコーナー区間の開始候補点に設定し、最も奥にある形状補間点を、当該特定したコーナー区間の終了候補点として設定する。
【００３２】
次いで、制御部５１は、自車両の進行方向前方にコーナー区間があるか否かを判定する（ＳＡ３）。具体的には、制御部５１は、ＳＡ２でコーナー区間が検出された場合には、コーナー区間があると判定し、ＳＡ２でコーナー区間が検出されなかった場合には、コーナー区間がないと判定する。そして、コーナー区間がないと判定した場合（ＳＡ３、Ｎｏ）、制御部５１は、道路形状を推定する必要がないものとし、道路形状推定処理を終了する。
【００３３】
一方、コーナー区間があると判定した場合（ＳＡ３、Ｙｅｓ）、基準距離設定部５１ｃは、ＳＡ２で特定されたコーナー区間（以下、単にコーナー区間）の基準距離を算定する（ＳＡ４）。具体的には、基準距離設定部５１ｃは、ＳＡ２で取得したコーナー区間に含まれる形状補間点であって、開始候補点及び終了候補点と、開始候補点から終了候補点までの間に位置する形状補間点を対象として、相互に隣接する形状補間点の各距離を算定し、当該算定した各距離の平均距離を算定して、当該算定した平均距離を基準距離に設定する。
【００３４】
次いで、仮曲率半径算定部５１ｄは、コーナー区間の仮の曲率半径を算定する（ＳＡ５）。具体的には、仮曲率半径算定部５１ｄは、ＳＡ２で取得したコーナー区間に含まれる形状補間点の中から、３つの形状補間点を抽出し、当該抽出した３つの形状補間点の半径（以下、３点半径）を公知の３点計算法によって算定し、当該算定した半径を仮の曲率半径に設定する。ここで、３つの形状補間点の抽出方法は任意であり、いずれの形状補間点を抽出してもよい。ここでは、相互に隣接する３つの形状補間点を抽出する。この３つの形状補間点は、コーナー区間の形状を代表するような形状補間点を抽出することが好ましく、例えば、仮曲率半径算定部５１ｄは、ＳＡ３で取得した形状補間点の中で、最も中央寄りの位置において、相互に隣接する３つの形状補間点を抽出する。
【００３５】
その後、補正係数特定部５１ｅは、コーナー区間の道路種別を特定する（ＳＡ６）。具体的には、補正係数特定部５１ｅは、地図情報ＤＢ５２ａの地図情報を参照し、コーナー区間の道路種別を特定する。
【００３６】
次いで、補正係数特定部５１ｅは、補正係数を特定する（ＳＡ７）。具体的には、補正係数特定部５１ｅは、ＳＡ５で算定した仮の曲率半径と、ＳＡ６で特定したコーナー区間の道路種別とに対応する補正係数を、補正係数テーブル５２ｂから取得する。例えば、仮の曲率半径＝２５０ｍで、道路種別＝一般道である場合において、パラメータＳ２＝１．８の場合には、補正係数＝Ｓ２×１．２＝２．１６となる。
【００３７】
そして、形状補間点抽出部５１ｆは、コーナー区間の曲率半径を算定するために使用する形状補間点を抽出する（ＳＡ８）。具体的には、形状補間点抽出部５１ｆは、ＳＡ４で算定した基準距離に、ＳＡ７で特定した補正係数を乗じることで、抽出距離を算定する。例えば、基準距離＝２ｍで、補正係数＝２．１６の場合には、抽出距離＝４．３２ｍとなる。次いで、形状補間点抽出部５１ｆは、ＳＡ３で取得した形状補間点の中で、基準となる一つの形状補間点を特定し、当該特定した形状補間点と、当該特定した形状補間点に対して開始候補点側に抽出距離だけ離れた位置（以下、開始側位置）にある形状補間点と、当該特定した形状補間点に対して終了候補点側に抽出距離だけ離れた位置（以下、終了側位置）にある形状補間点とを、コーナー区間の曲率半径を算定するために使用する３つの形状補間点として特定する。ここで、基準となる一つの形状補間点としては、ＳＡ３で取得した形状補間点の中で、最も中央寄りの位置にある形状補間点を特定する。なお、開始側位置や終了側位置に形状補間点がない場合には、開始側位置に対して開始候補点側において最も近い位置にある形状補間点や、終了側位置対して終了候補点側において最も近い位置にある形状補間点を抽出する。
【００３８】
そして、曲率半径算定部５１ｇは、ＳＡ８で抽出された３つの形状補間点を用いて、当該３つの形状補間点の３点半径を公知の３点計算法によって算定する（ＳＡ９）。このことにより、コーナー区間の曲率半径を算定することができる。
【００３９】
最後に、制御部５１は、ＳＡ９で算定されたコーナー区間の曲率半径に基づいてクロソイドフィッティング処理を公知の方法で行うことで、コーナー区間の形状を推定する（ＳＡ１０）。これにて道路形状推定処理が終了する。
【００４０】
次に、このような道路形状推定処理を行う意義について説明する。図４は、道路形状推定処理による推定結果を示す図であり、（ａ）は従来の道路形状推定結果を示す図、（ｂ）は本実施の形態による道路形状推定結果を示す図である。この図４（ａ）（ｂ）には、形状補間点Ｐ１〜Ｐ６を示しており、特に、Ｐ４は、実際のコーナー区間の形状からのずれが大きい形状補間点であることを想定している。
【００４１】
ここで、図４（ａ）に示すように、従来は、相互に隣接する３つの形状補間点を用いて曲率半径の算定を行っていたので、例えば、このような３つの形状補間点として、ずれが大きい形状補間点Ｐ４を含む形状補間点Ｐ２〜Ｐ４を用いて３点計算法によりコーナー区間の曲率半径を算定した場合には、当該算定されたコーナー区間の曲率半径が実際のコーナー区間の曲率半径とは異なるものとなり、曲率半径の算定精度が低いものとなる。また、この結果、このように算定されたコーナー区間の曲率半径に基づいて推定された道路の形状が実際の道路の形状とは異なるものとなる。
【００４２】
これに対して、図４（ｂ）に示すように、本実施の形態では、抽出距離だけ離れた３つの形状補間点を用いて道路形状の推定を行うので、例えば、このような３つの形状補間点として、形状補間点Ｐ１、Ｐ３、Ｐ５を用いて３点計算法によりコーナー区間の曲率半径を算定することができ、曲率半径の算定精度が向上する。また、この結果、このように算定されたコーナー区間の曲率半径に基づいて推定された道路の形状が実際のコーナー区間の形状と近くなり、推定精度を向上させることができる。
【００４３】
（効果）
このように本実施の形態によれば、コーナー区間の道路種別と仮の曲率半径とに基づいて補正係数を特定し、この補正係数と基準距離とに基づいて３点の形状補間点の相互間距離を算定し、この相互間距離だけ相互に離れた３つの形状補間点を用いてコーナー区間の曲率半径を算定するので、コーナー区間の道路種別と曲率半径に応じた距離だけ離れた形状補間点を用いてコーナー区間の形状を推定することができ、形状補間点が実際の道路形状に合致する位置に設定されていない場合であっても、曲率半径の算定精度を向上させることができる。
【００４４】
また、複数の形状補間点の相互間の平均距離を算定し、当該算定した平均距離を基準距離として設定するので、複数の形状補間点の代表的な距離を基準距離とし、この基準距離に基づいて３点の形状補間点の相互間距離が算定されるので、曲率半径の算定精度を向上させることができる。
【００４５】
また、コーナー区間の道路種別と仮の曲率半径とに対応する補正係数が取得されるので、形状推定の対象になり得る各道路の種別と曲率半径に応じて補正係数を設定しておくことで、道路種別と曲率半径に応じて適切な相互間距離を算定することが可能となる。
【００４６】
〔実施の形態に対する変形例〕
以上、本発明に係る実施の形態について説明したが、本発明の具体的な構成及び手段は、特許請求の範囲に記載した各発明の技術的思想の範囲内において、任意に改変及び改良することができる。以下、このような変形例について説明する。
【００４７】
（解決しようとする課題や発明の効果について）
まず、発明が解決しようとする課題や発明の効果は、上述の内容に限定されるものではなく、発明の実施環境や構成の細部に応じて異なる可能性があり、上述した課題の一部のみを解決したり、上述した効果の一部のみを奏することがある。
【００４８】
（仮の曲率半径の算定について）
図３のＳＡ５において仮の曲率半径を算定するための３つの形状補間点の抽出方法としては、上記説明した方法以外にも、種々の方法を採用することができる。例えば、仮曲率半径算定部５１ｄは、屈曲角が最大となる形状補間点とその前後の形状補間点抽出する。あるいは、仮曲率半径算定部５１ｄは、屈曲角が最大となる形状補間点であって、かつ、前後の形状補間点における屈曲角との差が小さい形状補間点を特定し、当該形状補間点とその前後の形状補間点を抽出する。あるいは、仮曲率半径算定部５１ｄは、ＳＡ３で取得した形状補間点を対象に、相互に隣接する３つの形状補間点の全ての組み合わせを対象として３点半径を算定し、当該算定した３点半径の中で、一番小さく、かつ、前後の３点半径との差分が小さい３点半径を、仮の曲率半径としてもよい。
【００４９】
（抽出距離に基づく形状補間点の設定について）
図３のＳＡ８において抽出距離に基づいて３つの形状補間点を抽出する方法としては、上記説明した方法以外にも、種々の方法を採用することができる。例えば、形状補間点抽出部５１ｆは、コーナー区間の全ての形状補間点を対象とした３点半径の中で一番小さい３点半径の中心の形状補間点を、コーナー区間の曲率半径を算定するための３つの形状補間点の中の中心の形状補間点として設定し、当該形状補間点に対して抽出距離だけ離れた２つの形状補間点をさらに抽出するようにしてもよい。あるいは、形状補間点抽出部５１ｆは、最も中央寄りの位置にある形状補間点を特定した後、この形状補間点を基準として抽出距離だけ離れた開始側位置や終了側位置に形状補間点がない場合には、開始側位置や終了側位置に仮想の形状補間点を設定してもよい。仮想の形状補間点は、例えば、開始側位置や終了側位置の前後の形状補間点を特定し、当該特定した前後の形状補間点を結ぶ線分を設定し、当該線分上における開始側位置や終了側位置に対応する位置に設定することができる。また、形状補間点抽出部５１ｆは、最も中央寄りの位置にある形状補間点以外の形状補間点を基準として、他の２つの形状補間点を抽出してもよい。
【００５０】
（道路形状の推定について）
上記実施の形態では、コーナー区間の曲率半径が算定された後、当該算定された曲率半径に基づいてコーナー区間の形状を推定しているが、当該推定を行う処理は省略してもよい。
【符号の説明】
【００５１】
１ カーナビゲーションシステム
１０ 現在位置検出処理部
２０ 車速センサ
３０ ディスプレイ
４０ スピーカ
５０ 曲率半径算定装置
５１ 制御部
５１ａ 形状補間点情報取得部
５１ｂ コーナー区間検出部
５１ｃ 基準距離設定部
５１ｄ 仮曲率半径算定部
５１ｅ 補正係数特定部
５１ｆ 形状補間点抽出部
５１ｇ 曲率半径算定部
５２ データ記録部
５２ａ 地図情報ＤＢ
５２ｂ 補正係数テーブル
【技術分野】
【０００１】
本発明は、曲率半径算定装置、曲率半径算定方法、及び曲率半径算定プログラムに関する。
【背景技術】
【０００２】
従来、カーナビゲーション装置には、車両が走行する際に走行経路の道路形状に応じた各種の運転支援等を行うため、道路形状を推定するための道路形状推定装置が組み込まれている。この道路形状推定装置は、地図情報データベースを備えており、この地図情報データベースには、道路形状を複数の点で表すために設定された形状補間点が記憶されている。そして、道路形状推定装置は、道路形状の推定対象となっている道路に設定された形状補間点の中で、互いに隣接する３つの形状補間点を用いて道路の曲率半径を算出し、当該算出した曲率半径に基づいてクロソイドフィッティング処理を行うことで、道路形状を推定していた（例えば、特許文献１参照。）。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開２００５−２１４８３９号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
しかしながら、互いに隣接する３つの形状補間点を用いて道路の曲率半径を算出する場合、これら各形状補間点が実際の道路形状に合致する位置に設定されている場合には、道路の曲率半径を正しく算出することができるが、現実的には、各形状補間点が実際の道路形状に合致する位置に設定されていない場合があり、この場合には、道路の曲率半径の算出精度が低下する可能性があった。
【０００５】
本発明は、上記に鑑みてなされたものであって、各形状補間点が実際の道路形状に合致する位置に設定されていない場合であっても、道路の曲率半径の算出精度を向上させることができる、曲率半径算定装置、曲率半径算定方法、及び曲率半径算定プログラムを提供することを目的とする。
【課題を解決するための手段】
【０００６】
上述した課題を解決し、目的を達成するために、請求項１に記載の曲率半径算定装置は、道路種別を含む地図情報を格納する地図情報格納手段と、道路に沿って設定された複数の形状補間点の各々の位置を特定する形状補間点情報を取得する形状補間点情報取得手段と、前記形状補間点情報取得手段にて取得された形状補間点情報に基づいて、曲率半径の算定の対象とするコーナー区間を検出するコーナー区間検出手段と、前記形状補間点情報取得手段にて取得された形状補間点情報に基づいて、前記コーナー区間検出手段にて検出されたコーナー区間に含まれる複数の形状補間点の相互間の距離を算定し、当該算定した距離に基づいて基準距離を設定する基準距離設定手段と、前記形状補間点情報取得手段にて取得された形状補間点情報に基づいて、前記コーナー区間に含まれる３つの形状補間点を抽出し、当該抽出した３つの形状補間点に基づいて、当該コーナー区間の仮の曲率半径を算定する仮曲率半径算定手段と、前記地図情報格納手段にて格納された地図情報から取得した前記コーナー区間の道路種別と、前記仮曲率半径算定手段にて算定された仮の曲率半径とに基づいて、前記基準距離設定手段にて設定された基準距離を補正するための補正係数を特定する補正係数特定手段と、前記補正係数特定手段にて特定された補正係数と、前記基準距離設定手段にて設定された基準距離とに基づいて、前記コーナー区間に含まれる形状補間点の中から取得すべき３点の形状補間点の相互間距離を算定し、当該算定された相互間距離だけ相互に離れた３点を前記コーナー区間に含まれる形状補間点の中から抽出する形状補間点抽出手段と、前記形状補間点抽出手段にて抽出された３点の形状補間点に基づいて、前記コーナー区間の曲率半径を算定する曲率半径算定手段とを備える。
【０００７】
請求項２に記載の曲率半径算定装置は、請求項１に記載の曲率半径算定装置において、前記基準距離設定手段は、前記コーナー区間に含まれる形状補間点の相互間の平均距離を算定し、当該算定した平均距離を前記基準距離として設定する。
【０００８】
請求項３に記載の曲率半径算定装置は、請求項１又は２に記載の曲率半径算定装置において、前記補正係数を道路の種別毎及び道路の曲率半径毎に格納する補正係数格納手段を備え、前記補正係数特定手段は、前記地図情報格納手段にて格納された地図情報から取得した前記コーナー区間の道路種別と、前記仮曲率半径算定手段にて算定された仮の曲率半径とに対応する補正係数を、前記補正係数格納手段から取得する。
【０００９】
請求項４に記載の曲率半径算定方法は、道路に沿って設定された複数の形状補間点の各々の位置を特定する形状補間点情報を取得する形状補間点情報取得ステップと、前記形状補間点情報取得ステップにて取得された形状補間点情報に基づいて、曲率半径の算定の対象とするコーナー区間を検出するコーナー区間検出ステップと、前記形状補間点情報取得ステップにて取得された形状補間点情報に基づいて、前記コーナー区間検出ステップにて検出されたコーナー区間に含まれる複数の形状補間点の相互間の距離を算定し、当該算定した距離に基づいて基準距離を設定する基準距離設定ステップと、前記形状補間点情報取得ステップにて取得された形状補間点情報に基づいて、前記コーナー区間に含まれる３つの形状補間点を抽出し、当該抽出した３つの形状補間点に基づいて、当該コーナー区間の仮の曲率半径を算定する仮曲率半径算定ステップと、道路種別を含む地図情報を格納する地図情報格納手段から取得した前記コーナー区間の道路種別と、前記仮曲率半径算定ステップにて算定された仮の曲率半径とに基づいて、前記基準距離設定ステップにて設定された基準距離を補正するための補正係数を特定する補正係数特定ステップと、前記補正係数特定ステップにて特定された補正係数と、前記基準距離設定ステップにて設定された基準距離とに基づいて、前記コーナー区間に含まれる形状補間点の中から取得すべき３点の形状補間点の相互間距離を算定し、当該算定された相互間距離だけ相互に離れた３点を前記コーナー区間に含まれる形状補間点の中から抽出する形状補間点抽出ステップと、前記形状補間点抽出ステップにて抽出された３点の形状補間点に基づいて、前記コーナー区間の曲率半径を算定する曲率半径算定ステップとを含む。
【００１０】
請求項５に記載の曲率半径算定プログラムは、請求項４に記載の方法をコンピュータに実行させる。
【発明の効果】
【００１１】
請求項１に記載の曲率半径算定装置、請求項４に記載の曲率半径算定方法、及び請求項５に記載の曲率半径算定プログラムによれば、コーナー区間の道路種別と仮の曲率半径とに基づいて補正係数を特定し、この補正係数と基準距離とに基づいて３点の形状補間点の相互間距離を算定し、この相互間距離だけ相互に離れた３つの形状補間点を用いてコーナー区間の曲率半径を算定するので、コーナー区間の道路種別と曲率半径に応じた距離だけ離れた形状補間点を用いてコーナー区間の形状を推定することができ、形状補間点が実際の道路形状に合致する位置に設定されていない場合であっても、曲率半径の算定精度を向上させることができる。
【００１２】
請求項２に記載の曲率半径算定装置によれば、複数の形状補間点の相互間の平均距離を算定し、当該算定した平均距離を基準距離として設定するので、複数の形状補間点の代表的な距離を基準距離とし、この基準距離に基づいて３点の形状補間点の相互間距離が算定されるので、曲率半径の算定精度を向上させることができる。
【００１３】
請求項３に記載の曲率半径算定装置置によれば、コーナー区間の道路種別と仮の曲率半径とに対応する補正係数が取得されるので、形状推定の対象になり得る各道路の種別と曲率半径に応じて補正係数を設定しておくことで、道路種別と曲率半径に応じて適切な相互間距離を算定することが可能となる。
【図面の簡単な説明】
【００１４】
【図１】本実施の形態に係るカーナビゲーションシステムを例示するブロック図である。
【図２】補正係数テーブルを例示する図である。
【図３】道路形状推定処理のフローチャートである。
【図４】道路形状推定処理による推定結果を示す図であり、（ａ）は従来の道路形状推定結果を示す図、（ｂ）は本発明の実施の形態による道路形状推定結果を示す図である。
【発明を実施するための形態】
【００１５】
以下、本発明に係る曲率半径算定装置、曲率半径算定方法、及び曲率半径算定プログラムの実施の形態について図面を参照しつつ詳細に説明する。ただし、この実施の形態によって本発明が限定されるものではない。なお、なお、本発明に係る曲率半径算定装置、曲率半径算定方法、及び曲率半径算定プログラムは、任意の目的に使用することができるが、この実施の形態では、カーナビゲーションシステムにおける道路形状の推定に適用した例を示す。
【００１６】
（構成）
まず、本実施の形態に係るカーナビゲーションシステムの構成を説明する。図１は、本実施の形態に係るカーナビゲーションシステムを例示するブロック図である。図１に示すように、カーナビゲーションシステム１は、現在位置検出処理部１０、車速センサ２０、ディスプレイ３０、スピーカ４０、及び曲率半径算定装置５０を備えている。
【００１７】
（構成−現在位置検出処理部）
現在位置検出処理部１０は、カーナビゲーションシステム１が取り付けられた車両（以下、自車両）の現在位置を検出する現在位置検出手段である。具体的には、現在位置検出処理部１０は、ＧＰＳ、地磁気センサ、距離センサ、又はジャイロセンサ（いずれも図示省略）の少なくとも一つを有し、現在の自車両の位置（座標）及び方位等を公知の方法にて検出する。
【００１８】
（構成−車速センサ）
車速センサ２０は、自車両の車輪の回転速度等を曲率半径算定装置５０に出力するものであり、公知の車速センサを用いることができる。
【００１９】
（構成−ディスプレイ）
ディスプレイ３０は、曲率半径算定装置５０によって案内された画像を表示する表示手段である。ディスプレイ３０の具体的な構成は任意であり、公知の液晶ディスプレイや有機ＥＬディスプレイの如きフラットパネルディスプレイを使用することができる。
【００２０】
（構成−スピーカ）
スピーカ４０は、曲率半径算定装置５０の制御に基づいて各種の音声を出力する出力手段である。スピーカ４０より出力される音声の具体的な態様は任意であり、必要に応じて生成された合成音声や、予め録音された音声を出力することができる。
【００２１】
（構成−曲率半径算定装置）
曲率半径算定装置５０は、曲率半径の算定を行う曲率半径算定手段であり、制御部５１及びデータ記録部５２を備えている。
【００２２】
（構成−曲率半径算定装置−制御部）
制御部５１は、曲率半径算定装置５０を制御する制御手段であり、具体的には、ＣＰＵ、当該ＣＰＵ上で解釈実行される各種のプログラム（ＯＳなどの基本制御プログラムや、ＯＳ上で起動され特定機能を実現するアプリケーションプログラムを含む）、及びプログラムや各種のデータを格納するためのＲＡＭの如き内部メモリを備えて構成されるコンピュータである。特に、本実施の形態に係る曲率半径算定プログラムは、任意の記録媒体又はネットワークを介して曲率半径算定装置５０にインストールされることで、制御部５１の各部を実質的に構成する。
【００２３】
この制御部５１は、機能概念的に、形状補間点情報取得部５１ａ、コーナー区間検出部５１ｂ、基準距離設定部５１ｃ、仮曲率半径算定部５１ｄ、補正係数特定部５１ｅ、形状補間点抽出部５１ｆ、及び曲率半径算定部５１ｇを備える。形状補間点情報取得部５１ａは、道路に沿って設定された複数の形状補間点の各々の位置を特定する形状補間点情報を取得する形状補間点情報取得手段である。コーナー区間検出部５１ｂは、形状補間点情報取得部５１ａにて取得された形状補間点情報に基づいて、曲率半径の算定の対象とするコーナー区間を検出するコーナー区間検出手段である。基準距離設定部５１ｃは、形状補間点情報取得部５１ａにて取得された形状補間点情報に基づいて、コーナー区間検出部５１ｂにて検出されたコーナー区間に含まれる複数の形状補間点の相互間の距離を算定し、当該算定した距離に基づいて基準距離を設定する基準距離設定手段である。仮曲率半径算定部５１ｄは、形状補間点情報取得部５１ａにて取得された形状補間点情報に基づいて、コーナー区間に含まれる３つの形状補間点を抽出し、当該抽出した３つの形状補間点に基づいて、当該コーナー区間の仮の曲率半径を算定する仮曲率半径算定手段である。補正係数特定部５１ｅは、後述する地図情報ＤＢ５２ａにて格納された地図情報から取得したコーナー区間の道路種別と、仮曲率半径算定部５１ｄにて算定された仮の曲率半径とに基づいて、基準距離設定部５１ｃにて設定された基準距離を補正するための補正係数を特定する補正係数特定手段である。形状補間点抽出部５１ｆは、補正係数特定部５１ｅにて特定された補正係数と、基準距離設定部５１ｃにて設定された基準距離とに基づいて、コーナー区間に含まれる形状補間点の中から取得すべき３点の形状補間点の相互間距離を算定し、当該算定された相互間距離だけ相互に離れた３点をコーナー区間に含まれる形状補間点の中から抽出する形状補間点抽出手段である。曲率半径算定部５１ｇは、形状補間点抽出部５１ｆにて抽出された３点の形状補間点に基づいて、コーナー区間の曲率半径を算定する曲率半径算定手段である。これらの制御部５１の各構成要素によって実行される処理の詳細については後述する。また、補正係数、基準距離、及び仮の曲率半径についても後述する。
【００２４】
（構成−曲率半径算定装置−データ記録部）
図１において、データ記録部５２は、曲率半径算定装置５０の動作に必要なプログラム及び各種のデータを記録する記録手段であり、例えば、外部記録装置としてのハードディスク（図示省略）を用いて構成されている。ただし、ハードディスクに代えてあるいはハードディスクと共に、磁気ディスクの如き磁気的記録媒体、又はＤＶＤやブルーレイディスクの如き光学的記録媒体を含む、その他の任意の記録媒体を用いることができる。
【００２５】
このデータ記録部５２は、地図情報データベース（以下、データベースを「ＤＢ」と称する）５２ａと補正係数テーブル５２ｂを備えている。地図情報ＤＢ５２ａは、地図情報を格納する地図情報格納手段である。「地図情報」とは、交差点や一時停止地点を含む各種の位置の特定に必要な情報であり、例えば、交差点データ（交差点座標等）や、地図をディスプレイ３０に表示するための地図表示データ等を含んで構成されている。また、地図情報には、各道路の道路種別（高速道路、一般道、細街路、山岳路等）、各道路の始点から終点までの道路リンクを表すデータ、及び道路リンク上において道路形状を表すために道路に略沿って設定された形状補間点のデータ（以下、形状補間点データ）が含まれる。形状補間点データには、各形状補間点の番号及び座標等が含まれる。なお、各ノードは、道路リンク上の始点又は終点を表すものであるため、形状補間点としても機能する。
【００２６】
補正係数テーブル５２ｂは、補正係数を道路の種別毎及び道路の曲率半径毎に格納する補正係数格納手段である。この補正係数テーブル５２ｂを図２に例示する。この図２に示すように、補正係数テーブル５２ｂは、項目「道路の曲率半径」と項目「道路種別」を含んでおり、項目「道路種別」は、さらに項目「高速道路」、項目「一般道」、項目「細街路、山岳路」を含んでいる。項目「道路の曲率半径」に対応する情報としては、「０〜１００未満」、「１００〜２００未満」、「２００〜３００未満」、「３００〜４００未満」、「４００〜５００未満」、「５００以上」が格納されており、項目「高速道路」、項目「一般道」、項目「細街路又は山岳路」に対応する情報としては、補正係数Ｓ１〜Ｓ３のいずれか、あるいは当該補正係数Ｓ１〜Ｓ３に数値を乗算したものが格納されている。
【００２７】
ここで、補正係数について説明する。本実施の形態では、概略的に、道路形状を推定する際、３点の形状補間点を用いたクロソイドフィッティング処理を行う。ただし、従来のように相互に隣接した３点の形状補間点に限定せず、必要に応じて、相互に一定な距離だけ隔てて配置された３点の形状補間点を抽出して使用する。ただし、一定な距離とは、厳密に同一な距離を意味するものではなく、同一とみなせる程度のある程度幅をもった距離を意味する。以下、この距離を「抽出距離」と称する。
【００２８】
この抽出距離は、「基準距離」に「補正係数」を乗じることで算定する。「基準距離」とは、抽出距離を算定するための基礎となる距離である。以下の説明では、基準距離として「平均距離」を用いた例について説明する。平均距離とは、曲率半径の算定の対象になるコーナー区間に含まれる形状補間点を対象として算定された距離であって、相互に隣接する形状補間点の各距離の平均である。「補正係数」とは、基準距離を補正して抽出距離を算定するための係数である。この補正係数は、道路の種別と、道路の曲率半径とに基づいて、補正係数テーブル５２ｂに予め設定されている。この補正係数の概略的な設定方針としては、例えば、上述のように基準距離として平均距離を用いた場合において、道路種別＝高速道路である場合には、形状補間点が比較的長い距離を隔てて配置されており、相互に隣接する３点の形状補間点を用いて曲率半径を算定しても実際の道路の曲率半径との間でずれが生じる可能性は低いと考えられることから、平均距離に近い距離を抽出距離として設定することができるので、補正係数を比較的小さくする（例えば１に近い係数とする）。一方、道路種別＝細街路又は山岳路である場合には、形状補間点が比較的間短い距離を隔てて配置されており、相互に隣接する３点の形状補間点を用いて曲率半径を算定すると実際の道路の曲率半径との間でずれが生じる可能性があると考えられることから、平均距離よりも長い距離を抽出距離として設定することが好ましいため、補正係数を比較的大きくする（例えば１より大きい係数とする）。また、道路の曲率半径に関して、道路の曲率半径が小さい場合には、比較的近い形状補間点を使用してもコーナーを直線と推定してしまう可能性が低いため、抽出距離を短くするため、補正係数を比較的小さくし（あるいは１とし）、道路の曲率半径が大きい場合には、比較的近い形状補間点を使用するとコーナーを直線と推定してしまうことで推定精度が低下する可能性があるため、道路の曲率半径が小さい場合に比べて抽出距離を長くするため、補正係数を比較的大きくする。なお、このように、補正係数を決定する上で、道路の曲率半径を使用しているが、道路形状の推定が終了するまでは、最終的な曲率半径は特定することができない。このため、本実施の形態においては、補正係数を決定するために使用する暫定的な曲率半径を算定し、当該算定した暫定的な曲率半径を用いて補正係数を決定することとしている。このように暫定的に算定された曲率半径を、「仮の曲率半径」と称する。
【００２９】
このような設定方針に基づき、図２の補正係数テーブル５２ｂの内容が設定されている。すなわち、道路種別に関して、道路種別＝高速道路の場合にはパラメータ＝Ｓ３、道路種別＝一般道の場合にはパラメータ＝Ｓ２、道路種別＝細街路又は山岳路の場合にはパラメータ＝Ｓ１をそれぞれ用いるものとして、Ｓ３＜Ｓ２＜Ｓ１となるように、これらパラメータＳ１〜Ｓ３を決定している。この条件に合致する限りにおいて、パラメータの具体的数値は任意であるが、例えば、Ｓ３＝１．４、Ｓ２＝１．８、Ｓ１＝２．０として設定される。また、道路の曲率半径に関して、道路の曲率半径が大きい場合には、補正係数が大きくなるように、１．２又は１．５が乗算される。なお、この条件に合致する限りにおいて、これらの数値も任意に変更することができ、例えば、パラメータＳ１〜Ｓ３と同様に、各数値をパラメータとして設定することもできる。なお、道路種別＝一般道の場合であって、道路の曲率半径＝４００〜５００未満及び５００以上の場合と、道路種別＝細街路又は山岳路の場合であって、道路の曲率半径＝３００〜４００未満、４００〜５００未満、及び５００以上の場合は、対応する補正係数が設定されていない。この理由は、これらの各場合には、道路形状をコーナーであるとみなさない（直線とみなす）ことができる場合であり、補正係数による補正を行う必要性が低いためである。ただし、これらの各場合に対しても、補正係数を設定するようにしてもよい。
【００３０】
（処理）
次に、このように構成される曲率半径算定装置５０によって実行される道路形状推定処理について説明する。図３は、道路形状推定処理のフローチャートである（以下の各処理の説明ではステップを「Ｓ」と略記する）。この道路形状推定処理は、例えば、自車両の走行開始後に自動的に起動されて所定間隔で繰り返し実行される。
【００３１】
まず、制御部５１は、現在位置検出処理部１０から自車両の現在位置を取得する（ＳＡ１）。次いで、コーナー区間検出部５１ｂは、曲率半径の算定の対象とするコーナー区間を検出する（ＳＡ２）。具体的には、形状補間点情報取得部５１ａが、道路に沿って設定された複数の形状補間点の各々の位置を特定する形状補間点情報を取得し、当該取得された形状補間点情報に基づいて、コーナー区間検出部５１ｂが、曲率半径の算定の対象とするコーナー区間を検出する。例えば、形状補間点情報取得部５１ａは、ＳＡ１で取得した自車両の現在位置から、当該自車両の走行道路上における当該自車両の進行方向前方の所定範囲（例えば、１ｋｍ以内）を、推定対象範囲として設定し、地図情報ＤＢ５２ａに格納されている地図情報から、当該推定対象範囲内に含まれる全ての形状補間点を取得する。次いで、コーナー区間検出部５１ｂは、形状補間点情報取得部５１ａにて取得された全ての形状補間点を対象に、相互に隣接する３点の形状補間点の半径（以下、３点半径）と、相互に隣接する形状補間点同士を結ぶ線分の相互角度（屈曲角）をそれぞれ算定する。そして、３点半径が所定半径以下となる区間であって、屈曲角が所定角度以上であり、かつ、屈曲角が同一方向に形成される区間を、コーナー区間として特定する。また、コーナー区間検出部５１ｂは、当該特定したコーナー区間に含まれる形状補間点の中で、最も手前にある形状補間点を、当該特定したコーナー区間の開始候補点に設定し、最も奥にある形状補間点を、当該特定したコーナー区間の終了候補点として設定する。
【００３２】
次いで、制御部５１は、自車両の進行方向前方にコーナー区間があるか否かを判定する（ＳＡ３）。具体的には、制御部５１は、ＳＡ２でコーナー区間が検出された場合には、コーナー区間があると判定し、ＳＡ２でコーナー区間が検出されなかった場合には、コーナー区間がないと判定する。そして、コーナー区間がないと判定した場合（ＳＡ３、Ｎｏ）、制御部５１は、道路形状を推定する必要がないものとし、道路形状推定処理を終了する。
【００３３】
一方、コーナー区間があると判定した場合（ＳＡ３、Ｙｅｓ）、基準距離設定部５１ｃは、ＳＡ２で特定されたコーナー区間（以下、単にコーナー区間）の基準距離を算定する（ＳＡ４）。具体的には、基準距離設定部５１ｃは、ＳＡ２で取得したコーナー区間に含まれる形状補間点であって、開始候補点及び終了候補点と、開始候補点から終了候補点までの間に位置する形状補間点を対象として、相互に隣接する形状補間点の各距離を算定し、当該算定した各距離の平均距離を算定して、当該算定した平均距離を基準距離に設定する。
【００３４】
次いで、仮曲率半径算定部５１ｄは、コーナー区間の仮の曲率半径を算定する（ＳＡ５）。具体的には、仮曲率半径算定部５１ｄは、ＳＡ２で取得したコーナー区間に含まれる形状補間点の中から、３つの形状補間点を抽出し、当該抽出した３つの形状補間点の半径（以下、３点半径）を公知の３点計算法によって算定し、当該算定した半径を仮の曲率半径に設定する。ここで、３つの形状補間点の抽出方法は任意であり、いずれの形状補間点を抽出してもよい。ここでは、相互に隣接する３つの形状補間点を抽出する。この３つの形状補間点は、コーナー区間の形状を代表するような形状補間点を抽出することが好ましく、例えば、仮曲率半径算定部５１ｄは、ＳＡ３で取得した形状補間点の中で、最も中央寄りの位置において、相互に隣接する３つの形状補間点を抽出する。
【００３５】
その後、補正係数特定部５１ｅは、コーナー区間の道路種別を特定する（ＳＡ６）。具体的には、補正係数特定部５１ｅは、地図情報ＤＢ５２ａの地図情報を参照し、コーナー区間の道路種別を特定する。
【００３６】
次いで、補正係数特定部５１ｅは、補正係数を特定する（ＳＡ７）。具体的には、補正係数特定部５１ｅは、ＳＡ５で算定した仮の曲率半径と、ＳＡ６で特定したコーナー区間の道路種別とに対応する補正係数を、補正係数テーブル５２ｂから取得する。例えば、仮の曲率半径＝２５０ｍで、道路種別＝一般道である場合において、パラメータＳ２＝１．８の場合には、補正係数＝Ｓ２×１．２＝２．１６となる。
【００３７】
そして、形状補間点抽出部５１ｆは、コーナー区間の曲率半径を算定するために使用する形状補間点を抽出する（ＳＡ８）。具体的には、形状補間点抽出部５１ｆは、ＳＡ４で算定した基準距離に、ＳＡ７で特定した補正係数を乗じることで、抽出距離を算定する。例えば、基準距離＝２ｍで、補正係数＝２．１６の場合には、抽出距離＝４．３２ｍとなる。次いで、形状補間点抽出部５１ｆは、ＳＡ３で取得した形状補間点の中で、基準となる一つの形状補間点を特定し、当該特定した形状補間点と、当該特定した形状補間点に対して開始候補点側に抽出距離だけ離れた位置（以下、開始側位置）にある形状補間点と、当該特定した形状補間点に対して終了候補点側に抽出距離だけ離れた位置（以下、終了側位置）にある形状補間点とを、コーナー区間の曲率半径を算定するために使用する３つの形状補間点として特定する。ここで、基準となる一つの形状補間点としては、ＳＡ３で取得した形状補間点の中で、最も中央寄りの位置にある形状補間点を特定する。なお、開始側位置や終了側位置に形状補間点がない場合には、開始側位置に対して開始候補点側において最も近い位置にある形状補間点や、終了側位置対して終了候補点側において最も近い位置にある形状補間点を抽出する。
【００３８】
そして、曲率半径算定部５１ｇは、ＳＡ８で抽出された３つの形状補間点を用いて、当該３つの形状補間点の３点半径を公知の３点計算法によって算定する（ＳＡ９）。このことにより、コーナー区間の曲率半径を算定することができる。
【００３９】
最後に、制御部５１は、ＳＡ９で算定されたコーナー区間の曲率半径に基づいてクロソイドフィッティング処理を公知の方法で行うことで、コーナー区間の形状を推定する（ＳＡ１０）。これにて道路形状推定処理が終了する。
【００４０】
次に、このような道路形状推定処理を行う意義について説明する。図４は、道路形状推定処理による推定結果を示す図であり、（ａ）は従来の道路形状推定結果を示す図、（ｂ）は本実施の形態による道路形状推定結果を示す図である。この図４（ａ）（ｂ）には、形状補間点Ｐ１〜Ｐ６を示しており、特に、Ｐ４は、実際のコーナー区間の形状からのずれが大きい形状補間点であることを想定している。
【００４１】
ここで、図４（ａ）に示すように、従来は、相互に隣接する３つの形状補間点を用いて曲率半径の算定を行っていたので、例えば、このような３つの形状補間点として、ずれが大きい形状補間点Ｐ４を含む形状補間点Ｐ２〜Ｐ４を用いて３点計算法によりコーナー区間の曲率半径を算定した場合には、当該算定されたコーナー区間の曲率半径が実際のコーナー区間の曲率半径とは異なるものとなり、曲率半径の算定精度が低いものとなる。また、この結果、このように算定されたコーナー区間の曲率半径に基づいて推定された道路の形状が実際の道路の形状とは異なるものとなる。
【００４２】
これに対して、図４（ｂ）に示すように、本実施の形態では、抽出距離だけ離れた３つの形状補間点を用いて道路形状の推定を行うので、例えば、このような３つの形状補間点として、形状補間点Ｐ１、Ｐ３、Ｐ５を用いて３点計算法によりコーナー区間の曲率半径を算定することができ、曲率半径の算定精度が向上する。また、この結果、このように算定されたコーナー区間の曲率半径に基づいて推定された道路の形状が実際のコーナー区間の形状と近くなり、推定精度を向上させることができる。
【００４３】
（効果）
このように本実施の形態によれば、コーナー区間の道路種別と仮の曲率半径とに基づいて補正係数を特定し、この補正係数と基準距離とに基づいて３点の形状補間点の相互間距離を算定し、この相互間距離だけ相互に離れた３つの形状補間点を用いてコーナー区間の曲率半径を算定するので、コーナー区間の道路種別と曲率半径に応じた距離だけ離れた形状補間点を用いてコーナー区間の形状を推定することができ、形状補間点が実際の道路形状に合致する位置に設定されていない場合であっても、曲率半径の算定精度を向上させることができる。
【００４４】
また、複数の形状補間点の相互間の平均距離を算定し、当該算定した平均距離を基準距離として設定するので、複数の形状補間点の代表的な距離を基準距離とし、この基準距離に基づいて３点の形状補間点の相互間距離が算定されるので、曲率半径の算定精度を向上させることができる。
【００４５】
また、コーナー区間の道路種別と仮の曲率半径とに対応する補正係数が取得されるので、形状推定の対象になり得る各道路の種別と曲率半径に応じて補正係数を設定しておくことで、道路種別と曲率半径に応じて適切な相互間距離を算定することが可能となる。
【００４６】
〔実施の形態に対する変形例〕
以上、本発明に係る実施の形態について説明したが、本発明の具体的な構成及び手段は、特許請求の範囲に記載した各発明の技術的思想の範囲内において、任意に改変及び改良することができる。以下、このような変形例について説明する。
【００４７】
（解決しようとする課題や発明の効果について）
まず、発明が解決しようとする課題や発明の効果は、上述の内容に限定されるものではなく、発明の実施環境や構成の細部に応じて異なる可能性があり、上述した課題の一部のみを解決したり、上述した効果の一部のみを奏することがある。
【００４８】
（仮の曲率半径の算定について）
図３のＳＡ５において仮の曲率半径を算定するための３つの形状補間点の抽出方法としては、上記説明した方法以外にも、種々の方法を採用することができる。例えば、仮曲率半径算定部５１ｄは、屈曲角が最大となる形状補間点とその前後の形状補間点抽出する。あるいは、仮曲率半径算定部５１ｄは、屈曲角が最大となる形状補間点であって、かつ、前後の形状補間点における屈曲角との差が小さい形状補間点を特定し、当該形状補間点とその前後の形状補間点を抽出する。あるいは、仮曲率半径算定部５１ｄは、ＳＡ３で取得した形状補間点を対象に、相互に隣接する３つの形状補間点の全ての組み合わせを対象として３点半径を算定し、当該算定した３点半径の中で、一番小さく、かつ、前後の３点半径との差分が小さい３点半径を、仮の曲率半径としてもよい。
【００４９】
（抽出距離に基づく形状補間点の設定について）
図３のＳＡ８において抽出距離に基づいて３つの形状補間点を抽出する方法としては、上記説明した方法以外にも、種々の方法を採用することができる。例えば、形状補間点抽出部５１ｆは、コーナー区間の全ての形状補間点を対象とした３点半径の中で一番小さい３点半径の中心の形状補間点を、コーナー区間の曲率半径を算定するための３つの形状補間点の中の中心の形状補間点として設定し、当該形状補間点に対して抽出距離だけ離れた２つの形状補間点をさらに抽出するようにしてもよい。あるいは、形状補間点抽出部５１ｆは、最も中央寄りの位置にある形状補間点を特定した後、この形状補間点を基準として抽出距離だけ離れた開始側位置や終了側位置に形状補間点がない場合には、開始側位置や終了側位置に仮想の形状補間点を設定してもよい。仮想の形状補間点は、例えば、開始側位置や終了側位置の前後の形状補間点を特定し、当該特定した前後の形状補間点を結ぶ線分を設定し、当該線分上における開始側位置や終了側位置に対応する位置に設定することができる。また、形状補間点抽出部５１ｆは、最も中央寄りの位置にある形状補間点以外の形状補間点を基準として、他の２つの形状補間点を抽出してもよい。
【００５０】
（道路形状の推定について）
上記実施の形態では、コーナー区間の曲率半径が算定された後、当該算定された曲率半径に基づいてコーナー区間の形状を推定しているが、当該推定を行う処理は省略してもよい。
【符号の説明】
【００５１】
１ カーナビゲーションシステム
１０ 現在位置検出処理部
２０ 車速センサ
３０ ディスプレイ
４０ スピーカ
５０ 曲率半径算定装置
５１ 制御部
５１ａ 形状補間点情報取得部
５１ｂ コーナー区間検出部
５１ｃ 基準距離設定部
５１ｄ 仮曲率半径算定部
５１ｅ 補正係数特定部
５１ｆ 形状補間点抽出部
５１ｇ 曲率半径算定部
５２ データ記録部
５２ａ 地図情報ＤＢ
５２ｂ 補正係数テーブル
【特許請求の範囲】
【請求項１】
道路種別を含む地図情報を格納する地図情報格納手段と、
道路に沿って設定された複数の形状補間点の各々の位置を特定する形状補間点情報を取得する形状補間点情報取得手段と、
前記形状補間点情報取得手段にて取得された形状補間点情報に基づいて、曲率半径の算定の対象とするコーナー区間を検出するコーナー区間検出手段と、
前記形状補間点情報取得手段にて取得された形状補間点情報に基づいて、前記コーナー区間検出手段にて検出されたコーナー区間に含まれる複数の形状補間点の相互間の距離を算定し、当該算定した距離に基づいて基準距離を設定する基準距離設定手段と、
前記形状補間点情報取得手段にて取得された形状補間点情報に基づいて、前記コーナー区間に含まれる３つの形状補間点を抽出し、当該抽出した３つの形状補間点に基づいて、当該コーナー区間の仮の曲率半径を算定する仮曲率半径算定手段と、
前記地図情報格納手段にて格納された地図情報から取得した前記コーナー区間の道路種別と、前記仮曲率半径算定手段にて算定された仮の曲率半径とに基づいて、前記基準距離設定手段にて設定された基準距離を補正するための補正係数を特定する補正係数特定手段と、
前記補正係数特定手段にて特定された補正係数と、前記基準距離設定手段にて設定された基準距離とに基づいて、前記コーナー区間に含まれる形状補間点の中から取得すべき３点の形状補間点の相互間距離を算定し、当該算定された相互間距離だけ相互に離れた３点を前記コーナー区間に含まれる形状補間点の中から抽出する形状補間点抽出手段と、
前記形状補間点抽出手段にて抽出された３点の形状補間点に基づいて、前記コーナー区間の曲率半径を算定する曲率半径算定手段と、
を備える曲率半径算定装置。
【請求項２】
前記基準距離設定手段は、前記コーナー区間に含まれる形状補間点の相互間の平均距離を算定し、当該算定した平均距離を前記基準距離として設定する、
請求項１に記載の曲率半径算定装置。
【請求項３】
前記補正係数を道路の種別毎及び道路の曲率半径毎に格納する補正係数格納手段を備え、
前記補正係数特定手段は、前記地図情報格納手段にて格納された地図情報から取得した前記コーナー区間の道路種別と、前記仮曲率半径算定手段にて算定された仮の曲率半径とに対応する補正係数を、前記補正係数格納手段から取得する、
請求項１又は２に記載の曲率半径算定装置。
【請求項４】
道路に沿って設定された複数の形状補間点の各々の位置を特定する形状補間点情報を取得する形状補間点情報取得ステップと、
前記形状補間点情報取得ステップにて取得された形状補間点情報に基づいて、曲率半径の算定の対象とするコーナー区間を検出するコーナー区間検出ステップと、
前記形状補間点情報取得ステップにて取得された形状補間点情報に基づいて、前記コーナー区間検出ステップにて検出されたコーナー区間に含まれる複数の形状補間点の相互間の距離を算定し、当該算定した距離に基づいて基準距離を設定する基準距離設定ステップと、
前記形状補間点情報取得ステップにて取得された形状補間点情報に基づいて、前記コーナー区間に含まれる３つの形状補間点を抽出し、当該抽出した３つの形状補間点に基づいて、当該コーナー区間の仮の曲率半径を算定する仮曲率半径算定ステップと、
道路種別を含む地図情報を格納する地図情報格納手段から取得した前記コーナー区間の道路種別と、前記仮曲率半径算定ステップにて算定された仮の曲率半径とに基づいて、前記基準距離設定ステップにて設定された基準距離を補正するための補正係数を特定する補正係数特定ステップと、
前記補正係数特定ステップにて特定された補正係数と、前記基準距離設定ステップにて設定された基準距離とに基づいて、前記コーナー区間に含まれる形状補間点の中から取得すべき３点の形状補間点の相互間距離を算定し、当該算定された相互間距離だけ相互に離れた３点を前記コーナー区間に含まれる形状補間点の中から抽出する形状補間点抽出ステップと、
前記形状補間点抽出ステップにて抽出された３点の形状補間点に基づいて、前記コーナー区間の曲率半径を算定する曲率半径算定ステップと、
を含む曲率半径算定方法。
【請求項５】
請求項４に記載の方法をコンピュータに実行させる曲率半径算定プログラム。
【請求項１】
道路種別を含む地図情報を格納する地図情報格納手段と、
道路に沿って設定された複数の形状補間点の各々の位置を特定する形状補間点情報を取得する形状補間点情報取得手段と、
前記形状補間点情報取得手段にて取得された形状補間点情報に基づいて、曲率半径の算定の対象とするコーナー区間を検出するコーナー区間検出手段と、
前記形状補間点情報取得手段にて取得された形状補間点情報に基づいて、前記コーナー区間検出手段にて検出されたコーナー区間に含まれる複数の形状補間点の相互間の距離を算定し、当該算定した距離に基づいて基準距離を設定する基準距離設定手段と、
前記形状補間点情報取得手段にて取得された形状補間点情報に基づいて、前記コーナー区間に含まれる３つの形状補間点を抽出し、当該抽出した３つの形状補間点に基づいて、当該コーナー区間の仮の曲率半径を算定する仮曲率半径算定手段と、
前記地図情報格納手段にて格納された地図情報から取得した前記コーナー区間の道路種別と、前記仮曲率半径算定手段にて算定された仮の曲率半径とに基づいて、前記基準距離設定手段にて設定された基準距離を補正するための補正係数を特定する補正係数特定手段と、
前記補正係数特定手段にて特定された補正係数と、前記基準距離設定手段にて設定された基準距離とに基づいて、前記コーナー区間に含まれる形状補間点の中から取得すべき３点の形状補間点の相互間距離を算定し、当該算定された相互間距離だけ相互に離れた３点を前記コーナー区間に含まれる形状補間点の中から抽出する形状補間点抽出手段と、
前記形状補間点抽出手段にて抽出された３点の形状補間点に基づいて、前記コーナー区間の曲率半径を算定する曲率半径算定手段と、
を備える曲率半径算定装置。
【請求項２】
前記基準距離設定手段は、前記コーナー区間に含まれる形状補間点の相互間の平均距離を算定し、当該算定した平均距離を前記基準距離として設定する、
請求項１に記載の曲率半径算定装置。
【請求項３】
前記補正係数を道路の種別毎及び道路の曲率半径毎に格納する補正係数格納手段を備え、
前記補正係数特定手段は、前記地図情報格納手段にて格納された地図情報から取得した前記コーナー区間の道路種別と、前記仮曲率半径算定手段にて算定された仮の曲率半径とに対応する補正係数を、前記補正係数格納手段から取得する、
請求項１又は２に記載の曲率半径算定装置。
【請求項４】
道路に沿って設定された複数の形状補間点の各々の位置を特定する形状補間点情報を取得する形状補間点情報取得ステップと、
前記形状補間点情報取得ステップにて取得された形状補間点情報に基づいて、曲率半径の算定の対象とするコーナー区間を検出するコーナー区間検出ステップと、
前記形状補間点情報取得ステップにて取得された形状補間点情報に基づいて、前記コーナー区間検出ステップにて検出されたコーナー区間に含まれる複数の形状補間点の相互間の距離を算定し、当該算定した距離に基づいて基準距離を設定する基準距離設定ステップと、
前記形状補間点情報取得ステップにて取得された形状補間点情報に基づいて、前記コーナー区間に含まれる３つの形状補間点を抽出し、当該抽出した３つの形状補間点に基づいて、当該コーナー区間の仮の曲率半径を算定する仮曲率半径算定ステップと、
道路種別を含む地図情報を格納する地図情報格納手段から取得した前記コーナー区間の道路種別と、前記仮曲率半径算定ステップにて算定された仮の曲率半径とに基づいて、前記基準距離設定ステップにて設定された基準距離を補正するための補正係数を特定する補正係数特定ステップと、
前記補正係数特定ステップにて特定された補正係数と、前記基準距離設定ステップにて設定された基準距離とに基づいて、前記コーナー区間に含まれる形状補間点の中から取得すべき３点の形状補間点の相互間距離を算定し、当該算定された相互間距離だけ相互に離れた３点を前記コーナー区間に含まれる形状補間点の中から抽出する形状補間点抽出ステップと、
前記形状補間点抽出ステップにて抽出された３点の形状補間点に基づいて、前記コーナー区間の曲率半径を算定する曲率半径算定ステップと、
を含む曲率半径算定方法。
【請求項５】
請求項４に記載の方法をコンピュータに実行させる曲率半径算定プログラム。
【図１】
【図２】
【図３】
【図４】
【図２】
【図３】
【図４】
【公開番号】特開２０１１−２１４９９０（Ｐ２０１１−２１４９９０Ａ）
【公開日】平成２３年１０月２７日（２０１１．１０．２７）
【国際特許分類】
【出願番号】特願２０１０−８３２１３（Ｐ２０１０−８３２１３）
【出願日】平成２２年３月３１日（２０１０．３．３１）
【出願人】（０００１００７６８）アイシン・エィ・ダブリュ株式会社 (3,717)
【Ｆターム（参考）】
【公開日】平成２３年１０月２７日（２０１１．１０．２７）
【国際特許分類】
【出願日】平成２２年３月３１日（２０１０．３．３１）
【出願人】（０００１００７６８）アイシン・エィ・ダブリュ株式会社 (3,717)
【Ｆターム（参考）】
[ Back to top ]