位置算出方法及び位置算出装置
【課題】 移動体に備えられた衛星測位用ユニット及び慣性測位用ユニットの計測結果を併用した位置算出手法の提案。
【解決手段】 ＧＰＳユニット３とＩＮＳユニット５とを備えた位置算出装置１において、位置算出精度判定部６は、位置算出精度を判定する。影響度合設定部７は、位置算出精度判定部６により判定された位置算出精度に基づいて、ＧＰＳ計測結果のＩＮＳ計測結果に対する影響度合を設定する。カップリング処理部９は、影響度合設定部７により設定された影響度合に基づいてＧＰＳ計測結果とＩＮＳ計測結果とのカップリング処理を実行して、移動体の位置を算出する。
【解決手段】 ＧＰＳユニット３とＩＮＳユニット５とを備えた位置算出装置１において、位置算出精度判定部６は、位置算出精度を判定する。影響度合設定部７は、位置算出精度判定部６により判定された位置算出精度に基づいて、ＧＰＳ計測結果のＩＮＳ計測結果に対する影響度合を設定する。カップリング処理部９は、影響度合設定部７により設定された影響度合に基づいてＧＰＳ計測結果とＩＮＳ計測結果とのカップリング処理を実行して、移動体の位置を算出する。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、移動体に備えられた衛星測位用ユニット及び慣性測位用ユニットの計測結果を用いた位置算出方法等に関する。
【背景技術】
【０００２】
いわゆるシームレス測位やモーションセンシング、姿勢制御など様々な分野において、慣性センサーの活用が注目されている。慣性センサーとしては、加速度センサーやジャイロセンサー、圧力センサー、地磁気センサーなどが広く知られている。慣性センサーの検出結果を利用して慣性航法演算を行って位置算出を行うシステム（以下、「ＩＮＳ（Inertial Navigation System）」と称する。）も実用化されている。
【０００３】
ＩＮＳにおいては、慣性センサーの検出結果に含まれ得る種々の誤差成分に起因して位置算出の正確性が低下するという問題があり、位置算出の正確性を向上させるための様々な技術が考案されている。例えば、特許文献１には、ＩＮＳ演算結果を、ＧＰＳ（Global Positioning System）を利用して補正する技術が開示されている。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】米国特許出願公開第２０１０／００１９９６３号明細書
【発明の概要】
【発明が解決しようとする課題】
【０００５】
ＧＰＳを利用してＩＮＳ演算結果を補正する技術は、ＧＰＳ演算結果が正しいことを前提としている。特許文献１に開示された技術も同様である。しかし、ＧＰＳ演算結果は、ＧＰＳ衛星から受信したＧＰＳ衛星信号の信号強度、受信環境、ＧＰＳ衛星の天空配置、マルチパスといった種々の要因により、演算結果の精度が低下する場合がある。このため、常にＧＰＳ演算結果を利用してＩＮＳ演算結果を補正することが、必ずしも位置算出の精度改善に繋がるとは限らなかった。
【０００６】
本発明は上述した課題に鑑みて為されたものであり、移動体に備えられた衛星測位用ユニット及び慣性測位用ユニットの計測結果を併用して、移動体の位置をより正確に算出するための手法を提案することを目的とする。
【課題を解決するための手段】
【０００７】
以上の課題を解決するための第１の形態は、移動体に備えられた衛星測位用ユニットの第１の計測結果と、前記移動体に備えられた慣性測位用ユニットの第２の計測結果とを用いて、前記移動体の位置を算出する位置算出方法であって、位置算出精度を判定することと、前記位置算出精度に基づいて、前記第１の計測結果の前記第２の計測結果に対する影響度合を設定することと、前記影響度合に基づき、前記第１の計測結果と前記第２の計測結果とのカップリング処理を実行して前記移動体の位置を算出することと、を含む位置算出方法である。
【０００８】
また、他の形態として、移動体に備えられた衛星測位用ユニットの第１の計測結果と、前記移動体に備えられた慣性測位用ユニットの第２の計測結果とを用いて、前記移動体の位置を算出する位置算出装置であって、位置算出精度を判定する位置算出精度判定部と、前記位置算出精度に基づいて、前記第１の計測結果の前記第２の計測結果に対する影響度合を設定する影響度合設定部と、前記影響度合に基づき、前記第１の計測結果と前記第２の計測結果とのカップリング処理を実行して前記移動体の位置を算出するカップリング処理部と、を備えた位置算出装置を構成してもよい。
【０００９】
この第１の形態等によれば、位置算出精度を判定する。そして、位置算出精度に基づいて、慣性測位用ユニットの計測結果（第２の計測結果）に対する衛星測位用ユニットの計測結果（第１の計測結果）の影響度合を設定する。これにより、特に連続動作時における影響度合の適正化を実現することができる。そして、適正化した影響度合に基づき第１の計測結果と第２の計測結果とのカップリング処理を実行することで、位置算出の正確性を向上させることができる。
【００１０】
また、第２の形態として、第１の形態の位置算出方法において、前記判定することは、前記移動体が移動を開始してからの経過時間又は位置算出回数に基づいて前記位置算出精度を判定することを含む、位置算出方法を構成することとしてもよい。
【００１１】
この第２の形態によれば、移動体が移動を開始してからの経過時間又は位置算出回数から、位置算出精度を簡易且つ適切に判定することができる。
【００１２】
また、第３の形態として、第１又は第２の形態の位置算出方法において、前記カップリング処理は、算出した位置に含まれている誤差を推定する誤差推定演算を含み、前記判定することは、前記誤差推定演算で推定した誤差に基づいて前記位置算出精度を判定することを含む、位置算出方法を構成することとしてもよい。
【００１３】
この第３の形態によれば、カップリング処理において誤差推定演算を行うことで推定した位置の誤差から、位置算出精度を簡易且つ適切に判定することができる。
【００１４】
また、第４の形態として、第１〜第３の何れかの形態の位置算出方法において、前記影響度合には、前記第１の計測結果を採用して前記カップリング処理を実行する実行頻度が含まれており、前記影響度合を設定することは、前記位置算出精度に基づいて前記実行頻度を設定することを含み、前記位置を算出することは、前記実行頻度に従って前記第１の計測結果を採用した前記カップリング処理を実行することを含む、位置算出方法を構成することとしてもよい。
【００１５】
この第４の形態によれば、位置算出精度に基づいて、第１の計測結果を採用してカップリング処理を実行する実行頻度を適正化し、カップリング処理の実効性を向上させることができる。
【００１６】
また、第５の形態として、第４の形態の位置算出方法において、前記実行頻度を設定することは、前記位置算出精度が高いほど低い頻度を設定することである、位置算出方法を構成してもよい。
【００１７】
この第５の形態によれば、位置算出精度が高いほど、第１の計測結果を採用してカップリング処理を実行する実行頻度を低く設定することで、衛星測位用ユニットへの依存度を低減させることができる。位置算出精度が高ければ、第１の計測結果の影響度合を下げてカップリング処理を実行しても、位置算出の正確性は保証される。
【００１８】
また、第６の形態として、第１〜第３の何れかの形態の位置算出方法において、前記カップリング処理は、前記第１の計測結果を観測量とするカルマンフィルター処理を含み、前記影響度合を設定することは、前記位置算出精度に基づいて前記カルマンフィルター処理に用いる誤差パラメーター値を設定することを含み、前記位置を算出することは、前記第１の計測結果及び前記誤差パラメーター値を用いて前記カルマンフィルター処理を実行することを含む、位置算出方法を構成することとしてもよい。
【００１９】
誤差パラメーター値は、例えば、カルマンフィルター処理において第１の計測結果を重視する程度を決定付ける値である。第６の形態によれば、位置算出精度に基づいて誤差パラメーター値を設定することで、誤差パラメーター値を適正化し、移動体の位置をより正確に求めることが可能となる。
【００２０】
また、第７の形態として、第６の形態の位置算出方法において、前記誤差パラメーター値を設定することは、前記位置算出精度が高いほど大きい値を設定することである、位置算出方法を構成することとしてもよい。
【００２１】
この第７の形態によれば、位置算出精度が高いほど、カルマンフィルター処理に用いる誤差パラメーター値に大きい値を設定することで、衛星測位用ユニットへの依存度を低減させることができる。位置算出精度が高ければ、第１の計測結果の影響度合を下げてカップリング処理を実行しても、位置算出の正確性は保証される。
【図面の簡単な説明】
【００２２】
【図１】位置算出装置の主要構成図。
【図２】第１の位置算出装置の構成図。
【図３】カップリング処理の入出力データの説明図。
【図４】第１のモード設定条件の説明図。
【図５】第２のモード設定条件の説明図。
【図６】位置算出を行った実験結果の一例を示す図。
【図７】位置算出を行った実験結果の一例を示す図。
【図８】ナビゲーションシステムのシステム構成の説明図。
【図９】カーナビゲーション装置の機能構成を示すブロック図。
【図１０】演算設定テーブルのテーブル構成の一例を示す図。
【図１１】ナビゲーション処理の流れを示すフローチャート。
【図１２】カップリング処理の流れを示すフローチャート。
【発明を実施するための形態】
【００２３】
以下、図面を参照して、本発明の好適な実施形態の一例について説明する。本実施形態は、衛星測位システムの一種であるＧＰＳ（Global Positioning System）と、慣性航法演算を行うシステムであるＩＮＳ（Inertial Navigation System）とを併用して位置算出を行う実施形態である。
【００２４】
１．原理
１−１．システム構成
図１は、本実施形態における位置算出装置１の主要構成図である。位置算出装置１は、移動体に備えられて、当該移動体の位置を算出する装置（位置算出システム）である。移動体は、自動車やオートバイ、自転車、船、電車といった物の他、人間自体であってもよい。人間が位置算出装置１を携帯し、人間自身が位置算出装置１を備えることとしてもよい。図１では、ユニット（モジュール）を二重線で図示し、ユニットの計測結果を利用して演算処理を行う処理ブロックを一重線で図示することで、両者を区別する。図２についても同様である。
【００２５】
位置算出装置１は、ユニット（モジュール）として、ＧＰＳユニット３と、ＩＮＳユニット５とを備える。また、位置算出装置１は、主要な処理ブロックとして、位置算出精度判定部６と、影響度合設定部７と、カップリング処理部９とを有する。
【００２６】
ＧＰＳユニット３は、衛星測位システムを利用して測位を行うためのユニット（衛星測位用ユニット）である。ＧＰＳユニット３は、ＧＰＳ衛星から発信されているＧＰＳ衛星信号を受信するアンテナや、受信したＧＰＳ衛星信号を処理するプロセッサー等を有して構成される。
【００２７】
ＧＰＳユニット３は、ＧＰＳ衛星信号のコード位相やドップラー周波数、擬似距離、擬似距離変化率等のＧＰＳメジャメント情報を計測可能に構成されている。また、ＧＰＳユニット３は、ＧＰＳメジャメント情報を用いたＧＰＳ演算を行って、移動体の位置や速度（速度ベクトル）等を計測可能に構成されている。ＧＰＳメジャメント情報やＧＰＳ演算結果は、ＧＰＳ計測結果（第１の計測結果）としてカップリング処理部９に出力される。
【００２８】
ＩＮＳユニット５は、慣性航法を利用して測位を行うためのユニット（慣性測位用ユニット）である。ＩＮＳユニット５は、加速度センサーやジャイロセンサー等の慣性センサーや、慣性センサーをパッケージ化した慣性計測ユニット（ＩＭＵ（Inertial Measurement Unit））、慣性センサーの計測結果を処理するプロセッサー等を有して構成される。
【００２９】
ＩＮＳユニット５は、慣性センサーの計測結果を用いて、移動体の加速度（加速度ベクトル）や角速度等をＩＮＳメジャメント情報として計測可能に構成されている。また、ＩＮＳユニット５は、ＩＮＳメジャメント情報を用いた慣性航法演算（ＩＮＳ演算）を行って、移動体の位置や速度（速度ベクトル）、姿勢角等を計測可能に構成されている。ＩＮＳメジャメント情報やＩＮＳ演算結果は、ＩＮＳ計測結果（第２の計測結果）としてカップリング処理部９に出力される。
【００３０】
位置算出精度判定部６は、位置算出の確からしさである位置算出精度を判定する。具体的には、位置算出精度判定部６は、移動体が移動を開始してからの経過時間又は位置算出回数に基づいて位置算出精度を判定する。また、位置算出精度判定部６は、カップリング処理部９がカップリング処理において所定の誤差推定演算を行うことで推定したカップリング推定誤差に基づいて、位置算出精度を判定する。
【００３１】
影響度合設定部７は、位置算出精度判定部６により判定された位置算出精度に基づいて、ＧＰＳ計測結果（第１の計測結果）のＩＮＳ計測結果（第２の計測結果）に対する影響度合を設定する。
【００３２】
カップリング処理部９は、影響度合設定部７により設定された影響度合に基づいて、ＧＰＳ計測結果（第１の計測結果）とＩＮＳ計測結果（第２の計測結果）とのカップリング処理を実行して移動体の位置等を算出する。
【００３３】
図２は、図１の位置算出装置１を適用した第１の位置算出装置１Ａの構成図である。第１の位置算出装置１Ａでは、図１の位置算出精度判定部６が位置誤差レベル判定部６Ａを有し、影響度合設定部７が影響モード設定部７Ａを有する。また、図１のカップリング処理部９がカルマンフィルター処理部９Ａを有する。
【００３４】
位置誤差レベル判定部６Ａは、後述するモード設定条件（第１又は第２のモード設定条件）に従って位置誤差レベルを判定する。位置誤差レベルは、位置算出精度を決定付ける位置誤差のレベルである。
【００３５】
影響モード設定部７Ａは、位置誤差レベル判定部６Ａにより判定された位置誤差レベルに基づいてＧＰＳ影響モードを設定する。ＧＰＳ影響モードは、ＧＰＳの影響度合を決定づけるモードである。本実施形態では、ＧＰＳ計測結果のＩＮＳ計測結果に対する影響度合が低い順に、「第１の影響モード」、「第２の影響モード」、「第３の影響モード」及び「第４の影響モード」の４種類のモードを択一的に設定する場合を想定する。
【００３６】
カルマンフィルター処理部９Ａは、ＧＰＳ計測結果を観測量“Ｚ”とするカルマンフィルター処理を実行して、ＧＰＳ計測結果とＩＮＳ計測結果とをカップリング（結び付け）する。具体的には、カルマンフィルターの理論に基づき、予測演算（時刻更新）と補正演算（観測更新）とを行って、移動体の状態“Ｘ”を推定する。
【００３７】
本実施形態において、移動体の状態“Ｘ”には、少なくとも移動体の位置が含まれる。予測演算では、例えば、ＩＮＳユニット５から入力したＩＮＳ計測結果を制御入力“Ｕ”として、１つ前の時刻（前回時刻）における状態補正値“Ｘ＋”から、現在の時刻（今回時刻）における状態“Ｘ”を予測する演算を行って、状態予測値“Ｘ−”を算出する。
【００３８】
補正演算では、例えば、ＧＰＳユニット３から入力したＧＰＳ計測結果を観測量“Ｚ”として用いて、予測演算で算出した状態予測値“Ｘ−”を補正する演算を行って、状態補正値“Ｘ＋”を算出する。そして、算出した状態補正値“Ｘ＋”を、カップリング結果として出力する。
【００３９】
また、カルマンフィルター処理部９Ａは、ＧＰＳ計測結果とは別に、移動体の運動モデルに基づく制約条件を観測量“Ｚ”として適用可能に構成されている。本実施形態では、移動体の停止時における速度制約条件である「停止時速度制約条件」と、移動体の移動時における速度制約条件である「移動時速度制約条件」との２種類の速度制約条件を適用する場合を想定する。
【００４０】
停止時速度制約条件（第１の制約条件）は、移動体の停止時に適用可能な制約条件である。移動体が停止しているのであれば、理想的には移動体の速度はゼロである。従って、移動体が停止していると判定した場合は「移動体の各軸の速度成分＝０（速度ベクトル＝ゼロベクトル）」を観測量“Ｚ”として与えることができる。
【００４１】
移動時速度制約条件（第２の制約条件）は、移動体の移動時に適用可能な制約条件である。例えば、移動体として四輪自動車を想定した場合、通常、四輪自動車はジャンプや横滑りすることはないと仮定することができる。従って、移動体が移動していると判定した場合は「移動体の縦横方向の速度成分＝０」を観測量“Ｚ”として与えることができる。
【００４２】
本実施形態では、ＧＰＳ計測結果と上記の制約条件（停止時速度制約条件又は移動時速度制約条件）とを切り替えて観測量“Ｚ”に適用する場合を一例として説明する。なお、本実施形態とは異なり、ＧＰＳ計測結果と上記の制約条件とを観測量“Ｚ”として併用することも当然に可能である。
【００４３】
図３は、カルマンフィルター処理の入出力データの説明図である。制御入力“Ｕ”と、観測量“Ｚ”と、状態“Ｘ”との対応関係を表したテーブルを図示している。カップリングには種々の方式が存在する。その中でも、ルーズカップリング（疎結合）と呼ばれる方式と、タイトカップリング（密結合）と呼ばれる方式とが一般的に用いられる。
【００４４】
ルーズカップリング方式は、ＧＰＳとＩＮＳとの結び付きが比較的弱いカップリング方式である。この方式では、例えば、制御入力“Ｕ”をＩＮＳ演算結果（位置、速度、姿勢角等）とし、観測量“Ｚ”をＧＰＳ演算結果（位置、速度等）としてカップリング処理を実行する。そして、移動体情報（位置、速度、姿勢角等）を状態“Ｘ”として推定する。
【００４５】
タイトカップリング方式は、ＧＰＳとＩＮＳとの結び付きが比較的強いカップリング方式である。この方式では、例えば、制御入力“Ｕ”をＩＮＳ演算結果（位置、速度、姿勢角等）とし、観測量“Ｚ”をＧＰＳメジャメント情報（コード位相、ドップラー周波数、擬似距離、擬似距離変化率等）としてカップリング処理を実行する。そして、移動体情報（位置、速度、姿勢角等）を状態“Ｘ”として推定する。
【００４６】
また、タイトカップリング方式として、制御入力“Ｕ”をＩＮＳメジャメント情報（加速度、角速度等）とし、観測量“Ｚ”をＧＰＳメジャメント情報（コード位相、ドップラー周波数、擬似距離、擬似距離変化率等）とし、状態“Ｘ”を移動体情報（位置、速度、姿勢角等）とする手法も存在する。
【００４７】
本実施形態の位置算出方法は、上記の何れのカップリング方式に対しても実質的に同一に適用可能である。つまり、ＧＰＳ計測結果（第１の計測結果）として、ＧＰＳメジャメント情報を適用してもよいし、ＧＰＳ演算結果を適用してもよい。また、ＩＮＳ計測結果（第２の計測結果）として、ＩＮＳメジャメント情報を適用してもよいし、ＩＮＳ演算結果を適用してもよい。
【００４８】
ＩＮＳ計測結果及びＧＰＳ計測結果として用いる情報は、適用するシステムに応じて適宜設定可能である。この場合、カルマンフィルター処理の予測演算及び補正演算で用いる演算式やパラメーター値を、適用するシステムに応じて適宜設定すればよい。なお、具体的な演算式やパラメーター値については、公知の手法に基づき定義可能であるため、ここでは説明を省略する。
【００４９】
１−２．ＧＰＳ影響モードの設定
本実施形態では、大きく分けて２つのＧＰＳ影響モード設定方法について説明する。第１の設定方法は、移動体が移動を開始してからの経過時間又は位置算出回数に基づいて位置算出精度を判定し、当該位置算出精度に基づいてＧＰＳ影響モードを設定する方法である。第２の設定方法は、カップリング処理において所定の誤差推定演算を行うことで推定したカップリング推定誤差に基づいて位置算出精度を判定し、当該位置算出精度に基づいてＧＰＳ影響モードを設定する方法である。
【００５０】
（１）第１の設定方法
図４は、ＧＰＳ影響モードの第１の設定方法の説明図であり、ＧＰＳ影響モードの設定で用いる第１のモード設定条件を定めた第１のモード設定条件テーブルを図示したものである。第１のモード設定条件テーブルには、第１のモード設定条件と、位置誤差レベルと、設定モードとが対応付けて定められている。
【００５１】
第１のモード設定条件は、移動体が移動を開始してからの経過時間（以下、「移動開始後経過時間」と称す。）、又は、移動体が移動を開始してからの位置算出回数（以下、「移動開始後位置算出回数」と称す。）に応じた条件が定められている。「移動を開始してから」とは、移動体が停止した状態から動き出してからという意味である。
【００５２】
１番目の条件は「移動開始後経過時間≦第１の閾値時間θT1、又は、移動開始後位置算出回数≦第１の閾値回数θC1」であり、位置誤差レベルは「Ｌ１」、設定モードは「第１の影響モード」である。２番目の条件は「第１の閾値時間θT1＜移動開始後経過時間≦第２の閾値時間θT2、又は、第１の閾値回数θC1＜移動開始後位置算出回数≦第２の閾値回数θC2」であり、位置誤差レベルは「Ｌ２」、設定モードは「第２の影響モード」である。
【００５３】
３番目の条件は「第２の閾値時間θT2＜移動開始後経過時間≦第３の閾値時間θT3、又は、第２の閾値回数θC2＜移動開始後位置算出回数≦第３の閾値回数θC3」であり、位置誤差レベルは「Ｌ３」、設定モードは「第３の影響モード」である。４番目の条件は「第３の閾値時間θT3＜移動開始後経過時間、又は、第３の閾値回数θC3＜移動開始後位置算出回数」であり、位置誤差レベルは「Ｌ４」、設定モードは「第４の影響モード」である。
【００５４】
位置誤差レベルは、位置算出精度を表すレベルであり、数字が大きいほど位置誤差が大きく、位置算出精度が低いことを意味する。また、設定モードは、数字が大きいほどＧＰＳの影響度合が高いことを意味する。
【００５５】
第１〜第３の閾値時間「θT1，θT2，θT3」及び第１〜第３の閾値回数「θC1，θC2，θC3」は、本実施形態の位置算出方法を適用するシステムに応じて適宜設定可能である。例えば、位置算出を「１秒間隔」で行うシステムに適用するのであれば、「θT1＝６０秒、θT2＝９０秒、θT3＝１２０秒」や「θC1＝５０回、θC2＝１００回、θC3＝１５０回」といった値を定めておくことができる。
【００５６】
移動体が停止している場合は、停止時速度制約条件を利用することで、位置算出の誤差を低減させることができる。誤差が低減された状態で移動を開始すると、暫くの間は位置算出精度が高い状態が維持される。しかし、慣性航法演算では、加速度（加速度ベクトル）を積分して速度（速度ベクトル）を算出し、速度（速度ベクトル）を積分して距離及び移動方向を算出し、算出した距離を前回位置に継ぎ足すように加算することで位置を算出する。つまり、多重の積分演算を行って累積的に位置を求めるために、時間経過に伴って誤差が累積する特徴がある。そのため、移動を開始してからの経過時間が長くなると、位置算出の精度が低下する。
【００５７】
そこで、第１の設定方法では、移動開始後経過時間が長くなるほど、又は、移動開始後位置算出回数が多くなるほど、位置誤差レベルが高い（位置算出精度が低い）と判定する。そして、位置誤差レベルが高いほど、ＧＰＳ計測結果をＩＮＳ計測結果に強く作用させるために、ＧＰＳの影響度合を高くする。
【００５８】
第１の設定方法は、移動体が頻繁に停止及び移動を繰り返す環境（例えば都心部）に適した設定方法である。都心部では、信号機が多く存在するために、自動車は頻繁に停止及び移動を繰り返す。また、道路が入り組んでいるために、自動車の移動方向も頻繁に変化する。これらの環境では、慣性航法演算に誤差が生じやすいため、移動開始からの時間経過に応じてＧＰＳの影響度合を変更することで、誤差の累積を抑えることができる。
【００５９】
（２）第２の設定方法
図５は、ＧＰＳ影響モードの第２の設定方法の説明図であり、ＧＰＳ影響モードの設定で用いる第２のモード設定条件を定めた第２のモード設定条件テーブルを図示したものである。第２のモード設定条件テーブルには、第２のモード設定条件と、位置誤差レベルと、設定モードとが対応付けて定められている。位置誤差レベル及び設定モードは、図４の第１のモード設定条件テーブルと同じである。
【００６０】
第２のモード設定条件は、カップリング推定誤差に基づいて定義されている。カップリング推定誤差は、カップリング結果に含まれ得る誤差の推定値であり、カップリング処理において所定の誤差推定演算を行うことで推定される。例えば、カルマンフィルター処理では、推定対象とする状態“Ｘ”の誤差“Ｐ”を設定して演算を行う。予測演算及び補正演算において、状態“Ｘ”と併せて誤差“Ｐ”の予測及び補正を行うことで、カップリング推定誤差が定まる。
【００６１】
状態“Ｘ”が複数の要素で構成される場合は、誤差“Ｐ”は行列形式の誤差共分散行列“Ｐ”で表すことができる。この場合、誤差共分散行列“Ｐ”の対角成分から、各要素の誤差を見積もることができる。例えば、状態“Ｘ”の要素が移動体の位置、速度及び姿勢角であれば、誤差共分散行列“Ｐ”の対角成分が、それぞれカップリング位置推定誤差、カップリング速度推定誤差及びカップリング姿勢角推定誤差となる。
【００６２】
１番目の条件は「カップリング推定誤差≦第１の閾値誤差θE1」であり、位置誤差レベルは「Ｌ１」、設定モードは「第１の影響モード」である。２番目の条件は「第１の閾値誤差θE1＜カップリング推定誤差≦第２の閾値誤差θE2」であり、位置誤差レベルは「Ｌ２」、設定モードは「第２の影響モード」である。
【００６３】
３番目の条件は「第２の閾値誤差θE2＜カップリング推定誤差≦第３の閾値誤差θE3」であり、位置誤差レベルは「Ｌ３」、設定モードは「第３の影響モード」である。４番目の条件は「第３の閾値誤差θE3＜カップリング推定誤差」であり、位置誤差レベルは「Ｌ４」、設定モードは「第４の影響モード」である。
【００６４】
この場合は、カップリング位置推定誤差、カップリング速度推定誤差及びカップリング姿勢角推定誤差に対してそれぞれ閾値を定めておく。例えば、第１の閾値誤差θE1に相当する閾値として“１０［ｍ］”、“１［ｍ／ｓ］”、“１［°］”、第２の閾値誤差θE2に相当する閾値として“２０［ｍ］”、“２［ｍ／ｓ］”、“２［°］”、第３の閾値誤差θE3に相当する閾値として“３０［ｍ］”、“３［ｍ／ｓ］”、“３［°］”をそれぞれ定めておく。そして、カップリング位置推定誤差、カップリング速度推定誤差及びカップリング姿勢角推定誤差それぞれに対する閾値判定を行い、ＡＮＤ条件又はＯＲ条件を適用して位置誤差レベルを判定する。
【００６５】
カップリング推定誤差が小さければ、位置算出精度は高いと考えられる。そのため、ＧＰＳの影響度合を低くしても、位置算出の正確性はある程度保証される。しかし、カップリング推定誤差が大きければ、位置算出精度は低いと考えられる。そのため、ＧＰＳの影響度合を高くしなければ、位置算出精度の改善が図れない。
【００６６】
そこで、カップリング推定誤差が大きいほど、位置誤差レベルが高い（位置算出精度が低い）と判定する。そして、位置誤差レベルが高いほど、ＧＰＳ計測結果をＩＮＳ計測結果に強く作用させることを目的として、ＧＰＳの影響度合を高く設定する。
【００６７】
第２の設定方法は、高品質のＧＰＳ衛星信号を継続して受信可能な環境（例えばオープンスカイ環境）に適した設定方法である。オープンスカイ環境では、ＧＰＳメジャメント情報やＧＰＳ演算結果を高い精度で取得することができるため、ＩＮＳ計測結果とのカップリング処理を実行することで、位置算出精度が向上する。従って、ＧＰＳの影響度合を下げる方向に作用し易くなり、ＩＮＳを重視した位置算出が実現され易くなる。
【００６８】
１−３．演算設定
カップリング処理部９は、ＧＰＳ影響モードに応じて演算設定を変更してカップリング処理を行う。本実施形態において、演算設定には、ＧＰＳ計測結果採用頻度と、カルマンフィルター処理で用いる誤差パラメーター値とが含まれる。
【００６９】
ＧＰＳ計測結果採用頻度は、ＧＰＳ計測結果を採用してカップリング処理を実行する実行頻度である。図２では、カルマンフィルター処理部９Ａが、観測量“Ｚ”であるＧＰＳ計測結果を採用して補正演算を実行する頻度が、ＧＰＳ計測結果採用頻度に相当する。
【００７０】
ＧＰＳの影響度合が高いモードでは、ＧＰＳ計測結果をＩＮＳ計測結果に対して強く作用させることが必要となる。逆に、ＧＰＳの影響度合が低いモードでは、ＧＰＳ計測結果をＩＮＳ計測結果に対する作用を弱める必要がある。そこで、ＧＰＳの影響度合が低いモードほど、より低い頻度をＧＰＳ計測結果採用頻度に設定する。
【００７１】
誤差パラメーター値は、カルマンフィルターの演算において設定するパラメーター値の一種である。本実施形態では、観測量“Ｚ”の誤差に相当する観測誤差（観測雑音）“Ｒ”を、誤差パラメーターの一例として説明する。
【００７２】
カルマンフィルター処理の補正演算において、観測誤差“Ｒ”を小さく設定すると、観測量“Ｚ”に追従するように状態“Ｘ”が補正される。つまり、観測量“Ｚ”を信用・重視して状態“Ｘ”を推定するようにフィルターが作用する。それに対して、観測誤差“Ｒ”を大きく設定すると、状態予測値“Ｘ−”に追従するように状態“Ｘ”が補正される。つまり、予測演算で予測された状態予測値“Ｘ−”を信用・重視して状態“Ｘ”を推定するようにフィルターが作用する。
【００７３】
そこで、ＧＰＳの影響度合が低いモードほど、ＧＰＳ計測結果のＩＮＳ計測結果に対する作用を弱めることを目的として、より大きな値を観測誤差（Ｒ値）に設定する。
【００７４】
１−４．実験結果
実際に位置算出を行った実験結果を説明する。移動体を予め定められた経路に沿って移動させ、その場合に算出される位置を東西南北の２次元平面にプロットする実験を行った。図４の第１のモード設定条件を適用し、移動開始後経過時間に基づいてＧＰＳ影響モードを設定した。実験に用いた移動開始後経過時間の閾値は「θT1＝６０秒、θT2＝９０秒、θT3＝１２０秒」である。各図において、横軸は東西方向、縦軸は南北方向をそれぞれ示す。単位はメートル［ｍ］である。東西方向「０ｍ」、南北方向「０ｍ」の位置をスタート地点とし、スタート地点から西方向に向かい、時計回り方向に周回する経路を辿った。ゴール地点は、スタート地点の近傍所定位置である。
【００７５】
図６は、従来の位置算出方法を適用した実験結果である。この実験ではＧＰＳとＩＮＳとのカップリング処理は行っていない。図６では、移動体の真の軌跡を「点線」で、ＧＰＳ演算位置の軌跡を「一点鎖線」で、ＩＮＳ演算位置の軌跡を「実線」でそれぞれ示している。
【００７６】
この実験結果を見ると、最初のうちは真の軌跡に沿ったＩＮＳ演算位置の軌跡が得られているが、長時間が経過すると、ＩＮＳ演算位置の誤差が増大していることがわかる。特に、点線で囲った部分Ａ１に着目すると、本来は右に曲がるべき場所でＩＮＳ演算位置は曲がることができず、そのまま行き過ぎてしまっている。その後、行き過ぎた道を引き返したが、本来曲がるべき場所から少し離れた場所で曲がっており、その距離分の誤差が位置誤差として重畳してしまっている。
【００７７】
図７は、本実施形態の位置算出方法を適用した実験結果である。この実験ではＧＰＳとＩＮＳとのカップリング処理を行った。図７では、移動体の真の軌跡を「点線」で、ＧＰＳ演算位置の軌跡を「一点鎖線」で、カップリング演算位置の軌跡を「実線」でそれぞれ示している。
【００７８】
この実験結果を見ると、長時間が経過しても位置誤差が増大することはなく、良好な結果が得られていることがわかる。部分Ａ１での行き過ぎの問題も解消されている。部分Ａ１の前段部分を調べてみると、部分Ａ２では、ＧＰＳ影響モードが「第２の影響モード」から「第３の影響モード」に変化していた。つまり、この部分では、ＧＰＳの影響度合がより高いモードに遷移していた。その結果、ＧＰＳ演算位置の軌跡に引き寄せられて、カップリング演算位置の軌跡が真の軌跡に徐々に近付いていく様子が確認できる。
【００７９】
２．実施例
次に、上記の位置算出装置を備えた電子機器の実施例について説明する。ここでは、位置算出装置を具備するナビゲーション装置の実施例を説明する。但し、本発明を適用可能な実施例が以下説明する実施例に限定されるわけではないことは勿論である。
【００８０】
２−１．システム構成
図８は、本実施例におけるナビゲーションシステム１０００のシステム構成の説明図である。ナビゲーションシステム１０００は、移動体の一種である四輪自動車（以下、単に「自動車」と称す。）に、位置算出装置を具備した電子機器の一種であるカーナビゲーション装置１００が設置されたシステムである。
【００８１】
カーナビゲーション装置１００は、自動車に設置され、自動車の運転者に対するナビゲーションを行う電子機器である。カーナビゲーション装置１００は、ＧＰＳユニット３と、ＩＮＳユニット５とを備える。
【００８２】
本実施例では、ＧＰＳユニット３は、ＧＰＳメジャメント情報５５を計測して出力する。また、ＩＮＳユニット５は、ＩＮＳメジャメント情報５６を、機体座標系（Body Frame）として知られるＢフレームで計測して出力する。Ｂフレームは、例えば、移動体の前方を正とする前後方向をＲ軸（ロール軸）、右方を正とする左右方向をＰ軸（ピッチ軸）、鉛直下方を正とする上下方向をＹ軸（ヨー軸）とする三次元直交座標系である。
【００８３】
カーナビゲーション装置１００は、ＧＰＳユニット３から取得したＧＰＳメジャメント情報を用いてＧＰＳ演算処理を行い、且つ、ＩＮＳユニット５から取得したＩＮＳメジャメント情報を用いてＩＮＳ演算処理を行う。そして、これらの演算結果に対するカップリング処理を実行して自動車の位置を算出し、算出位置をプロットしたナビゲーション画面を表示部３０であるディスプレイに表示させる。
【００８４】
自動車の位置は、自動車の移動空間を定める絶対的な座標系であるＮフレームにおいて演算する。Ｎフレームは、例えば、北東下座標系として知られるＮＥＤ（North East Down）座標系や、地球中心地球固定座標系として知られるＥＣＥＦ（Earth Centered Earth Fixed）座標系として定義される。
【００８５】
２−２．機能構成
図９は、カーナビゲーション装置１００の機能構成の一例を示すブロック図である。カーナビゲーション装置１００は、ＧＰＳユニット３と、ＩＮＳユニット５と、処理部１０と、操作部２０と、表示部３０と、通信部４０と、記憶部５０とを備えて構成される。
【００８６】
処理部１０は、記憶部５０に記憶されているシステムプログラム等の各種プログラムに従ってカーナビゲーション装置１００の各部を統括的に制御する制御装置であり、ＣＰＵ（Central Processing Unit）等のプロセッサーを有して構成される。処理部１０は、記憶部５０に記憶されたナビゲーションプログラム５１に従ってナビゲーション処理を行い、自動車の現在位置を指し示した地図を表示部３０に表示させる処理を行う。
【００８７】
操作部２０は、例えばタッチパネルやボタンスイッチ等により構成される入力装置であり、押下されたキーやボタンの信号を処理部１０に出力する。この操作部２０の操作により、目的地の入力等の各種指示入力がなされる。
【００８８】
表示部３０は、ＬＣＤ（Liquid Crystal Display）等により構成され、処理部１０から入力される表示信号に基づいた各種表示を行う表示装置である。表示部３０には、ナビゲーション画面等が表示される。
【００８９】
通信部４０は、処理部１０の制御に従って、装置内部で利用される情報をインターネット等の通信ネットワークを介して外部とやりとりするための通信装置である。この通信には、公知の無線通信技術を適用可能である。
【００９０】
記憶部５０は、ＲＯＭ（Read Only Memory）やフラッシュＲＯＭ、ＲＡＭ（Random Access Memory）等の記憶装置によって構成され、カーナビゲーション装置１００のシステムプログラムや、ナビゲーション機能等の各種機能を実現するための各種プログラム、データ等を記憶している。また、各種処理の処理中データ、処理結果などを一時的に記憶するワークエリアを有する。
【００９１】
記憶部５０には、プログラムとして、処理部１０により読み出され、ナビゲーション処理（図１１参照）として実行されるナビゲーションプログラム５１が記憶されている。ナビゲーションプログラム５１は、カップリング処理（図１２参照）として実行されるカップリングプログラム５１３をサブルーチンとして含む。
【００９２】
また、記憶部５０には、データとして、演算設定テーブル５２と、モード設定条件テーブル５３と、設定モード５４と、ＧＰＳメジャメント情報５５と、ＩＮＳメジャメント情報５６と、ＧＰＳ演算結果５７と、ＩＮＳ演算結果５８と、カップリング結果５９とが記憶される。
【００９３】
演算設定テーブル５２は、カップリング処理における演算設定が定義されたテーブルであり、そのテーブル構成の一例を図１０に示す。演算設定テーブル５２には、ＧＰＳ影響モード５２１と、演算設定５２３とが対応付けて記憶されている。
【００９４】
ＧＰＳ計測結果採用頻度については、第１の影響モードでは「採用しない」が定められ、第２の影響モードでは「１０回に１回」が定められている。また、第３の影響モードでは「５回に１回」が定められており、第４の影響モードでは「毎回」が定められている。つまり、ＧＰＳの影響度合が低くなるほど、より低い頻度がＧＰＳ計測結果採用頻度に設定される。
【００９５】
カルマンフィルター処理の観測誤差（Ｒ値）には、位置の観測誤差である位置観測誤差“ＲP”と、速度の観測誤差である速度観測誤差“ＲV”とが含まれる。第１の影響モードではＧＰＳ計測結果を採用しないため、観測誤差は「−（無し）」が定められている。また、第２の影響モードでは「ＲP＝５００，ＲV＝５０」が定められ、第３の影響モードでは「ＲP＝１００，ＲV＝１０」が定められ、第４の影響モードでは「ＲP＝（σP）2，ＲV＝（σV）2」が定められている。
【００９６】
“σP”及び“σV”は、ＧＰＳ演算結果に含まれる位置誤差及び速度誤差である。本願発明者が行った実験によれば、通常の測位環境では、位置誤差及び速度誤差は“σP＝３〜４［ｍ］”、“σV＝０．６〜０．８［ｍ／ｓ］”程度の値として算出される。このため、第４の影響モードでは、位置観測誤差“ＲP”として“１０”程度の値が設定され、速度観測誤差“ＲV”として“０．５”程度の値が設定される。従って、ＧＰＳの影響度合が低くなるほど、より大きな値が観測誤差“Ｒ”に設定される。
【００９７】
モード設定条件テーブル５３には、ＧＰＳ影響モードを設定するための条件が定められたテーブルであり、例えば第１のモード設定条件テーブルや第２のモード設定条件テーブル（図４及び図５参照）がこれに含まれる。
【００９８】
設定モード５４は、設定されているＧＰＳ影響モードであり、影響モード設定処理により随時更新される。
【００９９】
２−３．処理の流れ
図１１は、処理部１０が、記憶部５０に記憶されたナビゲーションプログラム５１に従って実行するナビゲーション処理の流れを示すフローチャートである。
【０１００】
先ず、処理部１０は、ＧＰＳユニット３及びＩＮＳユニット５から、ＧＰＳメジャメント情報５５及びＩＮＳメジャメント情報５６の取得を開始する（ステップＡ１）。そして、処理部１０は、移動状況判定処理を行う（ステップＡ３）。具体的には、例えば、ＩＮＳユニット５からＩＮＳメジャメント情報５６として取得した自動車の加速度（加速度ベクトル）や角速度に基づいて、自動車が停止している状態であるか、移動している状態であるかを判定する。
【０１０１】
その後、処理部１０は、ＧＰＳ演算処理を行う（ステップＡ５）。具体的には、ＧＰＳユニット３から取得したＧＰＳメジャメント情報５５を用いて、公知の測位計算を行って、自動車の位置や速度（速度ベクトル）を演算する。また、公知の誤差推定演算を行って、位置及び速度（速度ベクトル）の誤差を推定する。そして、これらの演算結果をＧＰＳ演算結果５７として記憶部５０に記憶させる。
【０１０２】
また、処理部１０は、ＩＮＳ演算処理を行う（ステップＡ７）。具体的には、ＩＮＳユニット５から取得したＩＮＳメジャメント情報５６を用いて、公知の慣性航法演算を行って、自動車の位置や速度（速度ベクトル）、姿勢角を演算する。そして、これらの演算結果をＩＮＳ演算結果５８として記憶部５０に記憶させる。
【０１０３】
その後、処理部１０は、位置算出精度判定処理を行う（ステップＡ８）。具体的には、記憶部５０に記憶されたモード設定条件テーブル５３を参照し、移動開始後経過時間又は移動開始後位置算出回数や、カップリング推定誤差に基づいて、位置算出精度を示す位置誤差レベルを判定する。
【０１０４】
次いで、処理部１０は、影響モード設定処理を行う（ステップＡ９）。具体的には、記憶部５０に記憶されたモード設定条件テーブル５３を参照し、ステップＡ８で判定した位置誤差レベルに対応付けられた設定モードで記憶部５０の設定モード５４を更新する。
【０１０５】
その後、処理部１０は、記憶部５０に記憶されたカップリングプログラム５１３に従ってカップリング処理を実行する（ステップＡ１１）。
【０１０６】
図１２は、カップリング処理の流れを示すフローチャートである。
処理部１０は、ＧＰＳ演算結果５７をカップリング処理に採用するか否かを判定する（ステップＢ１）。具体的には、影響モード設定処理で設定されたＧＰＳ影響モードに対応付けられたＧＰＳ計測結果採用頻度に基づき、今回のカップリング処理においてＧＰＳ演算結果５７を採用するか否かを判定する。
【０１０７】
ＧＰＳ演算結果５７をカップリング処理に採用すると判定したならば（ステップＢ１；Ｙｅｓ）、処理部１０は、最新のＧＰＳ演算結果５７を観測量とする観測量ベクトル“Ｚ”を設定する（ステップＢ３）。また、演算設定テーブル５２を参照し、現在の設定モード５４に対応する観測誤差に基づいて観測誤差共分散行列“Ｒ”を設定する（ステップＢ５）。そして、処理部１０は、ステップＢ３及びＢ５で設定した観測量ベクトル“Ｚ”及び観測誤差共分散行列“Ｒ”を用いて、カルマンフィルター処理を実行する（ステップＢ７）。
【０１０８】
一方、ステップＢ１においてＧＰＳ演算結果５７をカップリング処理に採用しないと判定したならば（ステップＢ１；Ｎｏ）、処理部１０は、ステップＡ３で判定した移動状況を判定する（ステップＢ９）。そして、移動状況が「移動」である場合は（ステップＢ９；移動）、移動時制約速度ベクトルを観測量ベクトル“Ｚ”として設定する（ステップＢ１１）。また、移動時用速度観測誤差（例えば所定値）に基づき観測誤差共分散行列“Ｒ”を設定する（ステップＢ１３）。そして、処理部１０は、ステップＢ１１及びＢ１３で設定した観測量ベクトル“Ｚ”及び観測誤差共分散行列“Ｒ”を用いて、カルマンフィルター処理を実行する（ステップＢ７）。
【０１０９】
また、移動状況が「停止」である場合は（ステップＢ９；停止）、処理部１０は、停止時制約速度ベクトルを観測量ベクトル“Ｚ”として設定する（ステップＢ１５）。また、停止時用速度観測誤差（例えば所定値）に基づき観測誤差共分散行列“Ｒ”を設定する（ステップＢ１７）。そして、処理部１０は、ステップＢ１５及びＢ１７で設定した観測量ベクトル“Ｚ”及び観測誤差共分散行列“Ｒ”を用いて、カルマンフィルター処理を実行する（ステップＢ７）。
【０１１０】
ステップＢ７においてカルマンフィルター処理を行うと、処理部１０は、その結果をカップリング結果５９として記憶部５０に記憶させる。そして、処理部１０は、カップリング処理を終了する。
【０１１１】
図１１のナビゲーション処理に戻り、カップリング処理を行ったならば、処理部１０は、カップリング結果５９を出力する（ステップＡ１３）。そして、処理部１０は、処理を終了するか否かを判定する（ステップＡ１５）。例えば、操作部２０を介してユーザーによりナビゲーションの終了指示操作がなされた場合に、ナビゲーション処理を終了すると判定する。
【０１１２】
まだ処理を終了しないと判定した場合は（ステップＡ１５；Ｎｏ）、処理部１０は、ステップＡ３に戻る。また、処理を終了すると判定した場合は（ステップＡ１５；Ｙｅｓ）、処理部１０は、ナビゲーション処理を終了する。
【０１１３】
３．作用効果
ＧＰＳユニット３とＩＮＳユニット５とを備えた位置算出装置１において、位置算出精度判定部６は、位置算出精度を判定する。影響度合設定部７は、位置算出精度判定部６により判定された位置算出精度に基づいて、ＧＰＳ計測結果のＩＮＳ計測結果に対する影響度合を設定する。カップリング処理部９は、影響度合設定部７により設定された影響度合に基づいてＧＰＳ計測結果とＩＮＳ計測結果とのカップリング処理を実行して、移動体の位置を算出する。
【０１１４】
位置算出精度判定部６は、例えば、移動体が移動を開始してからの経過時間又は位置算出回数に基づいて位置算出精度を判定する。また、位置算出精度判定部６は、例えば、カップリング処理部６が所定の誤差推定演算を行うことで推定したカップリング推定誤差に基づいて位置算出精度を判定する。
【０１１５】
第１の位置算出装置１Ａでは、影響度合設定部７は影響モード設定部７Ａを有し、位置算出精度判定部６が有する位置誤差レベル判定部６Ａにより判定された位置誤差レベルに基づいてＧＰＳ影響モードを設定する。具体的には、位置誤差レベルが低いほど（位置算出精度が高いほど）、ＧＰＳの影響度合が低いＧＰＳ影響モードを設定する。
【０１１６】
また、第１の位置算出装置１Ａでは、カップリング処理部９はカルマンフィルター処理部９Ａを有し、影響モード設定部７Ａより設定されたＧＰＳ影響モードに応じて演算設定を変更してカルマンフィルター処理を実行する。演算設定には、ＧＰＳ計測結果を採用してカップリング処理を実行する実行頻度が含まれ、ＧＰＳの影響度合が低い影響モードほど、より低い頻度が設定される。また、演算設定には、観測量とするＧＰＳ計測結果の想定誤差を示す観測誤差（Ｒ値）が含まれ、ＧＰＳの影響度合が低い影響モードほど、より大きな値が設定される。
【０１１７】
このように、位置算出精度に応じて、衛星測位用ユニットの計測結果の慣性測位用ユニットの計測結果に対する影響度合を変更することで、特に位置算出装置の連続動作時において影響度合を適正化することができる。そして、適正化した影響度合に応じてカップリング処理の演算設定を変更することで、カップリング処理の実効性を高め、ひいては位置算出の正確性を向上させることが可能となる。
【０１１８】
４．変形例
本発明を適用可能な実施例は、上記の実施例に限定されることなく、本発明の趣旨を逸脱しない範囲で適宜変更可能であることは勿論である。以下、変形例について説明するが、上記の実施例と同一の構成要素については同一の符号を付して説明を省略し、上記の実施例とは異なる部分を中心に説明する。
【０１１９】
４−１．ユニット
上記の実施形態では、衛星測位用ユニットとして、ＧＰＳを適用したＧＰＳユニットを例に挙げて説明したが、ＷＡＡＳ（Wide Area Augmentation System）、ＱＺＳＳ（Quasi Zenith Satellite System）、ＧＬＯＮＡＳＳ（GLObal NAvigation Satellite System）、ＧＡＬＩＬＥＯ等の他の衛星測位システムを適用したユニットとしてもよいことは勿論である。
【０１２０】
また、上記の実施形態では、慣性測位用ユニットとして、ＩＮＳユニットを例に挙げて説明したが、ＩＮＳメジャメント情報（加速度や角速度）を計測する慣性センサーや慣性計測ユニット（ＩＭＵ）を慣性測位用ユニットとしてもよい。この場合は、慣性測位用ユニットにより計測されたＩＮＳメジャメント情報を用いて、位置算出装置の処理部がＩＮＳ演算処理を行えばよい。
【０１２１】
４−２．カップリング処理
上記の実施形態では、カップリング処理の一例としてカルマンフィルター処理を例に挙げて説明したが、カップリング処理はこれに限られない。例えば、ＧＰＳ計測結果とＩＮＳ計測結果との平均演算を行う平均処理をカップリング処理に含めることとしてもよい。
【０１２２】
平均演算としては、単純な算術平均や幾何平均を適用してもよいし、加重平均を適用してもよい。算術平均や幾何平均を適用するのであれば、カップリング処理の演算設定として、例えば、ＧＰＳ計測結果を採用して平均処理を実行する実行頻度を定めておくことができる。ＧＰＳの影響度合が高いほど、ＧＰＳ計測結果をＩＮＳ計測結果に作用し易くするように実行頻度を高くすればよい。
【０１２３】
また、加重平均を適用するのであれば、カップリング処理の演算設定として、例えば、加重平均の重みを定めておけばよい。具体的には、ＧＰＳの影響度合が高いモードほど、ＧＰＳ計測結果をＩＮＳ計測結果よりも重視して加重平均するように、ＧＰＳ計測結果の重みとしてより大きな値を設定すればよい。
【０１２４】
４−３．影響モードの段数
上記の実施形態では、ＧＰＳ影響モードを第１〜第４の影響モードの４段として説明したが、影響モードの段数は適宜設定可能である。つまり、影響モードをより少ない段数（例えば２段）としてもよいし、より多い段数（例えば８段）としてもよい。これは、ＧＰＳの影響度合をより粗く設定したり、より細かく設定することに相当する。
【０１２５】
４−４．処理主体
上記の実施例では、電子機器の処理部１０が、ＧＰＳユニット３から取得したＧＰＳメジャメント情報５５を用いてＧＰＳ演算処理を行うこととして説明した。また、処理部１０が、ＩＮＳユニット５から取得したＩＮＳメジャメント情報５６を用いてＩＮＳ演算処理を行うこととして説明した。つまり、ＧＰＳ演算処理、ＩＮＳ演算処理及びカップリング処理の実行主体が、全て電子機器の処理部１０であるものとして説明した。この構成を次のようにしてもよい。
【０１２６】
ＧＰＳユニット３は、ＧＰＳメジャメント情報５５を用いたＧＰＳ演算処理を行ってＧＰＳ演算結果５７を求め、処理部１０に出力する。また、ＩＮＳユニット５は、ＩＮＳメジャメント情報５６を用いたＩＮＳ演算処理を行ってＩＮＳ演算結果５８を求め、処理部１０に出力する。そして、処理部１０は、各ユニットから取得したＧＰＳ演算結果５７とＩＮＳ演算結果５８とのカップリング処理を実行する。つまり、この場合は、ＧＰＳ演算処理及びＩＮＳ演算処理の実行主体が、それぞれＧＰＳユニット３及びＩＮＳユニット５となり、カップリング処理の実行主体が、電子機器の処理部１０となる。
【０１２７】
４−５．電子機器
上記の実施例では、四輪自動車に搭載するナビゲーション装置に本発明を適用した場合を例に挙げて説明したが、本発明を適用可能な電子機器はこれに限られるわけではない。例えば、二輪自動車に搭載するナビゲーション装置に適用してもよいし、携帯型ナビゲーション装置に適用することとしてもよい。
【０１２８】
また、ナビゲーション以外の用途の電子機器についても本発明を同様に適用可能であることは勿論である。例えば、携帯型電話機やパソコン、ＰＤＡ（Personal Digital Assistant）といった他の電子機器についても本発明を同様に適用して、当該電子機器の位置算出を実現することが可能である。
【符号の説明】
【０１２９】
１、１Ａ 位置算出装置、 ３ ＧＰＳユニット、 ５ ＩＮＳユニット、 ６ 位置算出精度判定部、 ６Ａ 位置誤差レベル判定部、 ７ 影響度合設定部、 ７Ａ 影響モード設定部、 ９ カップリング処理部、 ９Ａ カルマンフィルター処理部、 １０ 処理部、 ２０ 操作部、 ３０ 表示部、 ４０ 通信部、 ５０ 記憶部、 １００ カーナビゲーション装置、 １０００ ナビゲーションシステム
【技術分野】
【０００１】
本発明は、移動体に備えられた衛星測位用ユニット及び慣性測位用ユニットの計測結果を用いた位置算出方法等に関する。
【背景技術】
【０００２】
いわゆるシームレス測位やモーションセンシング、姿勢制御など様々な分野において、慣性センサーの活用が注目されている。慣性センサーとしては、加速度センサーやジャイロセンサー、圧力センサー、地磁気センサーなどが広く知られている。慣性センサーの検出結果を利用して慣性航法演算を行って位置算出を行うシステム（以下、「ＩＮＳ（Inertial Navigation System）」と称する。）も実用化されている。
【０００３】
ＩＮＳにおいては、慣性センサーの検出結果に含まれ得る種々の誤差成分に起因して位置算出の正確性が低下するという問題があり、位置算出の正確性を向上させるための様々な技術が考案されている。例えば、特許文献１には、ＩＮＳ演算結果を、ＧＰＳ（Global Positioning System）を利用して補正する技術が開示されている。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】米国特許出願公開第２０１０／００１９９６３号明細書
【発明の概要】
【発明が解決しようとする課題】
【０００５】
ＧＰＳを利用してＩＮＳ演算結果を補正する技術は、ＧＰＳ演算結果が正しいことを前提としている。特許文献１に開示された技術も同様である。しかし、ＧＰＳ演算結果は、ＧＰＳ衛星から受信したＧＰＳ衛星信号の信号強度、受信環境、ＧＰＳ衛星の天空配置、マルチパスといった種々の要因により、演算結果の精度が低下する場合がある。このため、常にＧＰＳ演算結果を利用してＩＮＳ演算結果を補正することが、必ずしも位置算出の精度改善に繋がるとは限らなかった。
【０００６】
本発明は上述した課題に鑑みて為されたものであり、移動体に備えられた衛星測位用ユニット及び慣性測位用ユニットの計測結果を併用して、移動体の位置をより正確に算出するための手法を提案することを目的とする。
【課題を解決するための手段】
【０００７】
以上の課題を解決するための第１の形態は、移動体に備えられた衛星測位用ユニットの第１の計測結果と、前記移動体に備えられた慣性測位用ユニットの第２の計測結果とを用いて、前記移動体の位置を算出する位置算出方法であって、位置算出精度を判定することと、前記位置算出精度に基づいて、前記第１の計測結果の前記第２の計測結果に対する影響度合を設定することと、前記影響度合に基づき、前記第１の計測結果と前記第２の計測結果とのカップリング処理を実行して前記移動体の位置を算出することと、を含む位置算出方法である。
【０００８】
また、他の形態として、移動体に備えられた衛星測位用ユニットの第１の計測結果と、前記移動体に備えられた慣性測位用ユニットの第２の計測結果とを用いて、前記移動体の位置を算出する位置算出装置であって、位置算出精度を判定する位置算出精度判定部と、前記位置算出精度に基づいて、前記第１の計測結果の前記第２の計測結果に対する影響度合を設定する影響度合設定部と、前記影響度合に基づき、前記第１の計測結果と前記第２の計測結果とのカップリング処理を実行して前記移動体の位置を算出するカップリング処理部と、を備えた位置算出装置を構成してもよい。
【０００９】
この第１の形態等によれば、位置算出精度を判定する。そして、位置算出精度に基づいて、慣性測位用ユニットの計測結果（第２の計測結果）に対する衛星測位用ユニットの計測結果（第１の計測結果）の影響度合を設定する。これにより、特に連続動作時における影響度合の適正化を実現することができる。そして、適正化した影響度合に基づき第１の計測結果と第２の計測結果とのカップリング処理を実行することで、位置算出の正確性を向上させることができる。
【００１０】
また、第２の形態として、第１の形態の位置算出方法において、前記判定することは、前記移動体が移動を開始してからの経過時間又は位置算出回数に基づいて前記位置算出精度を判定することを含む、位置算出方法を構成することとしてもよい。
【００１１】
この第２の形態によれば、移動体が移動を開始してからの経過時間又は位置算出回数から、位置算出精度を簡易且つ適切に判定することができる。
【００１２】
また、第３の形態として、第１又は第２の形態の位置算出方法において、前記カップリング処理は、算出した位置に含まれている誤差を推定する誤差推定演算を含み、前記判定することは、前記誤差推定演算で推定した誤差に基づいて前記位置算出精度を判定することを含む、位置算出方法を構成することとしてもよい。
【００１３】
この第３の形態によれば、カップリング処理において誤差推定演算を行うことで推定した位置の誤差から、位置算出精度を簡易且つ適切に判定することができる。
【００１４】
また、第４の形態として、第１〜第３の何れかの形態の位置算出方法において、前記影響度合には、前記第１の計測結果を採用して前記カップリング処理を実行する実行頻度が含まれており、前記影響度合を設定することは、前記位置算出精度に基づいて前記実行頻度を設定することを含み、前記位置を算出することは、前記実行頻度に従って前記第１の計測結果を採用した前記カップリング処理を実行することを含む、位置算出方法を構成することとしてもよい。
【００１５】
この第４の形態によれば、位置算出精度に基づいて、第１の計測結果を採用してカップリング処理を実行する実行頻度を適正化し、カップリング処理の実効性を向上させることができる。
【００１６】
また、第５の形態として、第４の形態の位置算出方法において、前記実行頻度を設定することは、前記位置算出精度が高いほど低い頻度を設定することである、位置算出方法を構成してもよい。
【００１７】
この第５の形態によれば、位置算出精度が高いほど、第１の計測結果を採用してカップリング処理を実行する実行頻度を低く設定することで、衛星測位用ユニットへの依存度を低減させることができる。位置算出精度が高ければ、第１の計測結果の影響度合を下げてカップリング処理を実行しても、位置算出の正確性は保証される。
【００１８】
また、第６の形態として、第１〜第３の何れかの形態の位置算出方法において、前記カップリング処理は、前記第１の計測結果を観測量とするカルマンフィルター処理を含み、前記影響度合を設定することは、前記位置算出精度に基づいて前記カルマンフィルター処理に用いる誤差パラメーター値を設定することを含み、前記位置を算出することは、前記第１の計測結果及び前記誤差パラメーター値を用いて前記カルマンフィルター処理を実行することを含む、位置算出方法を構成することとしてもよい。
【００１９】
誤差パラメーター値は、例えば、カルマンフィルター処理において第１の計測結果を重視する程度を決定付ける値である。第６の形態によれば、位置算出精度に基づいて誤差パラメーター値を設定することで、誤差パラメーター値を適正化し、移動体の位置をより正確に求めることが可能となる。
【００２０】
また、第７の形態として、第６の形態の位置算出方法において、前記誤差パラメーター値を設定することは、前記位置算出精度が高いほど大きい値を設定することである、位置算出方法を構成することとしてもよい。
【００２１】
この第７の形態によれば、位置算出精度が高いほど、カルマンフィルター処理に用いる誤差パラメーター値に大きい値を設定することで、衛星測位用ユニットへの依存度を低減させることができる。位置算出精度が高ければ、第１の計測結果の影響度合を下げてカップリング処理を実行しても、位置算出の正確性は保証される。
【図面の簡単な説明】
【００２２】
【図１】位置算出装置の主要構成図。
【図２】第１の位置算出装置の構成図。
【図３】カップリング処理の入出力データの説明図。
【図４】第１のモード設定条件の説明図。
【図５】第２のモード設定条件の説明図。
【図６】位置算出を行った実験結果の一例を示す図。
【図７】位置算出を行った実験結果の一例を示す図。
【図８】ナビゲーションシステムのシステム構成の説明図。
【図９】カーナビゲーション装置の機能構成を示すブロック図。
【図１０】演算設定テーブルのテーブル構成の一例を示す図。
【図１１】ナビゲーション処理の流れを示すフローチャート。
【図１２】カップリング処理の流れを示すフローチャート。
【発明を実施するための形態】
【００２３】
以下、図面を参照して、本発明の好適な実施形態の一例について説明する。本実施形態は、衛星測位システムの一種であるＧＰＳ（Global Positioning System）と、慣性航法演算を行うシステムであるＩＮＳ（Inertial Navigation System）とを併用して位置算出を行う実施形態である。
【００２４】
１．原理
１−１．システム構成
図１は、本実施形態における位置算出装置１の主要構成図である。位置算出装置１は、移動体に備えられて、当該移動体の位置を算出する装置（位置算出システム）である。移動体は、自動車やオートバイ、自転車、船、電車といった物の他、人間自体であってもよい。人間が位置算出装置１を携帯し、人間自身が位置算出装置１を備えることとしてもよい。図１では、ユニット（モジュール）を二重線で図示し、ユニットの計測結果を利用して演算処理を行う処理ブロックを一重線で図示することで、両者を区別する。図２についても同様である。
【００２５】
位置算出装置１は、ユニット（モジュール）として、ＧＰＳユニット３と、ＩＮＳユニット５とを備える。また、位置算出装置１は、主要な処理ブロックとして、位置算出精度判定部６と、影響度合設定部７と、カップリング処理部９とを有する。
【００２６】
ＧＰＳユニット３は、衛星測位システムを利用して測位を行うためのユニット（衛星測位用ユニット）である。ＧＰＳユニット３は、ＧＰＳ衛星から発信されているＧＰＳ衛星信号を受信するアンテナや、受信したＧＰＳ衛星信号を処理するプロセッサー等を有して構成される。
【００２７】
ＧＰＳユニット３は、ＧＰＳ衛星信号のコード位相やドップラー周波数、擬似距離、擬似距離変化率等のＧＰＳメジャメント情報を計測可能に構成されている。また、ＧＰＳユニット３は、ＧＰＳメジャメント情報を用いたＧＰＳ演算を行って、移動体の位置や速度（速度ベクトル）等を計測可能に構成されている。ＧＰＳメジャメント情報やＧＰＳ演算結果は、ＧＰＳ計測結果（第１の計測結果）としてカップリング処理部９に出力される。
【００２８】
ＩＮＳユニット５は、慣性航法を利用して測位を行うためのユニット（慣性測位用ユニット）である。ＩＮＳユニット５は、加速度センサーやジャイロセンサー等の慣性センサーや、慣性センサーをパッケージ化した慣性計測ユニット（ＩＭＵ（Inertial Measurement Unit））、慣性センサーの計測結果を処理するプロセッサー等を有して構成される。
【００２９】
ＩＮＳユニット５は、慣性センサーの計測結果を用いて、移動体の加速度（加速度ベクトル）や角速度等をＩＮＳメジャメント情報として計測可能に構成されている。また、ＩＮＳユニット５は、ＩＮＳメジャメント情報を用いた慣性航法演算（ＩＮＳ演算）を行って、移動体の位置や速度（速度ベクトル）、姿勢角等を計測可能に構成されている。ＩＮＳメジャメント情報やＩＮＳ演算結果は、ＩＮＳ計測結果（第２の計測結果）としてカップリング処理部９に出力される。
【００３０】
位置算出精度判定部６は、位置算出の確からしさである位置算出精度を判定する。具体的には、位置算出精度判定部６は、移動体が移動を開始してからの経過時間又は位置算出回数に基づいて位置算出精度を判定する。また、位置算出精度判定部６は、カップリング処理部９がカップリング処理において所定の誤差推定演算を行うことで推定したカップリング推定誤差に基づいて、位置算出精度を判定する。
【００３１】
影響度合設定部７は、位置算出精度判定部６により判定された位置算出精度に基づいて、ＧＰＳ計測結果（第１の計測結果）のＩＮＳ計測結果（第２の計測結果）に対する影響度合を設定する。
【００３２】
カップリング処理部９は、影響度合設定部７により設定された影響度合に基づいて、ＧＰＳ計測結果（第１の計測結果）とＩＮＳ計測結果（第２の計測結果）とのカップリング処理を実行して移動体の位置等を算出する。
【００３３】
図２は、図１の位置算出装置１を適用した第１の位置算出装置１Ａの構成図である。第１の位置算出装置１Ａでは、図１の位置算出精度判定部６が位置誤差レベル判定部６Ａを有し、影響度合設定部７が影響モード設定部７Ａを有する。また、図１のカップリング処理部９がカルマンフィルター処理部９Ａを有する。
【００３４】
位置誤差レベル判定部６Ａは、後述するモード設定条件（第１又は第２のモード設定条件）に従って位置誤差レベルを判定する。位置誤差レベルは、位置算出精度を決定付ける位置誤差のレベルである。
【００３５】
影響モード設定部７Ａは、位置誤差レベル判定部６Ａにより判定された位置誤差レベルに基づいてＧＰＳ影響モードを設定する。ＧＰＳ影響モードは、ＧＰＳの影響度合を決定づけるモードである。本実施形態では、ＧＰＳ計測結果のＩＮＳ計測結果に対する影響度合が低い順に、「第１の影響モード」、「第２の影響モード」、「第３の影響モード」及び「第４の影響モード」の４種類のモードを択一的に設定する場合を想定する。
【００３６】
カルマンフィルター処理部９Ａは、ＧＰＳ計測結果を観測量“Ｚ”とするカルマンフィルター処理を実行して、ＧＰＳ計測結果とＩＮＳ計測結果とをカップリング（結び付け）する。具体的には、カルマンフィルターの理論に基づき、予測演算（時刻更新）と補正演算（観測更新）とを行って、移動体の状態“Ｘ”を推定する。
【００３７】
本実施形態において、移動体の状態“Ｘ”には、少なくとも移動体の位置が含まれる。予測演算では、例えば、ＩＮＳユニット５から入力したＩＮＳ計測結果を制御入力“Ｕ”として、１つ前の時刻（前回時刻）における状態補正値“Ｘ＋”から、現在の時刻（今回時刻）における状態“Ｘ”を予測する演算を行って、状態予測値“Ｘ−”を算出する。
【００３８】
補正演算では、例えば、ＧＰＳユニット３から入力したＧＰＳ計測結果を観測量“Ｚ”として用いて、予測演算で算出した状態予測値“Ｘ−”を補正する演算を行って、状態補正値“Ｘ＋”を算出する。そして、算出した状態補正値“Ｘ＋”を、カップリング結果として出力する。
【００３９】
また、カルマンフィルター処理部９Ａは、ＧＰＳ計測結果とは別に、移動体の運動モデルに基づく制約条件を観測量“Ｚ”として適用可能に構成されている。本実施形態では、移動体の停止時における速度制約条件である「停止時速度制約条件」と、移動体の移動時における速度制約条件である「移動時速度制約条件」との２種類の速度制約条件を適用する場合を想定する。
【００４０】
停止時速度制約条件（第１の制約条件）は、移動体の停止時に適用可能な制約条件である。移動体が停止しているのであれば、理想的には移動体の速度はゼロである。従って、移動体が停止していると判定した場合は「移動体の各軸の速度成分＝０（速度ベクトル＝ゼロベクトル）」を観測量“Ｚ”として与えることができる。
【００４１】
移動時速度制約条件（第２の制約条件）は、移動体の移動時に適用可能な制約条件である。例えば、移動体として四輪自動車を想定した場合、通常、四輪自動車はジャンプや横滑りすることはないと仮定することができる。従って、移動体が移動していると判定した場合は「移動体の縦横方向の速度成分＝０」を観測量“Ｚ”として与えることができる。
【００４２】
本実施形態では、ＧＰＳ計測結果と上記の制約条件（停止時速度制約条件又は移動時速度制約条件）とを切り替えて観測量“Ｚ”に適用する場合を一例として説明する。なお、本実施形態とは異なり、ＧＰＳ計測結果と上記の制約条件とを観測量“Ｚ”として併用することも当然に可能である。
【００４３】
図３は、カルマンフィルター処理の入出力データの説明図である。制御入力“Ｕ”と、観測量“Ｚ”と、状態“Ｘ”との対応関係を表したテーブルを図示している。カップリングには種々の方式が存在する。その中でも、ルーズカップリング（疎結合）と呼ばれる方式と、タイトカップリング（密結合）と呼ばれる方式とが一般的に用いられる。
【００４４】
ルーズカップリング方式は、ＧＰＳとＩＮＳとの結び付きが比較的弱いカップリング方式である。この方式では、例えば、制御入力“Ｕ”をＩＮＳ演算結果（位置、速度、姿勢角等）とし、観測量“Ｚ”をＧＰＳ演算結果（位置、速度等）としてカップリング処理を実行する。そして、移動体情報（位置、速度、姿勢角等）を状態“Ｘ”として推定する。
【００４５】
タイトカップリング方式は、ＧＰＳとＩＮＳとの結び付きが比較的強いカップリング方式である。この方式では、例えば、制御入力“Ｕ”をＩＮＳ演算結果（位置、速度、姿勢角等）とし、観測量“Ｚ”をＧＰＳメジャメント情報（コード位相、ドップラー周波数、擬似距離、擬似距離変化率等）としてカップリング処理を実行する。そして、移動体情報（位置、速度、姿勢角等）を状態“Ｘ”として推定する。
【００４６】
また、タイトカップリング方式として、制御入力“Ｕ”をＩＮＳメジャメント情報（加速度、角速度等）とし、観測量“Ｚ”をＧＰＳメジャメント情報（コード位相、ドップラー周波数、擬似距離、擬似距離変化率等）とし、状態“Ｘ”を移動体情報（位置、速度、姿勢角等）とする手法も存在する。
【００４７】
本実施形態の位置算出方法は、上記の何れのカップリング方式に対しても実質的に同一に適用可能である。つまり、ＧＰＳ計測結果（第１の計測結果）として、ＧＰＳメジャメント情報を適用してもよいし、ＧＰＳ演算結果を適用してもよい。また、ＩＮＳ計測結果（第２の計測結果）として、ＩＮＳメジャメント情報を適用してもよいし、ＩＮＳ演算結果を適用してもよい。
【００４８】
ＩＮＳ計測結果及びＧＰＳ計測結果として用いる情報は、適用するシステムに応じて適宜設定可能である。この場合、カルマンフィルター処理の予測演算及び補正演算で用いる演算式やパラメーター値を、適用するシステムに応じて適宜設定すればよい。なお、具体的な演算式やパラメーター値については、公知の手法に基づき定義可能であるため、ここでは説明を省略する。
【００４９】
１−２．ＧＰＳ影響モードの設定
本実施形態では、大きく分けて２つのＧＰＳ影響モード設定方法について説明する。第１の設定方法は、移動体が移動を開始してからの経過時間又は位置算出回数に基づいて位置算出精度を判定し、当該位置算出精度に基づいてＧＰＳ影響モードを設定する方法である。第２の設定方法は、カップリング処理において所定の誤差推定演算を行うことで推定したカップリング推定誤差に基づいて位置算出精度を判定し、当該位置算出精度に基づいてＧＰＳ影響モードを設定する方法である。
【００５０】
（１）第１の設定方法
図４は、ＧＰＳ影響モードの第１の設定方法の説明図であり、ＧＰＳ影響モードの設定で用いる第１のモード設定条件を定めた第１のモード設定条件テーブルを図示したものである。第１のモード設定条件テーブルには、第１のモード設定条件と、位置誤差レベルと、設定モードとが対応付けて定められている。
【００５１】
第１のモード設定条件は、移動体が移動を開始してからの経過時間（以下、「移動開始後経過時間」と称す。）、又は、移動体が移動を開始してからの位置算出回数（以下、「移動開始後位置算出回数」と称す。）に応じた条件が定められている。「移動を開始してから」とは、移動体が停止した状態から動き出してからという意味である。
【００５２】
１番目の条件は「移動開始後経過時間≦第１の閾値時間θT1、又は、移動開始後位置算出回数≦第１の閾値回数θC1」であり、位置誤差レベルは「Ｌ１」、設定モードは「第１の影響モード」である。２番目の条件は「第１の閾値時間θT1＜移動開始後経過時間≦第２の閾値時間θT2、又は、第１の閾値回数θC1＜移動開始後位置算出回数≦第２の閾値回数θC2」であり、位置誤差レベルは「Ｌ２」、設定モードは「第２の影響モード」である。
【００５３】
３番目の条件は「第２の閾値時間θT2＜移動開始後経過時間≦第３の閾値時間θT3、又は、第２の閾値回数θC2＜移動開始後位置算出回数≦第３の閾値回数θC3」であり、位置誤差レベルは「Ｌ３」、設定モードは「第３の影響モード」である。４番目の条件は「第３の閾値時間θT3＜移動開始後経過時間、又は、第３の閾値回数θC3＜移動開始後位置算出回数」であり、位置誤差レベルは「Ｌ４」、設定モードは「第４の影響モード」である。
【００５４】
位置誤差レベルは、位置算出精度を表すレベルであり、数字が大きいほど位置誤差が大きく、位置算出精度が低いことを意味する。また、設定モードは、数字が大きいほどＧＰＳの影響度合が高いことを意味する。
【００５５】
第１〜第３の閾値時間「θT1，θT2，θT3」及び第１〜第３の閾値回数「θC1，θC2，θC3」は、本実施形態の位置算出方法を適用するシステムに応じて適宜設定可能である。例えば、位置算出を「１秒間隔」で行うシステムに適用するのであれば、「θT1＝６０秒、θT2＝９０秒、θT3＝１２０秒」や「θC1＝５０回、θC2＝１００回、θC3＝１５０回」といった値を定めておくことができる。
【００５６】
移動体が停止している場合は、停止時速度制約条件を利用することで、位置算出の誤差を低減させることができる。誤差が低減された状態で移動を開始すると、暫くの間は位置算出精度が高い状態が維持される。しかし、慣性航法演算では、加速度（加速度ベクトル）を積分して速度（速度ベクトル）を算出し、速度（速度ベクトル）を積分して距離及び移動方向を算出し、算出した距離を前回位置に継ぎ足すように加算することで位置を算出する。つまり、多重の積分演算を行って累積的に位置を求めるために、時間経過に伴って誤差が累積する特徴がある。そのため、移動を開始してからの経過時間が長くなると、位置算出の精度が低下する。
【００５７】
そこで、第１の設定方法では、移動開始後経過時間が長くなるほど、又は、移動開始後位置算出回数が多くなるほど、位置誤差レベルが高い（位置算出精度が低い）と判定する。そして、位置誤差レベルが高いほど、ＧＰＳ計測結果をＩＮＳ計測結果に強く作用させるために、ＧＰＳの影響度合を高くする。
【００５８】
第１の設定方法は、移動体が頻繁に停止及び移動を繰り返す環境（例えば都心部）に適した設定方法である。都心部では、信号機が多く存在するために、自動車は頻繁に停止及び移動を繰り返す。また、道路が入り組んでいるために、自動車の移動方向も頻繁に変化する。これらの環境では、慣性航法演算に誤差が生じやすいため、移動開始からの時間経過に応じてＧＰＳの影響度合を変更することで、誤差の累積を抑えることができる。
【００５９】
（２）第２の設定方法
図５は、ＧＰＳ影響モードの第２の設定方法の説明図であり、ＧＰＳ影響モードの設定で用いる第２のモード設定条件を定めた第２のモード設定条件テーブルを図示したものである。第２のモード設定条件テーブルには、第２のモード設定条件と、位置誤差レベルと、設定モードとが対応付けて定められている。位置誤差レベル及び設定モードは、図４の第１のモード設定条件テーブルと同じである。
【００６０】
第２のモード設定条件は、カップリング推定誤差に基づいて定義されている。カップリング推定誤差は、カップリング結果に含まれ得る誤差の推定値であり、カップリング処理において所定の誤差推定演算を行うことで推定される。例えば、カルマンフィルター処理では、推定対象とする状態“Ｘ”の誤差“Ｐ”を設定して演算を行う。予測演算及び補正演算において、状態“Ｘ”と併せて誤差“Ｐ”の予測及び補正を行うことで、カップリング推定誤差が定まる。
【００６１】
状態“Ｘ”が複数の要素で構成される場合は、誤差“Ｐ”は行列形式の誤差共分散行列“Ｐ”で表すことができる。この場合、誤差共分散行列“Ｐ”の対角成分から、各要素の誤差を見積もることができる。例えば、状態“Ｘ”の要素が移動体の位置、速度及び姿勢角であれば、誤差共分散行列“Ｐ”の対角成分が、それぞれカップリング位置推定誤差、カップリング速度推定誤差及びカップリング姿勢角推定誤差となる。
【００６２】
１番目の条件は「カップリング推定誤差≦第１の閾値誤差θE1」であり、位置誤差レベルは「Ｌ１」、設定モードは「第１の影響モード」である。２番目の条件は「第１の閾値誤差θE1＜カップリング推定誤差≦第２の閾値誤差θE2」であり、位置誤差レベルは「Ｌ２」、設定モードは「第２の影響モード」である。
【００６３】
３番目の条件は「第２の閾値誤差θE2＜カップリング推定誤差≦第３の閾値誤差θE3」であり、位置誤差レベルは「Ｌ３」、設定モードは「第３の影響モード」である。４番目の条件は「第３の閾値誤差θE3＜カップリング推定誤差」であり、位置誤差レベルは「Ｌ４」、設定モードは「第４の影響モード」である。
【００６４】
この場合は、カップリング位置推定誤差、カップリング速度推定誤差及びカップリング姿勢角推定誤差に対してそれぞれ閾値を定めておく。例えば、第１の閾値誤差θE1に相当する閾値として“１０［ｍ］”、“１［ｍ／ｓ］”、“１［°］”、第２の閾値誤差θE2に相当する閾値として“２０［ｍ］”、“２［ｍ／ｓ］”、“２［°］”、第３の閾値誤差θE3に相当する閾値として“３０［ｍ］”、“３［ｍ／ｓ］”、“３［°］”をそれぞれ定めておく。そして、カップリング位置推定誤差、カップリング速度推定誤差及びカップリング姿勢角推定誤差それぞれに対する閾値判定を行い、ＡＮＤ条件又はＯＲ条件を適用して位置誤差レベルを判定する。
【００６５】
カップリング推定誤差が小さければ、位置算出精度は高いと考えられる。そのため、ＧＰＳの影響度合を低くしても、位置算出の正確性はある程度保証される。しかし、カップリング推定誤差が大きければ、位置算出精度は低いと考えられる。そのため、ＧＰＳの影響度合を高くしなければ、位置算出精度の改善が図れない。
【００６６】
そこで、カップリング推定誤差が大きいほど、位置誤差レベルが高い（位置算出精度が低い）と判定する。そして、位置誤差レベルが高いほど、ＧＰＳ計測結果をＩＮＳ計測結果に強く作用させることを目的として、ＧＰＳの影響度合を高く設定する。
【００６７】
第２の設定方法は、高品質のＧＰＳ衛星信号を継続して受信可能な環境（例えばオープンスカイ環境）に適した設定方法である。オープンスカイ環境では、ＧＰＳメジャメント情報やＧＰＳ演算結果を高い精度で取得することができるため、ＩＮＳ計測結果とのカップリング処理を実行することで、位置算出精度が向上する。従って、ＧＰＳの影響度合を下げる方向に作用し易くなり、ＩＮＳを重視した位置算出が実現され易くなる。
【００６８】
１−３．演算設定
カップリング処理部９は、ＧＰＳ影響モードに応じて演算設定を変更してカップリング処理を行う。本実施形態において、演算設定には、ＧＰＳ計測結果採用頻度と、カルマンフィルター処理で用いる誤差パラメーター値とが含まれる。
【００６９】
ＧＰＳ計測結果採用頻度は、ＧＰＳ計測結果を採用してカップリング処理を実行する実行頻度である。図２では、カルマンフィルター処理部９Ａが、観測量“Ｚ”であるＧＰＳ計測結果を採用して補正演算を実行する頻度が、ＧＰＳ計測結果採用頻度に相当する。
【００７０】
ＧＰＳの影響度合が高いモードでは、ＧＰＳ計測結果をＩＮＳ計測結果に対して強く作用させることが必要となる。逆に、ＧＰＳの影響度合が低いモードでは、ＧＰＳ計測結果をＩＮＳ計測結果に対する作用を弱める必要がある。そこで、ＧＰＳの影響度合が低いモードほど、より低い頻度をＧＰＳ計測結果採用頻度に設定する。
【００７１】
誤差パラメーター値は、カルマンフィルターの演算において設定するパラメーター値の一種である。本実施形態では、観測量“Ｚ”の誤差に相当する観測誤差（観測雑音）“Ｒ”を、誤差パラメーターの一例として説明する。
【００７２】
カルマンフィルター処理の補正演算において、観測誤差“Ｒ”を小さく設定すると、観測量“Ｚ”に追従するように状態“Ｘ”が補正される。つまり、観測量“Ｚ”を信用・重視して状態“Ｘ”を推定するようにフィルターが作用する。それに対して、観測誤差“Ｒ”を大きく設定すると、状態予測値“Ｘ−”に追従するように状態“Ｘ”が補正される。つまり、予測演算で予測された状態予測値“Ｘ−”を信用・重視して状態“Ｘ”を推定するようにフィルターが作用する。
【００７３】
そこで、ＧＰＳの影響度合が低いモードほど、ＧＰＳ計測結果のＩＮＳ計測結果に対する作用を弱めることを目的として、より大きな値を観測誤差（Ｒ値）に設定する。
【００７４】
１−４．実験結果
実際に位置算出を行った実験結果を説明する。移動体を予め定められた経路に沿って移動させ、その場合に算出される位置を東西南北の２次元平面にプロットする実験を行った。図４の第１のモード設定条件を適用し、移動開始後経過時間に基づいてＧＰＳ影響モードを設定した。実験に用いた移動開始後経過時間の閾値は「θT1＝６０秒、θT2＝９０秒、θT3＝１２０秒」である。各図において、横軸は東西方向、縦軸は南北方向をそれぞれ示す。単位はメートル［ｍ］である。東西方向「０ｍ」、南北方向「０ｍ」の位置をスタート地点とし、スタート地点から西方向に向かい、時計回り方向に周回する経路を辿った。ゴール地点は、スタート地点の近傍所定位置である。
【００７５】
図６は、従来の位置算出方法を適用した実験結果である。この実験ではＧＰＳとＩＮＳとのカップリング処理は行っていない。図６では、移動体の真の軌跡を「点線」で、ＧＰＳ演算位置の軌跡を「一点鎖線」で、ＩＮＳ演算位置の軌跡を「実線」でそれぞれ示している。
【００７６】
この実験結果を見ると、最初のうちは真の軌跡に沿ったＩＮＳ演算位置の軌跡が得られているが、長時間が経過すると、ＩＮＳ演算位置の誤差が増大していることがわかる。特に、点線で囲った部分Ａ１に着目すると、本来は右に曲がるべき場所でＩＮＳ演算位置は曲がることができず、そのまま行き過ぎてしまっている。その後、行き過ぎた道を引き返したが、本来曲がるべき場所から少し離れた場所で曲がっており、その距離分の誤差が位置誤差として重畳してしまっている。
【００７７】
図７は、本実施形態の位置算出方法を適用した実験結果である。この実験ではＧＰＳとＩＮＳとのカップリング処理を行った。図７では、移動体の真の軌跡を「点線」で、ＧＰＳ演算位置の軌跡を「一点鎖線」で、カップリング演算位置の軌跡を「実線」でそれぞれ示している。
【００７８】
この実験結果を見ると、長時間が経過しても位置誤差が増大することはなく、良好な結果が得られていることがわかる。部分Ａ１での行き過ぎの問題も解消されている。部分Ａ１の前段部分を調べてみると、部分Ａ２では、ＧＰＳ影響モードが「第２の影響モード」から「第３の影響モード」に変化していた。つまり、この部分では、ＧＰＳの影響度合がより高いモードに遷移していた。その結果、ＧＰＳ演算位置の軌跡に引き寄せられて、カップリング演算位置の軌跡が真の軌跡に徐々に近付いていく様子が確認できる。
【００７９】
２．実施例
次に、上記の位置算出装置を備えた電子機器の実施例について説明する。ここでは、位置算出装置を具備するナビゲーション装置の実施例を説明する。但し、本発明を適用可能な実施例が以下説明する実施例に限定されるわけではないことは勿論である。
【００８０】
２−１．システム構成
図８は、本実施例におけるナビゲーションシステム１０００のシステム構成の説明図である。ナビゲーションシステム１０００は、移動体の一種である四輪自動車（以下、単に「自動車」と称す。）に、位置算出装置を具備した電子機器の一種であるカーナビゲーション装置１００が設置されたシステムである。
【００８１】
カーナビゲーション装置１００は、自動車に設置され、自動車の運転者に対するナビゲーションを行う電子機器である。カーナビゲーション装置１００は、ＧＰＳユニット３と、ＩＮＳユニット５とを備える。
【００８２】
本実施例では、ＧＰＳユニット３は、ＧＰＳメジャメント情報５５を計測して出力する。また、ＩＮＳユニット５は、ＩＮＳメジャメント情報５６を、機体座標系（Body Frame）として知られるＢフレームで計測して出力する。Ｂフレームは、例えば、移動体の前方を正とする前後方向をＲ軸（ロール軸）、右方を正とする左右方向をＰ軸（ピッチ軸）、鉛直下方を正とする上下方向をＹ軸（ヨー軸）とする三次元直交座標系である。
【００８３】
カーナビゲーション装置１００は、ＧＰＳユニット３から取得したＧＰＳメジャメント情報を用いてＧＰＳ演算処理を行い、且つ、ＩＮＳユニット５から取得したＩＮＳメジャメント情報を用いてＩＮＳ演算処理を行う。そして、これらの演算結果に対するカップリング処理を実行して自動車の位置を算出し、算出位置をプロットしたナビゲーション画面を表示部３０であるディスプレイに表示させる。
【００８４】
自動車の位置は、自動車の移動空間を定める絶対的な座標系であるＮフレームにおいて演算する。Ｎフレームは、例えば、北東下座標系として知られるＮＥＤ（North East Down）座標系や、地球中心地球固定座標系として知られるＥＣＥＦ（Earth Centered Earth Fixed）座標系として定義される。
【００８５】
２−２．機能構成
図９は、カーナビゲーション装置１００の機能構成の一例を示すブロック図である。カーナビゲーション装置１００は、ＧＰＳユニット３と、ＩＮＳユニット５と、処理部１０と、操作部２０と、表示部３０と、通信部４０と、記憶部５０とを備えて構成される。
【００８６】
処理部１０は、記憶部５０に記憶されているシステムプログラム等の各種プログラムに従ってカーナビゲーション装置１００の各部を統括的に制御する制御装置であり、ＣＰＵ（Central Processing Unit）等のプロセッサーを有して構成される。処理部１０は、記憶部５０に記憶されたナビゲーションプログラム５１に従ってナビゲーション処理を行い、自動車の現在位置を指し示した地図を表示部３０に表示させる処理を行う。
【００８７】
操作部２０は、例えばタッチパネルやボタンスイッチ等により構成される入力装置であり、押下されたキーやボタンの信号を処理部１０に出力する。この操作部２０の操作により、目的地の入力等の各種指示入力がなされる。
【００８８】
表示部３０は、ＬＣＤ（Liquid Crystal Display）等により構成され、処理部１０から入力される表示信号に基づいた各種表示を行う表示装置である。表示部３０には、ナビゲーション画面等が表示される。
【００８９】
通信部４０は、処理部１０の制御に従って、装置内部で利用される情報をインターネット等の通信ネットワークを介して外部とやりとりするための通信装置である。この通信には、公知の無線通信技術を適用可能である。
【００９０】
記憶部５０は、ＲＯＭ（Read Only Memory）やフラッシュＲＯＭ、ＲＡＭ（Random Access Memory）等の記憶装置によって構成され、カーナビゲーション装置１００のシステムプログラムや、ナビゲーション機能等の各種機能を実現するための各種プログラム、データ等を記憶している。また、各種処理の処理中データ、処理結果などを一時的に記憶するワークエリアを有する。
【００９１】
記憶部５０には、プログラムとして、処理部１０により読み出され、ナビゲーション処理（図１１参照）として実行されるナビゲーションプログラム５１が記憶されている。ナビゲーションプログラム５１は、カップリング処理（図１２参照）として実行されるカップリングプログラム５１３をサブルーチンとして含む。
【００９２】
また、記憶部５０には、データとして、演算設定テーブル５２と、モード設定条件テーブル５３と、設定モード５４と、ＧＰＳメジャメント情報５５と、ＩＮＳメジャメント情報５６と、ＧＰＳ演算結果５７と、ＩＮＳ演算結果５８と、カップリング結果５９とが記憶される。
【００９３】
演算設定テーブル５２は、カップリング処理における演算設定が定義されたテーブルであり、そのテーブル構成の一例を図１０に示す。演算設定テーブル５２には、ＧＰＳ影響モード５２１と、演算設定５２３とが対応付けて記憶されている。
【００９４】
ＧＰＳ計測結果採用頻度については、第１の影響モードでは「採用しない」が定められ、第２の影響モードでは「１０回に１回」が定められている。また、第３の影響モードでは「５回に１回」が定められており、第４の影響モードでは「毎回」が定められている。つまり、ＧＰＳの影響度合が低くなるほど、より低い頻度がＧＰＳ計測結果採用頻度に設定される。
【００９５】
カルマンフィルター処理の観測誤差（Ｒ値）には、位置の観測誤差である位置観測誤差“ＲP”と、速度の観測誤差である速度観測誤差“ＲV”とが含まれる。第１の影響モードではＧＰＳ計測結果を採用しないため、観測誤差は「−（無し）」が定められている。また、第２の影響モードでは「ＲP＝５００，ＲV＝５０」が定められ、第３の影響モードでは「ＲP＝１００，ＲV＝１０」が定められ、第４の影響モードでは「ＲP＝（σP）2，ＲV＝（σV）2」が定められている。
【００９６】
“σP”及び“σV”は、ＧＰＳ演算結果に含まれる位置誤差及び速度誤差である。本願発明者が行った実験によれば、通常の測位環境では、位置誤差及び速度誤差は“σP＝３〜４［ｍ］”、“σV＝０．６〜０．８［ｍ／ｓ］”程度の値として算出される。このため、第４の影響モードでは、位置観測誤差“ＲP”として“１０”程度の値が設定され、速度観測誤差“ＲV”として“０．５”程度の値が設定される。従って、ＧＰＳの影響度合が低くなるほど、より大きな値が観測誤差“Ｒ”に設定される。
【００９７】
モード設定条件テーブル５３には、ＧＰＳ影響モードを設定するための条件が定められたテーブルであり、例えば第１のモード設定条件テーブルや第２のモード設定条件テーブル（図４及び図５参照）がこれに含まれる。
【００９８】
設定モード５４は、設定されているＧＰＳ影響モードであり、影響モード設定処理により随時更新される。
【００９９】
２−３．処理の流れ
図１１は、処理部１０が、記憶部５０に記憶されたナビゲーションプログラム５１に従って実行するナビゲーション処理の流れを示すフローチャートである。
【０１００】
先ず、処理部１０は、ＧＰＳユニット３及びＩＮＳユニット５から、ＧＰＳメジャメント情報５５及びＩＮＳメジャメント情報５６の取得を開始する（ステップＡ１）。そして、処理部１０は、移動状況判定処理を行う（ステップＡ３）。具体的には、例えば、ＩＮＳユニット５からＩＮＳメジャメント情報５６として取得した自動車の加速度（加速度ベクトル）や角速度に基づいて、自動車が停止している状態であるか、移動している状態であるかを判定する。
【０１０１】
その後、処理部１０は、ＧＰＳ演算処理を行う（ステップＡ５）。具体的には、ＧＰＳユニット３から取得したＧＰＳメジャメント情報５５を用いて、公知の測位計算を行って、自動車の位置や速度（速度ベクトル）を演算する。また、公知の誤差推定演算を行って、位置及び速度（速度ベクトル）の誤差を推定する。そして、これらの演算結果をＧＰＳ演算結果５７として記憶部５０に記憶させる。
【０１０２】
また、処理部１０は、ＩＮＳ演算処理を行う（ステップＡ７）。具体的には、ＩＮＳユニット５から取得したＩＮＳメジャメント情報５６を用いて、公知の慣性航法演算を行って、自動車の位置や速度（速度ベクトル）、姿勢角を演算する。そして、これらの演算結果をＩＮＳ演算結果５８として記憶部５０に記憶させる。
【０１０３】
その後、処理部１０は、位置算出精度判定処理を行う（ステップＡ８）。具体的には、記憶部５０に記憶されたモード設定条件テーブル５３を参照し、移動開始後経過時間又は移動開始後位置算出回数や、カップリング推定誤差に基づいて、位置算出精度を示す位置誤差レベルを判定する。
【０１０４】
次いで、処理部１０は、影響モード設定処理を行う（ステップＡ９）。具体的には、記憶部５０に記憶されたモード設定条件テーブル５３を参照し、ステップＡ８で判定した位置誤差レベルに対応付けられた設定モードで記憶部５０の設定モード５４を更新する。
【０１０５】
その後、処理部１０は、記憶部５０に記憶されたカップリングプログラム５１３に従ってカップリング処理を実行する（ステップＡ１１）。
【０１０６】
図１２は、カップリング処理の流れを示すフローチャートである。
処理部１０は、ＧＰＳ演算結果５７をカップリング処理に採用するか否かを判定する（ステップＢ１）。具体的には、影響モード設定処理で設定されたＧＰＳ影響モードに対応付けられたＧＰＳ計測結果採用頻度に基づき、今回のカップリング処理においてＧＰＳ演算結果５７を採用するか否かを判定する。
【０１０７】
ＧＰＳ演算結果５７をカップリング処理に採用すると判定したならば（ステップＢ１；Ｙｅｓ）、処理部１０は、最新のＧＰＳ演算結果５７を観測量とする観測量ベクトル“Ｚ”を設定する（ステップＢ３）。また、演算設定テーブル５２を参照し、現在の設定モード５４に対応する観測誤差に基づいて観測誤差共分散行列“Ｒ”を設定する（ステップＢ５）。そして、処理部１０は、ステップＢ３及びＢ５で設定した観測量ベクトル“Ｚ”及び観測誤差共分散行列“Ｒ”を用いて、カルマンフィルター処理を実行する（ステップＢ７）。
【０１０８】
一方、ステップＢ１においてＧＰＳ演算結果５７をカップリング処理に採用しないと判定したならば（ステップＢ１；Ｎｏ）、処理部１０は、ステップＡ３で判定した移動状況を判定する（ステップＢ９）。そして、移動状況が「移動」である場合は（ステップＢ９；移動）、移動時制約速度ベクトルを観測量ベクトル“Ｚ”として設定する（ステップＢ１１）。また、移動時用速度観測誤差（例えば所定値）に基づき観測誤差共分散行列“Ｒ”を設定する（ステップＢ１３）。そして、処理部１０は、ステップＢ１１及びＢ１３で設定した観測量ベクトル“Ｚ”及び観測誤差共分散行列“Ｒ”を用いて、カルマンフィルター処理を実行する（ステップＢ７）。
【０１０９】
また、移動状況が「停止」である場合は（ステップＢ９；停止）、処理部１０は、停止時制約速度ベクトルを観測量ベクトル“Ｚ”として設定する（ステップＢ１５）。また、停止時用速度観測誤差（例えば所定値）に基づき観測誤差共分散行列“Ｒ”を設定する（ステップＢ１７）。そして、処理部１０は、ステップＢ１５及びＢ１７で設定した観測量ベクトル“Ｚ”及び観測誤差共分散行列“Ｒ”を用いて、カルマンフィルター処理を実行する（ステップＢ７）。
【０１１０】
ステップＢ７においてカルマンフィルター処理を行うと、処理部１０は、その結果をカップリング結果５９として記憶部５０に記憶させる。そして、処理部１０は、カップリング処理を終了する。
【０１１１】
図１１のナビゲーション処理に戻り、カップリング処理を行ったならば、処理部１０は、カップリング結果５９を出力する（ステップＡ１３）。そして、処理部１０は、処理を終了するか否かを判定する（ステップＡ１５）。例えば、操作部２０を介してユーザーによりナビゲーションの終了指示操作がなされた場合に、ナビゲーション処理を終了すると判定する。
【０１１２】
まだ処理を終了しないと判定した場合は（ステップＡ１５；Ｎｏ）、処理部１０は、ステップＡ３に戻る。また、処理を終了すると判定した場合は（ステップＡ１５；Ｙｅｓ）、処理部１０は、ナビゲーション処理を終了する。
【０１１３】
３．作用効果
ＧＰＳユニット３とＩＮＳユニット５とを備えた位置算出装置１において、位置算出精度判定部６は、位置算出精度を判定する。影響度合設定部７は、位置算出精度判定部６により判定された位置算出精度に基づいて、ＧＰＳ計測結果のＩＮＳ計測結果に対する影響度合を設定する。カップリング処理部９は、影響度合設定部７により設定された影響度合に基づいてＧＰＳ計測結果とＩＮＳ計測結果とのカップリング処理を実行して、移動体の位置を算出する。
【０１１４】
位置算出精度判定部６は、例えば、移動体が移動を開始してからの経過時間又は位置算出回数に基づいて位置算出精度を判定する。また、位置算出精度判定部６は、例えば、カップリング処理部６が所定の誤差推定演算を行うことで推定したカップリング推定誤差に基づいて位置算出精度を判定する。
【０１１５】
第１の位置算出装置１Ａでは、影響度合設定部７は影響モード設定部７Ａを有し、位置算出精度判定部６が有する位置誤差レベル判定部６Ａにより判定された位置誤差レベルに基づいてＧＰＳ影響モードを設定する。具体的には、位置誤差レベルが低いほど（位置算出精度が高いほど）、ＧＰＳの影響度合が低いＧＰＳ影響モードを設定する。
【０１１６】
また、第１の位置算出装置１Ａでは、カップリング処理部９はカルマンフィルター処理部９Ａを有し、影響モード設定部７Ａより設定されたＧＰＳ影響モードに応じて演算設定を変更してカルマンフィルター処理を実行する。演算設定には、ＧＰＳ計測結果を採用してカップリング処理を実行する実行頻度が含まれ、ＧＰＳの影響度合が低い影響モードほど、より低い頻度が設定される。また、演算設定には、観測量とするＧＰＳ計測結果の想定誤差を示す観測誤差（Ｒ値）が含まれ、ＧＰＳの影響度合が低い影響モードほど、より大きな値が設定される。
【０１１７】
このように、位置算出精度に応じて、衛星測位用ユニットの計測結果の慣性測位用ユニットの計測結果に対する影響度合を変更することで、特に位置算出装置の連続動作時において影響度合を適正化することができる。そして、適正化した影響度合に応じてカップリング処理の演算設定を変更することで、カップリング処理の実効性を高め、ひいては位置算出の正確性を向上させることが可能となる。
【０１１８】
４．変形例
本発明を適用可能な実施例は、上記の実施例に限定されることなく、本発明の趣旨を逸脱しない範囲で適宜変更可能であることは勿論である。以下、変形例について説明するが、上記の実施例と同一の構成要素については同一の符号を付して説明を省略し、上記の実施例とは異なる部分を中心に説明する。
【０１１９】
４−１．ユニット
上記の実施形態では、衛星測位用ユニットとして、ＧＰＳを適用したＧＰＳユニットを例に挙げて説明したが、ＷＡＡＳ（Wide Area Augmentation System）、ＱＺＳＳ（Quasi Zenith Satellite System）、ＧＬＯＮＡＳＳ（GLObal NAvigation Satellite System）、ＧＡＬＩＬＥＯ等の他の衛星測位システムを適用したユニットとしてもよいことは勿論である。
【０１２０】
また、上記の実施形態では、慣性測位用ユニットとして、ＩＮＳユニットを例に挙げて説明したが、ＩＮＳメジャメント情報（加速度や角速度）を計測する慣性センサーや慣性計測ユニット（ＩＭＵ）を慣性測位用ユニットとしてもよい。この場合は、慣性測位用ユニットにより計測されたＩＮＳメジャメント情報を用いて、位置算出装置の処理部がＩＮＳ演算処理を行えばよい。
【０１２１】
４−２．カップリング処理
上記の実施形態では、カップリング処理の一例としてカルマンフィルター処理を例に挙げて説明したが、カップリング処理はこれに限られない。例えば、ＧＰＳ計測結果とＩＮＳ計測結果との平均演算を行う平均処理をカップリング処理に含めることとしてもよい。
【０１２２】
平均演算としては、単純な算術平均や幾何平均を適用してもよいし、加重平均を適用してもよい。算術平均や幾何平均を適用するのであれば、カップリング処理の演算設定として、例えば、ＧＰＳ計測結果を採用して平均処理を実行する実行頻度を定めておくことができる。ＧＰＳの影響度合が高いほど、ＧＰＳ計測結果をＩＮＳ計測結果に作用し易くするように実行頻度を高くすればよい。
【０１２３】
また、加重平均を適用するのであれば、カップリング処理の演算設定として、例えば、加重平均の重みを定めておけばよい。具体的には、ＧＰＳの影響度合が高いモードほど、ＧＰＳ計測結果をＩＮＳ計測結果よりも重視して加重平均するように、ＧＰＳ計測結果の重みとしてより大きな値を設定すればよい。
【０１２４】
４−３．影響モードの段数
上記の実施形態では、ＧＰＳ影響モードを第１〜第４の影響モードの４段として説明したが、影響モードの段数は適宜設定可能である。つまり、影響モードをより少ない段数（例えば２段）としてもよいし、より多い段数（例えば８段）としてもよい。これは、ＧＰＳの影響度合をより粗く設定したり、より細かく設定することに相当する。
【０１２５】
４−４．処理主体
上記の実施例では、電子機器の処理部１０が、ＧＰＳユニット３から取得したＧＰＳメジャメント情報５５を用いてＧＰＳ演算処理を行うこととして説明した。また、処理部１０が、ＩＮＳユニット５から取得したＩＮＳメジャメント情報５６を用いてＩＮＳ演算処理を行うこととして説明した。つまり、ＧＰＳ演算処理、ＩＮＳ演算処理及びカップリング処理の実行主体が、全て電子機器の処理部１０であるものとして説明した。この構成を次のようにしてもよい。
【０１２６】
ＧＰＳユニット３は、ＧＰＳメジャメント情報５５を用いたＧＰＳ演算処理を行ってＧＰＳ演算結果５７を求め、処理部１０に出力する。また、ＩＮＳユニット５は、ＩＮＳメジャメント情報５６を用いたＩＮＳ演算処理を行ってＩＮＳ演算結果５８を求め、処理部１０に出力する。そして、処理部１０は、各ユニットから取得したＧＰＳ演算結果５７とＩＮＳ演算結果５８とのカップリング処理を実行する。つまり、この場合は、ＧＰＳ演算処理及びＩＮＳ演算処理の実行主体が、それぞれＧＰＳユニット３及びＩＮＳユニット５となり、カップリング処理の実行主体が、電子機器の処理部１０となる。
【０１２７】
４−５．電子機器
上記の実施例では、四輪自動車に搭載するナビゲーション装置に本発明を適用した場合を例に挙げて説明したが、本発明を適用可能な電子機器はこれに限られるわけではない。例えば、二輪自動車に搭載するナビゲーション装置に適用してもよいし、携帯型ナビゲーション装置に適用することとしてもよい。
【０１２８】
また、ナビゲーション以外の用途の電子機器についても本発明を同様に適用可能であることは勿論である。例えば、携帯型電話機やパソコン、ＰＤＡ（Personal Digital Assistant）といった他の電子機器についても本発明を同様に適用して、当該電子機器の位置算出を実現することが可能である。
【符号の説明】
【０１２９】
１、１Ａ 位置算出装置、 ３ ＧＰＳユニット、 ５ ＩＮＳユニット、 ６ 位置算出精度判定部、 ６Ａ 位置誤差レベル判定部、 ７ 影響度合設定部、 ７Ａ 影響モード設定部、 ９ カップリング処理部、 ９Ａ カルマンフィルター処理部、 １０ 処理部、 ２０ 操作部、 ３０ 表示部、 ４０ 通信部、 ５０ 記憶部、 １００ カーナビゲーション装置、 １０００ ナビゲーションシステム
【特許請求の範囲】
【請求項１】
移動体に備えられた衛星測位用ユニットの第１の計測結果と、前記移動体に備えられた慣性測位用ユニットの第２の計測結果とを用いて、前記移動体の位置を算出する位置算出方法であって、
位置算出精度を判定することと、
前記位置算出精度に基づいて、前記第１の計測結果の前記第２の計測結果に対する影響度合を設定することと、
前記影響度合に基づき、前記第１の計測結果と前記第２の計測結果とのカップリング処理を実行して前記移動体の位置を算出することと、
を含む位置算出方法。
【請求項２】
前記判定することは、前記移動体が移動を開始してからの経過時間又は位置算出回数に基づいて前記位置算出精度を判定することを含む、
請求項１に記載の位置算出方法。
【請求項３】
前記カップリング処理は、算出した位置に含まれている誤差を推定する誤差推定演算を含み、
前記判定することは、前記誤差推定演算で推定した誤差に基づいて前記位置算出精度を判定することを含む、
請求項１又は２に記載の位置算出方法。
【請求項４】
前記影響度合には、前記第１の計測結果を採用して前記カップリング処理を実行する実行頻度が含まれており、
前記影響度合を設定することは、前記位置算出精度に基づいて前記実行頻度を設定することを含み、
前記位置を算出することは、前記実行頻度に従って前記第１の計測結果を採用した前記カップリング処理を実行することを含む、
請求項１〜３の何れか一項に記載の位置算出方法。
【請求項５】
前記実行頻度を設定することは、前記位置算出精度が高いほど低い頻度を設定することである、
請求項４に記載の位置算出方法。
【請求項６】
前記カップリング処理は、前記第１の計測結果を観測量とするカルマンフィルター処理を含み、
前記影響度合を設定することは、前記位置算出精度に基づいて前記カルマンフィルター処理に用いる誤差パラメーター値を設定することを含み、
前記位置を算出することは、前記第１の計測結果及び前記誤差パラメーター値を用いて前記カルマンフィルター処理を実行することを含む、
請求項１〜３の何れか一項に記載の位置算出方法。
【請求項７】
前記誤差パラメーター値を設定することは、前記位置算出精度が高いほど大きい値を設定することである、
請求項６に記載の位置算出方法。
【請求項８】
移動体に備えられた衛星測位用ユニットの第１の計測結果と、前記移動体に備えられた慣性測位用ユニットの第２の計測結果とを用いて、前記移動体の位置を算出する位置算出装置であって、
位置算出精度を判定する位置算出精度判定部と、
前記位置算出精度に基づいて、前記第１の計測結果の前記第２の計測結果に対する影響度合を設定する影響度合設定部と、
前記影響度合に基づき、前記第１の計測結果と前記第２の計測結果とのカップリング処理を実行して前記移動体の位置を算出するカップリング処理部と、
を備えた位置算出装置。
【請求項１】
移動体に備えられた衛星測位用ユニットの第１の計測結果と、前記移動体に備えられた慣性測位用ユニットの第２の計測結果とを用いて、前記移動体の位置を算出する位置算出方法であって、
位置算出精度を判定することと、
前記位置算出精度に基づいて、前記第１の計測結果の前記第２の計測結果に対する影響度合を設定することと、
前記影響度合に基づき、前記第１の計測結果と前記第２の計測結果とのカップリング処理を実行して前記移動体の位置を算出することと、
を含む位置算出方法。
【請求項２】
前記判定することは、前記移動体が移動を開始してからの経過時間又は位置算出回数に基づいて前記位置算出精度を判定することを含む、
請求項１に記載の位置算出方法。
【請求項３】
前記カップリング処理は、算出した位置に含まれている誤差を推定する誤差推定演算を含み、
前記判定することは、前記誤差推定演算で推定した誤差に基づいて前記位置算出精度を判定することを含む、
請求項１又は２に記載の位置算出方法。
【請求項４】
前記影響度合には、前記第１の計測結果を採用して前記カップリング処理を実行する実行頻度が含まれており、
前記影響度合を設定することは、前記位置算出精度に基づいて前記実行頻度を設定することを含み、
前記位置を算出することは、前記実行頻度に従って前記第１の計測結果を採用した前記カップリング処理を実行することを含む、
請求項１〜３の何れか一項に記載の位置算出方法。
【請求項５】
前記実行頻度を設定することは、前記位置算出精度が高いほど低い頻度を設定することである、
請求項４に記載の位置算出方法。
【請求項６】
前記カップリング処理は、前記第１の計測結果を観測量とするカルマンフィルター処理を含み、
前記影響度合を設定することは、前記位置算出精度に基づいて前記カルマンフィルター処理に用いる誤差パラメーター値を設定することを含み、
前記位置を算出することは、前記第１の計測結果及び前記誤差パラメーター値を用いて前記カルマンフィルター処理を実行することを含む、
請求項１〜３の何れか一項に記載の位置算出方法。
【請求項７】
前記誤差パラメーター値を設定することは、前記位置算出精度が高いほど大きい値を設定することである、
請求項６に記載の位置算出方法。
【請求項８】
移動体に備えられた衛星測位用ユニットの第１の計測結果と、前記移動体に備えられた慣性測位用ユニットの第２の計測結果とを用いて、前記移動体の位置を算出する位置算出装置であって、
位置算出精度を判定する位置算出精度判定部と、
前記位置算出精度に基づいて、前記第１の計測結果の前記第２の計測結果に対する影響度合を設定する影響度合設定部と、
前記影響度合に基づき、前記第１の計測結果と前記第２の計測結果とのカップリング処理を実行して前記移動体の位置を算出するカップリング処理部と、
を備えた位置算出装置。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図１２】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図１２】
【公開番号】特開２０１２−２１５４９１（Ｐ２０１２−２１５４９１Ａ）
【公開日】平成２４年１１月８日（２０１２．１１．８）
【国際特許分類】
【出願番号】特願２０１１−８１６５７（Ｐ２０１１−８１６５７）
【出願日】平成２３年４月１日（２０１１．４．１）
【公序良俗違反の表示】
（特許庁注：以下のものは登録商標）
１．ＩＮＳ
【出願人】（０００００２３６９）セイコーエプソン株式会社 (51,324)
【Ｆターム（参考）】
【公開日】平成２４年１１月８日（２０１２．１１．８）
【国際特許分類】
【出願日】平成２３年４月１日（２０１１．４．１）
【公序良俗違反の表示】
（特許庁注：以下のものは登録商標）
１．ＩＮＳ
【出願人】（０００００２３６９）セイコーエプソン株式会社 (51,324)
【Ｆターム（参考）】
[ Back to top ]