移動体用位置推定装置
【課題】道路形状や周辺環境に影響されずに高精度に移動体の位置を推定する移動体用位置推定装置を提供すること。
【解決手段】移動体に搭載され、移動体の位置を推定する移動体用位置推定装置に、移動体に搭載された慣性航法センサ群（加速度センサ、ヨーレートセンサなど）の出力に基づいて移動体の位置を推定する第一の推定手段と、少なくともノード情報を含む地図情報を記憶した記憶手段と、ノード情報から予測された移動体の予想移動軌跡に基づいて移動体の位置を推定する第二の推定手段と、第一の推定手段により推定された移動体位置と第二の推定手段により推定された移動体位置とを合成処理して移動体の最終推定位置を決定する合成手段とを備える。
【解決手段】移動体に搭載され、移動体の位置を推定する移動体用位置推定装置に、移動体に搭載された慣性航法センサ群（加速度センサ、ヨーレートセンサなど）の出力に基づいて移動体の位置を推定する第一の推定手段と、少なくともノード情報を含む地図情報を記憶した記憶手段と、ノード情報から予測された移動体の予想移動軌跡に基づいて移動体の位置を推定する第二の推定手段と、第一の推定手段により推定された移動体位置と第二の推定手段により推定された移動体位置とを合成処理して移動体の最終推定位置を決定する合成手段とを備える。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、概して、移動体に搭載され、該移動体の位置を推定する移動体用位置推定装置に係り、特に、道路形状や周辺環境に影響されずに高精度に移動体の位置を推定する移動体用位置推定装置に関する。
【背景技術】
【０００２】
従来、例えば車両などの移動体に搭載され、該移動体の位置を推定する移動体用位置推定装置が知られている（例えば、特許文献１参照）。このような装置は、典型的には、ナビゲーションシステムに含まれている。
【０００３】
ここで、移動体の位置を検出・推定する手法としては、ＧＰＳ（Ｇｌｏｂａｌ Ｐｏｓｉｔｉｏｎｉｎｇ Ｓｙｓｔｅｍ；全地球測位システム）を利用して当該移動体の絶対座標を取得する手法が周知である。
【０００４】
また、ＧＰＳ衛星からの電波受信状態が良好でないときに備えて、加速度センサやヨーレートセンサなどの慣性航法センサ群を移動体に搭載しておき、ＧＰＳを利用して移動体の位置を検出できないときには慣性航法センサ群の出力から移動体位置を推定する手法も周知である。
【０００５】
既存のＧＰＳは、ＲＴＫ（Ｒｅａｌ Ｔｉｍｅ Ｋｉｎｅｍａｔｉｃ）−ＧＰＳなどの高精度ＧＰＳよりも測位精度が悪く、数十メートル程度の誤差を生じ得る。また、慣性航法センサ群は、いわゆるドリフトにより時間の経過と共に精度が劣化するという性質を有する。
【０００６】
そこで、従来のナビゲーションシステムにおいては、検出・推定した移動体位置を予め保持している地図情報に照らした際に移動体位置が道路上に位置しなかった場合、いわゆるマップマッチング処理により道路上のいずれかの位置へ移動体位置を補正した上でユーザに提示するのが一般的である。
【０００７】
この点、特許文献１には、ＧＰＳ電波を受信できないときに慣性航法センサを利用して移動体の位置及び速度を計算する場合、慣性航法センサのセンサ誤差及び出力誤差を地図情報に基づいて補正する装置が開示されている（段落［００３１］〜［００４０］記載の「実施の形態２」参照）。
【特許文献１】特開平９−１８９５６４号公報
【発明の開示】
【発明が解決しようとする課題】
【０００８】
しかしながら、従来のマップマッチング処理及び上記特許文献１に開示された地図情報を用いた補正処理はいずれも、地図情報が正確であるということを前提として、検出・推定された移動体位置の精度を地図情報の精度に揃える処理であって、結果として得られる補正後の移動体位置の精度は地図情報の精度を超えるものではない。
【０００９】
地図情報は、一般的に、複数のノードと、ノード間を結ぶ複数の直線リンクとから構成される。すなわち、従来のマップマッチング処理とは、検出・推定された移動体位置がいずれのリンク上にも位置しない場合に、当該移動体位置をいずれかのリンク上のいずれかの地点へ修正する処理に他ならない。
【００１０】
ところが、地図情報を記憶しておく記憶媒体の容量は有限であることから、地図情報にはノードが設定されるべきすべての道路形状変極点がノードとして登録されているわけではなく、ある程度「間引かれて」設定されている。すなわち、地図情報に含まれるノードとリンクによって描かれる道路形状は、実際の道路形状を必ずしも完全に再現したものではない。
【００１１】
このように必ずしも精度が良くない地図情報（ノード＆リンク情報）を基準となる正しい情報であるものとした従来のマップマッチング処理や上記特許文献１に開示された補正処理によれば、補正後の移動体位置が依然として比較的大きい誤差を含んでいる可能性があると共に、検出・推定された移動体位置の精度がマップマッチングなどの補正処理により一層劣化する可能性すらある。
【００１２】
一例を図１に示す。いま、図１（ａ）に示すように、実際の道路形状Ｒに対して、地図情報ではノードＮ１とノードＮ３が設定されており、破線で示したノードＮ２は道路が湾曲している地点であるにもかかわらず例えば記憶媒体の容量の制限などに起因して地図情報内にはノード情報として設定されなかったものとする。すると、同じく破線で示したリンクＬ１及びＬ２もリンク情報として設定されないことになり、地図情報にはノードＮ１とノードＮ３を直線で結ぶリンクＬ３が設定されることになる。すなわち、この地図情報によれば、道路形状はリンクＬ３に沿っているものとして認識され、表示されることになる。
【００１３】
このような地図情報を基準としてマップマッチング処理を行うと、例えば図１（ｂ）に示すように、ＧＰＳや慣性航法センサ群により検出・推定された移動体位置が位置Ｐ１であっても、或いは、実際の道路上の一点である位置Ｐ２であったとしても、マップマッチング処理により図示したようなリンクＬ３上の移動体位置Ｖに補正されてしまうことになる。
【００１４】
従来、マップマッチング処理の精度を向上させる手法は様々なものが提案されているが、上記のように検出・推定された移動体位置を地図情報に含まれるいずれかのリンク上のいずれかの地点へ修正することを固有の目的とするマップマッチング処理では、原理上、細部にどのような具体的手法を採用したとしても地図情報の精度に収束してしまうことは内在的な制約として避けられない。
【００１５】
たとえ検出・推定された移動体位置が道路上に位置するように補正され、ナビゲーションシステムにおける表示の問題が見かけ上解決されたとしても、移動体位置の精度が悪いと様々な不都合を生じる。
【００１６】
例えば、高精度ＧＰＳを車両に搭載し、数センチメートル程度の誤差しか含まれない高精度な位置検出を行って、検出された車両位置を様々な車両制御に利用するいわゆるナビゲーションシステム協調運転支援システム（例えば、警報や制動介入による交差点一時停止支援制御など）においては、ＧＰＳ電波の受信状態が悪くなっても車両制御継続のために車両位置を高精度に検出し続けなければならない。このような場合に、上記特許文献１に開示された装置のように慣性航法センサ及びその出力を地図情報で補正する手法では、自車両位置を基礎とした車両制御を継続し難いほど位置推定精度が劣化する可能性がある。
【００１７】
本発明はこのような課題を解決するためのものであり、移動体の位置検出・推定精度を地図情報精度に揃えてしまう従来のマップマッチングとは根本的に異なる概念により、道路形状や周辺環境に影響されずに高精度に移動体の位置を推定する移動体用位置推定装置を提供することを主たる目的とする。
【課題を解決するための手段】
【００１８】
上記目的を達成するための本発明の一態様は、移動体に搭載され、該移動体の位置を推定する移動体用位置推定装置であって、上記移動体に搭載された慣性航法センサ群（加速度センサ、ヨーレートセンサなど）の出力に基づいて当該移動体の位置を推定する第一の推定手段と、少なくともノード情報を含む地図情報を記憶した記憶手段と、上記ノード情報から予測された上記移動体の予想移動軌跡に基づいて当該移動体の位置を推定する第二の推定手段と、上記第一の推定手段により推定された移動体位置と、上記第二の推定手段により推定された移動体位置とを合成処理して上記移動体の最終推定位置を決定する合成手段とを有する移動体用位置推定装置である。
【００１９】
この一態様において、上記第一の推定手段は、上記合成手段により上記移動体の最終推定位置が決定されるたびに、最新の最終推定位置を新たなスタート地点として上記慣性航法センサ群の出力に基づいて移動体位置を推定する。
【００２０】
この一態様においては、Ａ）道路情報に含まれるノード情報とリンク情報に関して、既述のような「ノード飛び」によりリンク情報は比較的精度が良くないが、道路情報に含まれているノード情報自体は比較的精度が良いという考察、及び、Ｂ）慣性航法センサ群の出力に関して、Ｂ−１）時間がたつほど誤差が累積されて実際値との乖離が大きくなるが、基準となるスタート地点からあまり時間が経過していない段階では誤差が比較的小さいという考察、及び、Ｂ−２）瞬間瞬間での移動体の進行方向について比較的精度良く推定できるという考察、を前提としている。
【００２１】
すなわち、この一態様においては、隣接するノード間の実際の道路形状がリンク情報で表される直線ではない場合であっても、上記合成手段が、慣性航法センサ群出力から推定した移動体推定位置も考慮することによって、当該ノード間の実際の道路形状が慣性航法センサ群出力から求めた移動体進行方向から推定された上で最終的な移動体推定位置を判断できるようにすることができる。
【００２２】
この一態様によれば、移動体の位置を推定する際に、従来のマップマッチングのように移動体推定位置をいかなる場合でも道路情報に含まれるいずれかのリンク上へ持ってくる考えを排除し、道路情報により推定された移動体位置と慣性航法センサ群出力より推定された移動体位置とを総合的に判断することによって、両推定手法のうち精度が比較的良い部分同士のみを組み合わせ、すなわち道路情報に含まれるノード情報と慣性航法センサ群出力より推定される移動体進行方向とに基づいた移動体位置推定を実現することができるため、従来のマップマッチング手法よりも大幅に精度良く移動体位置を推定することができる。
【００２３】
なお、この一態様においては、高精度ＧＰＳが利用可能であれば誤差が非常に小さい移動体絶対位置が検出可能であることに鑑み、上記移動体用位置推定装置が通信（例えば高精度ＧＰＳ）を利用して上記移動体の位置の絶対座標を検出する位置検出手段を更に有する場合には、上記第一の推定手段、上記第二の推定手段、及び上記合成手段は、上記位置検出手段が上記通信を実行できないとき（ＧＰＳ電波の受信状態が悪いときなど）のみ作動するように設定することが好ましい。
【００２４】
この場合、上記第二の推定手段は、例えば、上記ノード情報のうち上記移動体の周辺のノードをａ）直線で又はｂ）所定の補間方法（例えば、クロソイド補間、スプライン補間、など）に基づいて曲線で結んで推定道路形状線と引き、上記位置検出手段によって検出された当該移動体の位置と上記推定道路形状線との道路幅方向のずれ量を求め、上記推定道路形状線を該ずれ量だけずらした線を上記予想移動軌跡とし、１）最後に移動体位置を推定したときから上記移動体の移動距離を検出する距離検出手段により検出された移動距離だけ上記予想移動軌跡に沿って移動した位置を新たな移動体位置として推定する、或いは、２）上記第一の推定手段により推定された移動体位置から上記予想移動軌跡に下ろした垂線と該予想移動軌跡との交点を移動体位置として推定することができる。
【発明の効果】
【００２５】
本発明によれば、道路形状や周辺環境に影響されずに高精度に移動体の位置を推定する移動体用位置推定装置を提供することができる。
【発明を実施するための最良の形態】
【００２６】
以下、本発明を実施するための最良の形態について、添付図面を参照しながら実施例を挙げて説明する。なお、ＧＰＳを利用した位置検出装置及び慣性航法センサ群出力に基づいて位置推定装置の基本概念、主要なハードウェア構成、作動原理、及び基本的な制御手法等については当業者には既知であるため、詳しい説明を省略する。
【実施例】
【００２７】
以下、図２〜６を用いて、本発明の一実施例に係る移動体用位置推定装置について説明する。本実施例では、代表的な一例として、移動体が車両であるものとする。
【００２８】
図２は、車両に搭載された本実施例に係る移動体用位置推定装置２００の概略構成図である。
【００２９】
移動体用位置推定装置２００は、自車両の現在位置の絶対座標を検出する手段として、例えばＲＴＫ−ＧＰＳなどの高精度ＧＰＳ装置２０１を有する。
【００３０】
移動体用位置推定装置２００は、更に、自車両の車速を検出する手段として、車輪速センサ２０２を有する。
【００３１】
移動体用位置推定装置２００は、更に、慣性航法センサ群２０３を有する。本実施例において、慣性航法センサ群２０３は、一例として、ヨーレートセンサと加速度センサ（前後、左右、上下）とを含むものとする。
【００３２】
移動体用位置推定装置２００は、更に、地図情報を予め記憶した記憶部２０４を有する。本実施例において、記憶部２０４は任意の記憶媒体でよい。また、記憶部２０４に記憶された地図情報は、例えば通信を利用して、適宜最新のデータに更新されることが好ましい。
【００３３】
移動体用位置推定装置２００は、更に、高精度な自車両の位置及び向きを推定する演算部２０５を有する。演算部２０５は、例えば、マイクロプロセッサを含む。
【００３４】
本実施例において、演算部２０５は、自車両の位置と向きを高精度に算出又は推定し、その結果を自車両現在位置の情報を利用する例えば運転支援システムなどへ提供する。移動体用位置推定装置２００自体は、ナビゲーションシステムの一部分であってもよい。
【００３５】
次いで、図３のフローチャートを参照して、移動体用位置推定装置２００による高精度な自車両位置及び向きの推定処理の流れについて説明する。
【００３６】
まず、高精度ＧＰＳ装置２０１は、ＧＰＳ電波の受信レベルや電波を受信できているＧＰＳ衛星の数などからＧＰＳデータの信頼性が十分であるか或いは信頼できないほど劣化しているかを判断する（Ｓ３０１）。
【００３７】
電波環境が良好である場合などＧＰＳの信頼性が十分であると判断された場合（Ｓ３０１の「ＮＯ」）、演算部２０５は高精度ＧＰＳ装置２０１によって検出された自車両現在位置の絶対座標により自車両の位置を高精度に検出できると共に、この絶対座標の時間変化を監視することによって自車両の向き（進行方向）も高精度に算出できる。検出・算出された自車両の位置及び向きは、上述のように運転支援システムなどへ提供される（Ｓ３０６）。
【００３８】
他方、電波環境が良好でない場合などＧＰＳの信頼性が低下していると判断された場合（Ｓ３０１の「ＹＥＳ」）、演算部２０５は、以降のＳ３０３〜Ｓ３０５において、ＧＰＳが利用できない代わりに、慣性航法センサ群２０３を利用して、自車両の位置及び向きを高精度に推定する。
【００３９】
より具体的には、演算部２０５は、記憶部２０４に記憶された地図情報から推定した自車両位置及び向きと慣性航法センサ群２０３出力から推定した自車両位置及び向きの双方を総合的に考慮して最終的な自車両の位置及び向きを推定する。
【００４０】
まず、演算部２０５は、記憶部２０４に記憶された地図情報に基づいて、自車両の位置及び向きを推定する（Ｓ３０３）。このＳ３０３における推定処理の詳細について、図５を参照しながら図４のフローチャートに沿って説明する。
【００４１】
演算部２０５は、高精度ＧＰＳ装置２０１よりＧＰＳの信頼性が低下したと判断されると、最後にＧＰＳデータにより取得された自車両位置ＸＳを記憶部２０４に記憶された地図情報に照らして、その最後にＧＰＳデータにより取得された自車両位置ＸＳ周辺のノード位置Ｎ及びリンク位置Ｌを抽出する（Ｓ４０１）。
【００４２】
次いで、演算部２０５は、最後にＧＰＳデータにより取得された自車両位置ＸＳから自車両がいずれのリンクＬ上に位置するかを判断し、そのリンクＬ上において最後にＧＰＳデータにより取得された自車両位置ＸＳの前後の所定数のノードＮ１〜Ｎ３を例えばクロソイド補間やスプライン補間などにより滑らかな近時曲線Ｓで結ぶ（Ｓ４０２）。
【００４３】
次いで、演算部２０５は、最後にＧＰＳデータにより取得された自車両位置ＸＳがノード情報Ｎから近似により推定された道路形状曲線Ｓから道路幅方向にどのくらいずれているかを表すオフセット量ΔＸを算出する（Ｓ４０３）。ここで、オフセット量ΔＸは、正負いずれの値も採り得るパラメータであり、道路幅方向における右方向又は左方向のいずれかを予めオフセット量ΔＸの正方向と決めておく。
【００４４】
次いで、演算部２０５は、推定道路形状曲線Ｓをオフセット量ΔＸだけオフセットさせた（平行移動させた）曲線Ｐを予想走行軌跡として算出する（Ｓ４０４）。
【００４５】
次いで、演算部２０５は、最後にＧＰＳデータにより自車両位置が取得された位置ＸＳの時点からの経過時間と車輪速センサ２０２の出力とに基づいて、位置ＸＳからの自車両の移動距離Ｄを算出し、自車両が予想走行軌跡Ｐに沿って移動したものと仮定して予想走行軌跡Ｐ上での現在位置ＸＰを求める（Ｓ４０５）。
【００４６】
さらに、演算部２０５は、位置ＸＰにおける予想走行軌跡Ｐの傾きを自車両の向き（ヨー、ピッチ）として推定する（Ｓ４０６）。
【００４７】
このようにして、本実施例においては、地図情報のうち比較的精度が良いと考えられるノード位置Ｎと最後にＧＰＳにより検出できた自車両位置ＸＳとを基準として、自車両がノード情報のみから推定された道路形状線に対して位置ＸＳにおける相対的位置関係を保ちながらこの推定道路形状線に沿って移動したと仮定した場合の位置ＸＰ及び向きが推定される。
【００４８】
図３に戻る。このようにして地図情報から自車両位置及び向きが推定される（Ｓ３０３）と、次いで、演算部２０５は、慣性航法センサ群の出力に基づいて、従来通り、自車両の位置及び向きを推定する（Ｓ３０４）。
【００４９】
ここでは、地図情報に基づく推定処理が先で、慣性航法センサ群出力に基づく推定処理が後のように説明及び図示しているが、両者の実施順は逆でもよく、同時平行で実施されてもよい。
【００５０】
このようにして、地図情報に基づいて自車両の位置及び向きが推定され、さらに、慣性航法センサ群出力に基づいて自車両の位置及び向きが推定されると、次いで、演算部２０５は、これら双方の推定結果が反映されるように例えばカルマンフィルタによる推定や最尤推定などを利用した合成処理を行って最終的な自車両の推定位置及び向きを決定する（Ｓ３０５）。
【００５１】
この合成処理について図６を参照して説明する。本実施例における合成処理では、地図情報に含まれるノード情報に関しては位置精度が比較的良好であるとの考察に基づき、ノード情報を基準として推定した自車両位置ＸＰを加味することによって、最終的な推定自車両位置のノードに対する相対的位置関係の精度を向上させる。
【００５２】
また、慣性航法センサ群の出力は、基準となるスタート地点から長時間経過すると誤差が累積されて精度が悪くなるが、瞬間瞬間での車両の進行方向に関しては検出精度が比較的良好であるとの考察に基づき、慣性航法センサ群出力に基づいて推定した自車両位置ＸＩを加味することによって、地図情報にノードが設定されていない領域であっても車両の進行方向に反映された実際の道路形状を加味し、最終的な推定自車両位置の実際の道路形状に対する位置精度を向上させる。
【００５３】
図６において、位置ＸＳにおいてＧＰＳの信頼性が低下したものとする。位置ＸＰ１は、上述のようにノード情報と位置ＸＳからの移動距離Ｄ１に基づいて推定された自車両位置を示している。また、位置ＸＩ１は、位置ＸＳをスタート地点として従来通りＧＰＳに代えて慣性航法センサ群の出力のみを用いて推定した自車両位置を示している。既述のように、慣性航法センサ群の出力に基づく推定は、図６に破線で示すように、スタート地点ＸＳから離れるほど誤差が累積されて実際の道路位置からの乖離が大きくなる。
【００５４】
そこで、本実施例では、実際のノード位置との相対的位置関係について比較的精度が良いと考えられる推定位置ＸＰ１と、曲率などの道路形状については比較的精度良く反映していると考えられる推定位置ＸＩ１とを双方の精度が良好な点がいずれも反映されるように合成処理することによって、最終的な自車両推定位置ＸＦ１を決定する。
【００５５】
最終的な自車両推定向きも、地図情報に基づいて推定された向きと、慣性航法センサ群出力に基づいて推定された向きとを上記位置推定の場合と同様に両推定の長所が組み合わされるように合成処理することによって得られる。
【００５６】
図３に戻る。このようにして最終的な自車両推定位置及び向きを求めると、演算部２０５はこれら結果を例えば運転支援システムなどへ提供する（Ｓ３０６）。
【００５７】
Ｓ３０３〜Ｓ３０５の工程は、ＧＰＳの信頼性が復帰するまで繰り返される。再度図６を参照すると、最終的な自車両推定位置ＸＦ１が決定された後、次の最終的な自車両推定位置ＸＦ２を決定する際には、決定されたばかりの位置ＸＦ１が新たなスタート地点として用いられる。すなわち、地図情報に基づく推定位置ＸＰ２の推定において位置ＸＰ１からの距離Ｄ２が用いられる。また、慣性航法センサ群出力に基づく推定位置ＸＩ２の推定においては、位置ＸＦ１を新たなスタート地点とするため、位置ＸＩ２に含まれる累積された誤差は比較的小さくて済む。
【００５８】
このように、本実施例によれば、ノード情報に基づいて推定された自車両位置及び向きと慣性航法センサ群出力に基づいて推定された自車両位置及び向きとを双方考慮して、ノード位置に対する相対的位置関係と道路形状の双方に対して精度の良い自車両推定位置及び向きを決定することができる。
【００５９】
なお、上記一実施例においては、慣性航法センサ群の一例としてヨーレートセンサと加速度センサの組み合わせを挙げたが、本発明はこれに限定されるものではなく、例えば、車輪速センサと舵角センサの組み合わせであってもよい。
【００６０】
また、上記一実施例においては、地図情報に基づいて自車両位置を推定する際に、自車両周辺のノードを補間処理によって滑らかな曲線Ｓに結び、これをオフセットしたものを予想走行軌跡Ｐとする場合を好ましい例として例示したが、補間処理を省きより簡素な処理とすることを狙いとして曲線Ｓの代わりに地図情報に含まれたリンク情報を用いることも当然可能である。
【００６１】
さらに、上記一実施例においては、地図情報に基づいて自車両位置を推定する際に、予想走行軌跡Ｐ上を車輪速センサ２０２の出力に基づいて算出された移動距離Ｄだけ移動したところを推定位置ＸＰとしたが、本発明はこれに限定されるものではなく、例えば、同時期に慣性航法センサ群出力に基づいて推定された位置ＸＩから予想走行軌跡Ｐへ下ろした垂線と予想走行軌跡Ｐとの交点を地図情報に基づく推定位置ＸＰとしてもよい。この場合、車輪速センサは不要となる。
【産業上の利用可能性】
【００６２】
本発明は、例えば車両などの移動体に搭載され、該移動体の位置を推定する移動体用位置推定装置に利用できる。車両に搭載される場合、本発明に係る移動体用位置推定装置はナビゲーションシステムの一部として構成されることが好ましい。また、この場合、搭載される車両の外観、重量、サイズ、走行性能等は問わない。
【図面の簡単な説明】
【００６３】
【図１】従来のマップマッチング処理の問題点を説明するための図である。
【図２】本発明の一実施例に係る移動体用位置推定装置の概略構成図である。
【図３】本発明の一実施例に係る移動体用位置推定装置による位置及び向き推定処理の流れを示すフローチャートである。
【図４】本発明の一実施例に係る移動体用位置推定装置による地図情報に基づいた位置及び向き推定処理の流れを示すフローチャートである。
【図５】本発明の一実施例に係る移動体用位置推定装置による地図情報に基づいた位置及び向き推定処理を説明するための図である。
【図６】本発明の一実施例に係る移動体用位置推定装置による合成処理を説明するための図である。
【符号の説明】
【００６４】
２００ 移動体用位置推定装置
２０１ 高精度ＧＰＳ装置
２０２ 車輪速センサ
２０３ 慣性航法センサ群
２０４ 記憶部
２０５ 演算部
【技術分野】
【０００１】
本発明は、概して、移動体に搭載され、該移動体の位置を推定する移動体用位置推定装置に係り、特に、道路形状や周辺環境に影響されずに高精度に移動体の位置を推定する移動体用位置推定装置に関する。
【背景技術】
【０００２】
従来、例えば車両などの移動体に搭載され、該移動体の位置を推定する移動体用位置推定装置が知られている（例えば、特許文献１参照）。このような装置は、典型的には、ナビゲーションシステムに含まれている。
【０００３】
ここで、移動体の位置を検出・推定する手法としては、ＧＰＳ（Ｇｌｏｂａｌ Ｐｏｓｉｔｉｏｎｉｎｇ Ｓｙｓｔｅｍ；全地球測位システム）を利用して当該移動体の絶対座標を取得する手法が周知である。
【０００４】
また、ＧＰＳ衛星からの電波受信状態が良好でないときに備えて、加速度センサやヨーレートセンサなどの慣性航法センサ群を移動体に搭載しておき、ＧＰＳを利用して移動体の位置を検出できないときには慣性航法センサ群の出力から移動体位置を推定する手法も周知である。
【０００５】
既存のＧＰＳは、ＲＴＫ（Ｒｅａｌ Ｔｉｍｅ Ｋｉｎｅｍａｔｉｃ）−ＧＰＳなどの高精度ＧＰＳよりも測位精度が悪く、数十メートル程度の誤差を生じ得る。また、慣性航法センサ群は、いわゆるドリフトにより時間の経過と共に精度が劣化するという性質を有する。
【０００６】
そこで、従来のナビゲーションシステムにおいては、検出・推定した移動体位置を予め保持している地図情報に照らした際に移動体位置が道路上に位置しなかった場合、いわゆるマップマッチング処理により道路上のいずれかの位置へ移動体位置を補正した上でユーザに提示するのが一般的である。
【０００７】
この点、特許文献１には、ＧＰＳ電波を受信できないときに慣性航法センサを利用して移動体の位置及び速度を計算する場合、慣性航法センサのセンサ誤差及び出力誤差を地図情報に基づいて補正する装置が開示されている（段落［００３１］〜［００４０］記載の「実施の形態２」参照）。
【特許文献１】特開平９−１８９５６４号公報
【発明の開示】
【発明が解決しようとする課題】
【０００８】
しかしながら、従来のマップマッチング処理及び上記特許文献１に開示された地図情報を用いた補正処理はいずれも、地図情報が正確であるということを前提として、検出・推定された移動体位置の精度を地図情報の精度に揃える処理であって、結果として得られる補正後の移動体位置の精度は地図情報の精度を超えるものではない。
【０００９】
地図情報は、一般的に、複数のノードと、ノード間を結ぶ複数の直線リンクとから構成される。すなわち、従来のマップマッチング処理とは、検出・推定された移動体位置がいずれのリンク上にも位置しない場合に、当該移動体位置をいずれかのリンク上のいずれかの地点へ修正する処理に他ならない。
【００１０】
ところが、地図情報を記憶しておく記憶媒体の容量は有限であることから、地図情報にはノードが設定されるべきすべての道路形状変極点がノードとして登録されているわけではなく、ある程度「間引かれて」設定されている。すなわち、地図情報に含まれるノードとリンクによって描かれる道路形状は、実際の道路形状を必ずしも完全に再現したものではない。
【００１１】
このように必ずしも精度が良くない地図情報（ノード＆リンク情報）を基準となる正しい情報であるものとした従来のマップマッチング処理や上記特許文献１に開示された補正処理によれば、補正後の移動体位置が依然として比較的大きい誤差を含んでいる可能性があると共に、検出・推定された移動体位置の精度がマップマッチングなどの補正処理により一層劣化する可能性すらある。
【００１２】
一例を図１に示す。いま、図１（ａ）に示すように、実際の道路形状Ｒに対して、地図情報ではノードＮ１とノードＮ３が設定されており、破線で示したノードＮ２は道路が湾曲している地点であるにもかかわらず例えば記憶媒体の容量の制限などに起因して地図情報内にはノード情報として設定されなかったものとする。すると、同じく破線で示したリンクＬ１及びＬ２もリンク情報として設定されないことになり、地図情報にはノードＮ１とノードＮ３を直線で結ぶリンクＬ３が設定されることになる。すなわち、この地図情報によれば、道路形状はリンクＬ３に沿っているものとして認識され、表示されることになる。
【００１３】
このような地図情報を基準としてマップマッチング処理を行うと、例えば図１（ｂ）に示すように、ＧＰＳや慣性航法センサ群により検出・推定された移動体位置が位置Ｐ１であっても、或いは、実際の道路上の一点である位置Ｐ２であったとしても、マップマッチング処理により図示したようなリンクＬ３上の移動体位置Ｖに補正されてしまうことになる。
【００１４】
従来、マップマッチング処理の精度を向上させる手法は様々なものが提案されているが、上記のように検出・推定された移動体位置を地図情報に含まれるいずれかのリンク上のいずれかの地点へ修正することを固有の目的とするマップマッチング処理では、原理上、細部にどのような具体的手法を採用したとしても地図情報の精度に収束してしまうことは内在的な制約として避けられない。
【００１５】
たとえ検出・推定された移動体位置が道路上に位置するように補正され、ナビゲーションシステムにおける表示の問題が見かけ上解決されたとしても、移動体位置の精度が悪いと様々な不都合を生じる。
【００１６】
例えば、高精度ＧＰＳを車両に搭載し、数センチメートル程度の誤差しか含まれない高精度な位置検出を行って、検出された車両位置を様々な車両制御に利用するいわゆるナビゲーションシステム協調運転支援システム（例えば、警報や制動介入による交差点一時停止支援制御など）においては、ＧＰＳ電波の受信状態が悪くなっても車両制御継続のために車両位置を高精度に検出し続けなければならない。このような場合に、上記特許文献１に開示された装置のように慣性航法センサ及びその出力を地図情報で補正する手法では、自車両位置を基礎とした車両制御を継続し難いほど位置推定精度が劣化する可能性がある。
【００１７】
本発明はこのような課題を解決するためのものであり、移動体の位置検出・推定精度を地図情報精度に揃えてしまう従来のマップマッチングとは根本的に異なる概念により、道路形状や周辺環境に影響されずに高精度に移動体の位置を推定する移動体用位置推定装置を提供することを主たる目的とする。
【課題を解決するための手段】
【００１８】
上記目的を達成するための本発明の一態様は、移動体に搭載され、該移動体の位置を推定する移動体用位置推定装置であって、上記移動体に搭載された慣性航法センサ群（加速度センサ、ヨーレートセンサなど）の出力に基づいて当該移動体の位置を推定する第一の推定手段と、少なくともノード情報を含む地図情報を記憶した記憶手段と、上記ノード情報から予測された上記移動体の予想移動軌跡に基づいて当該移動体の位置を推定する第二の推定手段と、上記第一の推定手段により推定された移動体位置と、上記第二の推定手段により推定された移動体位置とを合成処理して上記移動体の最終推定位置を決定する合成手段とを有する移動体用位置推定装置である。
【００１９】
この一態様において、上記第一の推定手段は、上記合成手段により上記移動体の最終推定位置が決定されるたびに、最新の最終推定位置を新たなスタート地点として上記慣性航法センサ群の出力に基づいて移動体位置を推定する。
【００２０】
この一態様においては、Ａ）道路情報に含まれるノード情報とリンク情報に関して、既述のような「ノード飛び」によりリンク情報は比較的精度が良くないが、道路情報に含まれているノード情報自体は比較的精度が良いという考察、及び、Ｂ）慣性航法センサ群の出力に関して、Ｂ−１）時間がたつほど誤差が累積されて実際値との乖離が大きくなるが、基準となるスタート地点からあまり時間が経過していない段階では誤差が比較的小さいという考察、及び、Ｂ−２）瞬間瞬間での移動体の進行方向について比較的精度良く推定できるという考察、を前提としている。
【００２１】
すなわち、この一態様においては、隣接するノード間の実際の道路形状がリンク情報で表される直線ではない場合であっても、上記合成手段が、慣性航法センサ群出力から推定した移動体推定位置も考慮することによって、当該ノード間の実際の道路形状が慣性航法センサ群出力から求めた移動体進行方向から推定された上で最終的な移動体推定位置を判断できるようにすることができる。
【００２２】
この一態様によれば、移動体の位置を推定する際に、従来のマップマッチングのように移動体推定位置をいかなる場合でも道路情報に含まれるいずれかのリンク上へ持ってくる考えを排除し、道路情報により推定された移動体位置と慣性航法センサ群出力より推定された移動体位置とを総合的に判断することによって、両推定手法のうち精度が比較的良い部分同士のみを組み合わせ、すなわち道路情報に含まれるノード情報と慣性航法センサ群出力より推定される移動体進行方向とに基づいた移動体位置推定を実現することができるため、従来のマップマッチング手法よりも大幅に精度良く移動体位置を推定することができる。
【００２３】
なお、この一態様においては、高精度ＧＰＳが利用可能であれば誤差が非常に小さい移動体絶対位置が検出可能であることに鑑み、上記移動体用位置推定装置が通信（例えば高精度ＧＰＳ）を利用して上記移動体の位置の絶対座標を検出する位置検出手段を更に有する場合には、上記第一の推定手段、上記第二の推定手段、及び上記合成手段は、上記位置検出手段が上記通信を実行できないとき（ＧＰＳ電波の受信状態が悪いときなど）のみ作動するように設定することが好ましい。
【００２４】
この場合、上記第二の推定手段は、例えば、上記ノード情報のうち上記移動体の周辺のノードをａ）直線で又はｂ）所定の補間方法（例えば、クロソイド補間、スプライン補間、など）に基づいて曲線で結んで推定道路形状線と引き、上記位置検出手段によって検出された当該移動体の位置と上記推定道路形状線との道路幅方向のずれ量を求め、上記推定道路形状線を該ずれ量だけずらした線を上記予想移動軌跡とし、１）最後に移動体位置を推定したときから上記移動体の移動距離を検出する距離検出手段により検出された移動距離だけ上記予想移動軌跡に沿って移動した位置を新たな移動体位置として推定する、或いは、２）上記第一の推定手段により推定された移動体位置から上記予想移動軌跡に下ろした垂線と該予想移動軌跡との交点を移動体位置として推定することができる。
【発明の効果】
【００２５】
本発明によれば、道路形状や周辺環境に影響されずに高精度に移動体の位置を推定する移動体用位置推定装置を提供することができる。
【発明を実施するための最良の形態】
【００２６】
以下、本発明を実施するための最良の形態について、添付図面を参照しながら実施例を挙げて説明する。なお、ＧＰＳを利用した位置検出装置及び慣性航法センサ群出力に基づいて位置推定装置の基本概念、主要なハードウェア構成、作動原理、及び基本的な制御手法等については当業者には既知であるため、詳しい説明を省略する。
【実施例】
【００２７】
以下、図２〜６を用いて、本発明の一実施例に係る移動体用位置推定装置について説明する。本実施例では、代表的な一例として、移動体が車両であるものとする。
【００２８】
図２は、車両に搭載された本実施例に係る移動体用位置推定装置２００の概略構成図である。
【００２９】
移動体用位置推定装置２００は、自車両の現在位置の絶対座標を検出する手段として、例えばＲＴＫ−ＧＰＳなどの高精度ＧＰＳ装置２０１を有する。
【００３０】
移動体用位置推定装置２００は、更に、自車両の車速を検出する手段として、車輪速センサ２０２を有する。
【００３１】
移動体用位置推定装置２００は、更に、慣性航法センサ群２０３を有する。本実施例において、慣性航法センサ群２０３は、一例として、ヨーレートセンサと加速度センサ（前後、左右、上下）とを含むものとする。
【００３２】
移動体用位置推定装置２００は、更に、地図情報を予め記憶した記憶部２０４を有する。本実施例において、記憶部２０４は任意の記憶媒体でよい。また、記憶部２０４に記憶された地図情報は、例えば通信を利用して、適宜最新のデータに更新されることが好ましい。
【００３３】
移動体用位置推定装置２００は、更に、高精度な自車両の位置及び向きを推定する演算部２０５を有する。演算部２０５は、例えば、マイクロプロセッサを含む。
【００３４】
本実施例において、演算部２０５は、自車両の位置と向きを高精度に算出又は推定し、その結果を自車両現在位置の情報を利用する例えば運転支援システムなどへ提供する。移動体用位置推定装置２００自体は、ナビゲーションシステムの一部分であってもよい。
【００３５】
次いで、図３のフローチャートを参照して、移動体用位置推定装置２００による高精度な自車両位置及び向きの推定処理の流れについて説明する。
【００３６】
まず、高精度ＧＰＳ装置２０１は、ＧＰＳ電波の受信レベルや電波を受信できているＧＰＳ衛星の数などからＧＰＳデータの信頼性が十分であるか或いは信頼できないほど劣化しているかを判断する（Ｓ３０１）。
【００３７】
電波環境が良好である場合などＧＰＳの信頼性が十分であると判断された場合（Ｓ３０１の「ＮＯ」）、演算部２０５は高精度ＧＰＳ装置２０１によって検出された自車両現在位置の絶対座標により自車両の位置を高精度に検出できると共に、この絶対座標の時間変化を監視することによって自車両の向き（進行方向）も高精度に算出できる。検出・算出された自車両の位置及び向きは、上述のように運転支援システムなどへ提供される（Ｓ３０６）。
【００３８】
他方、電波環境が良好でない場合などＧＰＳの信頼性が低下していると判断された場合（Ｓ３０１の「ＹＥＳ」）、演算部２０５は、以降のＳ３０３〜Ｓ３０５において、ＧＰＳが利用できない代わりに、慣性航法センサ群２０３を利用して、自車両の位置及び向きを高精度に推定する。
【００３９】
より具体的には、演算部２０５は、記憶部２０４に記憶された地図情報から推定した自車両位置及び向きと慣性航法センサ群２０３出力から推定した自車両位置及び向きの双方を総合的に考慮して最終的な自車両の位置及び向きを推定する。
【００４０】
まず、演算部２０５は、記憶部２０４に記憶された地図情報に基づいて、自車両の位置及び向きを推定する（Ｓ３０３）。このＳ３０３における推定処理の詳細について、図５を参照しながら図４のフローチャートに沿って説明する。
【００４１】
演算部２０５は、高精度ＧＰＳ装置２０１よりＧＰＳの信頼性が低下したと判断されると、最後にＧＰＳデータにより取得された自車両位置ＸＳを記憶部２０４に記憶された地図情報に照らして、その最後にＧＰＳデータにより取得された自車両位置ＸＳ周辺のノード位置Ｎ及びリンク位置Ｌを抽出する（Ｓ４０１）。
【００４２】
次いで、演算部２０５は、最後にＧＰＳデータにより取得された自車両位置ＸＳから自車両がいずれのリンクＬ上に位置するかを判断し、そのリンクＬ上において最後にＧＰＳデータにより取得された自車両位置ＸＳの前後の所定数のノードＮ１〜Ｎ３を例えばクロソイド補間やスプライン補間などにより滑らかな近時曲線Ｓで結ぶ（Ｓ４０２）。
【００４３】
次いで、演算部２０５は、最後にＧＰＳデータにより取得された自車両位置ＸＳがノード情報Ｎから近似により推定された道路形状曲線Ｓから道路幅方向にどのくらいずれているかを表すオフセット量ΔＸを算出する（Ｓ４０３）。ここで、オフセット量ΔＸは、正負いずれの値も採り得るパラメータであり、道路幅方向における右方向又は左方向のいずれかを予めオフセット量ΔＸの正方向と決めておく。
【００４４】
次いで、演算部２０５は、推定道路形状曲線Ｓをオフセット量ΔＸだけオフセットさせた（平行移動させた）曲線Ｐを予想走行軌跡として算出する（Ｓ４０４）。
【００４５】
次いで、演算部２０５は、最後にＧＰＳデータにより自車両位置が取得された位置ＸＳの時点からの経過時間と車輪速センサ２０２の出力とに基づいて、位置ＸＳからの自車両の移動距離Ｄを算出し、自車両が予想走行軌跡Ｐに沿って移動したものと仮定して予想走行軌跡Ｐ上での現在位置ＸＰを求める（Ｓ４０５）。
【００４６】
さらに、演算部２０５は、位置ＸＰにおける予想走行軌跡Ｐの傾きを自車両の向き（ヨー、ピッチ）として推定する（Ｓ４０６）。
【００４７】
このようにして、本実施例においては、地図情報のうち比較的精度が良いと考えられるノード位置Ｎと最後にＧＰＳにより検出できた自車両位置ＸＳとを基準として、自車両がノード情報のみから推定された道路形状線に対して位置ＸＳにおける相対的位置関係を保ちながらこの推定道路形状線に沿って移動したと仮定した場合の位置ＸＰ及び向きが推定される。
【００４８】
図３に戻る。このようにして地図情報から自車両位置及び向きが推定される（Ｓ３０３）と、次いで、演算部２０５は、慣性航法センサ群の出力に基づいて、従来通り、自車両の位置及び向きを推定する（Ｓ３０４）。
【００４９】
ここでは、地図情報に基づく推定処理が先で、慣性航法センサ群出力に基づく推定処理が後のように説明及び図示しているが、両者の実施順は逆でもよく、同時平行で実施されてもよい。
【００５０】
このようにして、地図情報に基づいて自車両の位置及び向きが推定され、さらに、慣性航法センサ群出力に基づいて自車両の位置及び向きが推定されると、次いで、演算部２０５は、これら双方の推定結果が反映されるように例えばカルマンフィルタによる推定や最尤推定などを利用した合成処理を行って最終的な自車両の推定位置及び向きを決定する（Ｓ３０５）。
【００５１】
この合成処理について図６を参照して説明する。本実施例における合成処理では、地図情報に含まれるノード情報に関しては位置精度が比較的良好であるとの考察に基づき、ノード情報を基準として推定した自車両位置ＸＰを加味することによって、最終的な推定自車両位置のノードに対する相対的位置関係の精度を向上させる。
【００５２】
また、慣性航法センサ群の出力は、基準となるスタート地点から長時間経過すると誤差が累積されて精度が悪くなるが、瞬間瞬間での車両の進行方向に関しては検出精度が比較的良好であるとの考察に基づき、慣性航法センサ群出力に基づいて推定した自車両位置ＸＩを加味することによって、地図情報にノードが設定されていない領域であっても車両の進行方向に反映された実際の道路形状を加味し、最終的な推定自車両位置の実際の道路形状に対する位置精度を向上させる。
【００５３】
図６において、位置ＸＳにおいてＧＰＳの信頼性が低下したものとする。位置ＸＰ１は、上述のようにノード情報と位置ＸＳからの移動距離Ｄ１に基づいて推定された自車両位置を示している。また、位置ＸＩ１は、位置ＸＳをスタート地点として従来通りＧＰＳに代えて慣性航法センサ群の出力のみを用いて推定した自車両位置を示している。既述のように、慣性航法センサ群の出力に基づく推定は、図６に破線で示すように、スタート地点ＸＳから離れるほど誤差が累積されて実際の道路位置からの乖離が大きくなる。
【００５４】
そこで、本実施例では、実際のノード位置との相対的位置関係について比較的精度が良いと考えられる推定位置ＸＰ１と、曲率などの道路形状については比較的精度良く反映していると考えられる推定位置ＸＩ１とを双方の精度が良好な点がいずれも反映されるように合成処理することによって、最終的な自車両推定位置ＸＦ１を決定する。
【００５５】
最終的な自車両推定向きも、地図情報に基づいて推定された向きと、慣性航法センサ群出力に基づいて推定された向きとを上記位置推定の場合と同様に両推定の長所が組み合わされるように合成処理することによって得られる。
【００５６】
図３に戻る。このようにして最終的な自車両推定位置及び向きを求めると、演算部２０５はこれら結果を例えば運転支援システムなどへ提供する（Ｓ３０６）。
【００５７】
Ｓ３０３〜Ｓ３０５の工程は、ＧＰＳの信頼性が復帰するまで繰り返される。再度図６を参照すると、最終的な自車両推定位置ＸＦ１が決定された後、次の最終的な自車両推定位置ＸＦ２を決定する際には、決定されたばかりの位置ＸＦ１が新たなスタート地点として用いられる。すなわち、地図情報に基づく推定位置ＸＰ２の推定において位置ＸＰ１からの距離Ｄ２が用いられる。また、慣性航法センサ群出力に基づく推定位置ＸＩ２の推定においては、位置ＸＦ１を新たなスタート地点とするため、位置ＸＩ２に含まれる累積された誤差は比較的小さくて済む。
【００５８】
このように、本実施例によれば、ノード情報に基づいて推定された自車両位置及び向きと慣性航法センサ群出力に基づいて推定された自車両位置及び向きとを双方考慮して、ノード位置に対する相対的位置関係と道路形状の双方に対して精度の良い自車両推定位置及び向きを決定することができる。
【００５９】
なお、上記一実施例においては、慣性航法センサ群の一例としてヨーレートセンサと加速度センサの組み合わせを挙げたが、本発明はこれに限定されるものではなく、例えば、車輪速センサと舵角センサの組み合わせであってもよい。
【００６０】
また、上記一実施例においては、地図情報に基づいて自車両位置を推定する際に、自車両周辺のノードを補間処理によって滑らかな曲線Ｓに結び、これをオフセットしたものを予想走行軌跡Ｐとする場合を好ましい例として例示したが、補間処理を省きより簡素な処理とすることを狙いとして曲線Ｓの代わりに地図情報に含まれたリンク情報を用いることも当然可能である。
【００６１】
さらに、上記一実施例においては、地図情報に基づいて自車両位置を推定する際に、予想走行軌跡Ｐ上を車輪速センサ２０２の出力に基づいて算出された移動距離Ｄだけ移動したところを推定位置ＸＰとしたが、本発明はこれに限定されるものではなく、例えば、同時期に慣性航法センサ群出力に基づいて推定された位置ＸＩから予想走行軌跡Ｐへ下ろした垂線と予想走行軌跡Ｐとの交点を地図情報に基づく推定位置ＸＰとしてもよい。この場合、車輪速センサは不要となる。
【産業上の利用可能性】
【００６２】
本発明は、例えば車両などの移動体に搭載され、該移動体の位置を推定する移動体用位置推定装置に利用できる。車両に搭載される場合、本発明に係る移動体用位置推定装置はナビゲーションシステムの一部として構成されることが好ましい。また、この場合、搭載される車両の外観、重量、サイズ、走行性能等は問わない。
【図面の簡単な説明】
【００６３】
【図１】従来のマップマッチング処理の問題点を説明するための図である。
【図２】本発明の一実施例に係る移動体用位置推定装置の概略構成図である。
【図３】本発明の一実施例に係る移動体用位置推定装置による位置及び向き推定処理の流れを示すフローチャートである。
【図４】本発明の一実施例に係る移動体用位置推定装置による地図情報に基づいた位置及び向き推定処理の流れを示すフローチャートである。
【図５】本発明の一実施例に係る移動体用位置推定装置による地図情報に基づいた位置及び向き推定処理を説明するための図である。
【図６】本発明の一実施例に係る移動体用位置推定装置による合成処理を説明するための図である。
【符号の説明】
【００６４】
２００ 移動体用位置推定装置
２０１ 高精度ＧＰＳ装置
２０２ 車輪速センサ
２０３ 慣性航法センサ群
２０４ 記憶部
２０５ 演算部
【特許請求の範囲】
【請求項１】
移動体に搭載され、該移動体の位置を推定する移動体用位置推定装置であって、
前記移動体に搭載された慣性航法センサ群の出力に基づいて当該移動体の位置を推定する第一の推定手段と、
少なくともノード情報を含む地図情報を記憶した記憶手段と、
前記ノード情報から予測された前記移動体の予想移動軌跡に基づいて当該移動体の位置を推定する第二の推定手段と、
前記第一の推定手段により推定された移動体位置と、前記第二の推定手段により推定された移動体位置とを合成処理して前記移動体の最終推定位置を決定する合成手段と、を有することを特徴とする移動体用位置推定装置。
【請求項２】
請求項１記載の移動体用位置推定装置であって、
前記第一の推定手段は、前記合成手段により前記移動体の最終推定位置が決定されるたびに、最新の最終推定位置を新たなスタート地点として前記慣性航法センサ群の出力に基づいて移動体位置を推定する、ことを特徴とする移動体用位置推定装置。
【請求項３】
請求項１又は２記載の移動体用位置推定装置であって、
通信を利用して前記移動体の位置の絶対座標を検出する位置検出手段を更に有し、
前記第一の推定手段、前記第二の推定手段、及び前記合成手段は、前記位置検出手段が前記通信を実行できないときのみ作動する、ことを特徴とする移動体用位置推定装置。
【請求項４】
請求項３記載の移動体用位置推定装置であって、
前記第二の推定手段は、
前記ノード情報のうち前記移動体の周辺のノードを結んで推定道路形状線と引き、
前記位置検出手段によって検出された当該移動体の位置と前記推定道路形状線との道路幅方向のずれ量を求め、
前記推定道路形状線を前記ずれ量だけずらした線を前記予想移動軌跡とする、ことを特徴とする移動体用位置推定装置。
【請求項５】
請求項４記載の移動体用位置推定装置であって、
前記第二の推定手段は、前記周辺のノードを所定の補間方法に基づいて曲線で結び前記推定道路形状線とする、ことを特徴とする移動体用位置推定装置。
【請求項６】
請求項４又は５記載の移動体用位置推定装置であって、
前記第二の推定手段は、
前記移動体の移動距離を検出する距離検出手段を含み、
最後に移動体位置を推定したときから前記距離検出手段により検出された移動距離だけ前記予想移動軌跡に沿って移動した位置を新たな移動体位置として推定する、ことを特徴とする移動体用位置推定装置。
【請求項７】
請求項４又は５記載の移動体用位置推定装置であって、
前記第二の推定手段は、前記第一の推定手段により推定された移動体位置から前記予想移動軌跡に下ろした垂線と該予想移動軌跡との交点を移動体位置として推定する、ことを特徴とする移動体用位置推定装置。
【請求項１】
移動体に搭載され、該移動体の位置を推定する移動体用位置推定装置であって、
前記移動体に搭載された慣性航法センサ群の出力に基づいて当該移動体の位置を推定する第一の推定手段と、
少なくともノード情報を含む地図情報を記憶した記憶手段と、
前記ノード情報から予測された前記移動体の予想移動軌跡に基づいて当該移動体の位置を推定する第二の推定手段と、
前記第一の推定手段により推定された移動体位置と、前記第二の推定手段により推定された移動体位置とを合成処理して前記移動体の最終推定位置を決定する合成手段と、を有することを特徴とする移動体用位置推定装置。
【請求項２】
請求項１記載の移動体用位置推定装置であって、
前記第一の推定手段は、前記合成手段により前記移動体の最終推定位置が決定されるたびに、最新の最終推定位置を新たなスタート地点として前記慣性航法センサ群の出力に基づいて移動体位置を推定する、ことを特徴とする移動体用位置推定装置。
【請求項３】
請求項１又は２記載の移動体用位置推定装置であって、
通信を利用して前記移動体の位置の絶対座標を検出する位置検出手段を更に有し、
前記第一の推定手段、前記第二の推定手段、及び前記合成手段は、前記位置検出手段が前記通信を実行できないときのみ作動する、ことを特徴とする移動体用位置推定装置。
【請求項４】
請求項３記載の移動体用位置推定装置であって、
前記第二の推定手段は、
前記ノード情報のうち前記移動体の周辺のノードを結んで推定道路形状線と引き、
前記位置検出手段によって検出された当該移動体の位置と前記推定道路形状線との道路幅方向のずれ量を求め、
前記推定道路形状線を前記ずれ量だけずらした線を前記予想移動軌跡とする、ことを特徴とする移動体用位置推定装置。
【請求項５】
請求項４記載の移動体用位置推定装置であって、
前記第二の推定手段は、前記周辺のノードを所定の補間方法に基づいて曲線で結び前記推定道路形状線とする、ことを特徴とする移動体用位置推定装置。
【請求項６】
請求項４又は５記載の移動体用位置推定装置であって、
前記第二の推定手段は、
前記移動体の移動距離を検出する距離検出手段を含み、
最後に移動体位置を推定したときから前記距離検出手段により検出された移動距離だけ前記予想移動軌跡に沿って移動した位置を新たな移動体位置として推定する、ことを特徴とする移動体用位置推定装置。
【請求項７】
請求項４又は５記載の移動体用位置推定装置であって、
前記第二の推定手段は、前記第一の推定手段により推定された移動体位置から前記予想移動軌跡に下ろした垂線と該予想移動軌跡との交点を移動体位置として推定する、ことを特徴とする移動体用位置推定装置。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図２】
【図３】
【図４】
【図５】
【図６】
【公開番号】特開２００７−１３９６０１（Ｐ２００７−１３９６０１Ａ）
【公開日】平成１９年６月７日（２００７．６．７）
【国際特許分類】
【出願番号】特願２００５−３３４３９５（Ｐ２００５−３３４３９５）
【出願日】平成１７年１１月１８日（２００５．１１．１８）
【出願人】（０００００３２０７）トヨタ自動車株式会社 (59,920)
【Ｆターム（参考）】
【公開日】平成１９年６月７日（２００７．６．７）
【国際特許分類】
【出願日】平成１７年１１月１８日（２００５．１１．１８）
【出願人】（０００００３２０７）トヨタ自動車株式会社 (59,920)
【Ｆターム（参考）】
[ Back to top ]