ナビゲーション装置
【課題】車速算出に用いる距離係数の学習中の現在位置の算出精度の劣化を抑制する「ナビゲーション装置」を提供する。
【解決手段】車速パルス信号のパルスを距離に換算するための距離係数が真値に安定せず正しく車速センサ１０６で車速を測定できない距離係数の学習中は、車速センサ１０６の測定する車速を用いずに現在位置を算出する。また、距離係数の学習が完了して正しく車速が車速センサ１０６において測定できるようになった後は、車速センサ１０６の測定する車速を考慮に含めて現在位置をより信頼性高く算出する（ａ）。
【解決手段】車速パルス信号のパルスを距離に換算するための距離係数が真値に安定せず正しく車速センサ１０６で車速を測定できない距離係数の学習中は、車速センサ１０６の測定する車速を用いずに現在位置を算出する。また、距離係数の学習が完了して正しく車速が車速センサ１０６において測定できるようになった後は、車速センサ１０６の測定する車速を考慮に含めて現在位置をより信頼性高く算出する（ａ）。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、現在位置を算出するナビゲーション装置に関するものである。
【背景技術】
【０００２】
自動車に搭載されたナビゲーション装置における現在位置算出の技術としては、ＧＰＳ受信機による衛星測位で求めた衛星航法位置と、車速センサやジャイロセンサや加速度センサを用いて求めた推測航法位置との双方を用いて現在位置を算出する技術が知られている（たとえば、特許文献１）。
【０００３】
ここで、このような自律航法位置の算出に用いられる車速センサに関する技術としては、車輪の所定回転角度毎に出力される車速パルス数に、１車速パルスあたりの移動距離を表す距離係数を乗じて求めた移動距離より車速を検出する技術が知られている。
また、このような距離係数の設定の技術としては、ＧＰＳ受信機で算出した移動距離と、車速センサで車速パルス数に距離係数を乗じて求めた移動距離とが一致するように、距離係数を、当該距離係数が安定するまで学習して設定する技術が知られている（たとえば、特許文献２、３）。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】特開昭６３-２６５３０号公報
【特許文献２】特開２００５-１４７７８５号公報
【特許文献３】特開２００５-１８９０１０号公報
【発明の概要】
【発明が解決しようとする課題】
【０００５】
前述した距離係数を学習して設定する技術によれば、学習が完了するまでは距離係数として正しい値が設定されないために、車速センサにおいて車速を正しく算出することができない。そして、このために、車速センサを用いて推測航法位置を正しく算出できずに、結果的に、誤った現在位位置が算出されてしまうことが生じ得る。
【０００６】
そこで、本発明は、距離係数の学習中の現在位置の算出精度の劣化を抑制することを課題とする。
【課題を解決するための手段】
【０００７】
前記課題達成のために、本発明は、現在位置を算出するナビゲーション装置に、地図データを記憶した地図記憶部と、自動車の車輪が所定回転角度回転する毎にパルスが出現する車速パルス信号の単位時間あたりのパルス出現数に、設定された距離係数を乗じて車速を検出する車速センサと、前記自動車の角速度を検出するジャイロセンサと、前記自動車の加速度を検出する加速度センサと、衛星測位により前記自動車の位置を算出するＧＰＳ受信機と、前記ＧＰＳ受信機が算出した前記自動車の位置の移動量と、前記車速センサが検出した車速より求まる前記自動車の位置の移動量とが一致するように、前記距離係数を学習し、学習した距離係数を前記車速センサに設定する距離係数学習手段と、前記自動車の現在位置を算出する現在位置算出手段とを備え、前記現在位置算出手段において、前記距離係数学習手段が前記距離係数の学習を行っていない期間中は、前記ＧＰＳ受信機が算出した前記自動車の位置と、前記車速センサが検出した車速と、前記ジャイロセンサが検出した角速度と、前記地図データとに少なくとも基づいて前記現在位置を算出し、前記距離係数学習手段が前記距離係数の学習を行っている期間中は、前記ＧＰＳ受信機が算出した前記自動車の位置と、前記ジャイロセンサが検出した角速度と、前記加速度センサが検出した加速度と、前記地図データとに少なくとも基づき、かつ、前記車速センサが検出した車速に基づかずに前記現在位置を算出するようにしたものである。
【０００８】
ここで、このようなナビゲーション装置は、前記現在位置算出手段において、前記距離係数学習手段が前記距離係数の学習を行っていない期間中は、前記ＧＰＳ受信機が算出した前記自動車の位置と、前記車速センサが検出した車速と、前記ジャイロセンサが検出した角速度と、前記地図データに加えて前記加速度センサが検出した加速度を用いて、前記現在位置を算出するように構成してもよい。
【０００９】
また、このようなナビゲーション装置は、前記現在位置算出手段において、前記距離係数学習手段が前記距離係数の学習を行っていない期間中は、前記車速センサが検出した車速と前記ジャイロセンサが検出した角速度とを少なくとも用いて推測した前記自動車の位置である推測航法位置と、前記ＧＰＳ受信機が算出した前記自動車の位置である衛星航法位置との一方を所定の基準に従って仮現在位置として選択し、選択した仮現在位置を、前記地図データにマップマッチングして前記現在位置を算出し、前記距離係数学習手段が前記距離係数の学習を行っている期間中は、前記ジャイロセンサが検出した角速度と前記加速度センサが検出した加速度とを用い、前記車速センサが検出した車速を用いずに推測した前記自動車の位置である推測航法位置と、前記ＧＰＳ受信機が算出した前記自動車の位置である衛星航法位置との一方を所定の基準に従って仮現在位置として選択し、選択した仮現在位置を、前記地図データにマップマッチングして前記現在位置を算出するように構成してもよい。また、この場合には、前記現在位置算出手段において、前記距離係数学習手段が前記距離係数の学習を行っていない期間中は、前記車速センサが検出した車速と前記ジャイロセンサが検出した角速度に加えて前記加速度センサが検出した加速度を用いて前記推測航法位置を推測するようにしてもよい。
【００１０】
このようなナビゲーション装置によれば、距離係数が真値に安定せず正しく車速センサで車速を測定できない距離係数の学習中は車速センサの測定する車速を用いずに現在位置を算出する。よって、このような距離係数の学習中の車速センサで車速を正しく測定できない期間中に誤った車速によって誤った現在位置が算出されてしまうことを抑止することができる。また、距離係数の学習が完了して正しく車速が車速センサにおいて測定できるようになった後は、車速センサの測定する車速を考慮に含めて現在位置を、より信頼性高く算出することができるようになる。
【発明の効果】
【００１１】
以上のように、本発明によれば、距離係数の学習中の現在位置の算出精度の劣化を抑制することができる。
【図面の簡単な説明】
【００１２】
【図１】本発明の実施形態に係るナビゲーション装置の構成を示すブロック図である。
【図２】本発明の実施形態に係る距離係数学習処理を示すフローチャートである。
【図３】本発明の実施形態に係る現在位置算出処理を示すフローチャートである。
【図４】本発明の実施形態に係るナビゲーション装置の動作例を示す図である。
【発明を実施するための形態】
【００１３】
以下、本発明の実施形態について説明する。
図１に、本実施形態に係るナビゲーション装置の構成を示す。
図示するように、ナビゲーション装置１は、自動車に組み込まれたロータリエンコーダ２と接続されている。ここで、ロータリエンコーダ２は、車輪が所定角度回転する毎にパルスが出現する車速パルス信号を出力する。
次に、ナビゲーション装置１は、操作部１０１と、表示装置１０２と、衛星測位を行うＧＰＳ受信機１０３と、自動車の加速度を検知する加速度センサ１０４と、自動車の角速度を検出するジャイロセンサ１０５と、車速センサ１０６と、地図を表す地図データを記録したＨＤＤなどである地図データ記憶部１０７と、現在状態算出部１０８と、ルート探索部１０９と、メモリ１１０と、制御部１１１と、案内画像生成部１１２と、操作部１０１や表示装置１０２を用いたＧＵＩをユーザに提供するＧＵＩ制御部１１３とを有する。
【００１４】
但し、以上のナビゲーション装置１は、ハードウエア的には、マイクロプロセッサや、メモリや、その他のグラフィックプロセッサやジオメトリックプロセッサ等の周辺デバイスを有する一般的な構成を備えたＣＰＵ回路であって良く、この場合、以上に示したナビゲーション装置１の各部は、マイクロプロセッサが予め用意されたプログラムを実行することにより具現化するプロセスとして実現されるものであって良い。また、この場合、このようなプログラムは、記録媒体や適当な通信路を介して、ナビゲーション装置１に提供されるものであって良い。
【００１５】
以下、このような構成におけるナビゲーション装置１の動作について説明する。
まず、ナビゲーション装置１の現在状態算出部１０８は、以下の処理を繰り返し行う。
すなわち、制御部１１１は、後述する距離係数学習処理を実行し、車速センサ１０６に距離係数を設定する。
車速センサ１０６は、ロータリエンコーダ２の出力する車速パルス信号のパルスの単位時間の出現数に、制御部１１１から設定された距離係数を乗じて自動車の車速を出力する。
現在状態算出部１０８は、後述する現在位置算出処理を実行し、現在位置として最も確からしい座標と、現在の進行方向として最も確からしい方向とを、それぞれ現在位置、現在進行方位として決定し、メモリ１１０に設定する。
また、制御部１１１は、ユーザの目的地設定要求に応じて、ユーザから操作部１０１、ＧＵＩ制御部１１３を介して目的地の設定を受け付け、これをメモリ１１０にセットする。そして、制御部１１１は、目的地の設定を受け付けた後に、推奨ルート探索をユーザから指示されたならば、メモリ１１０にセットされた目的地までの推奨ルートをルート探索部１０９に探索させる。ルート探索部１０９は、必要地理的範囲の地図の地図データを地図データ記憶部１０７から読み出し、メモリ１１０に設定されている現在位置から目的地までの最小コストの経路を、距離最小などの所定のコストモデルに基づいて推奨ルートとして算出し、算出した推奨ルートの経路データを、メモリ１１０にセットする。
【００１６】
そして、案内画像生成部１１２は、地図データ記憶部１０７から読み出した地図データが表す現在位置周辺の地図を表す地図画像を、予め成されたユーザ設定や初期設定に応じた地図縮尺で、メモリ１１０にセットされた現在進行方位が上になるように表示する。また、この際に、案内画像生成部１１２は、この表示した地図画像上の、メモリ１１０にセットされた現在位置に対応する位置に現在位置マークを表示する。また、案内画像生成部１１２は、推奨ルートの経路データがメモリ１１０にセットされている場合には、推奨ルートを表す推奨ルート図形を二次元地図画像上に表示する。また、目的地が地図画像が表す地理的範囲に含まれる場合、案内画像生成部１１２は、目的地の位置を示す目的地マークも地図画像上に表示する。
【００１７】
以下、上述した、制御部１１１が、車速センサ１０６に距離係数を設定するために行う距離係数学習処理について説明する。
ここで、この距離係数学習処理は、ナビゲーション装置１の自動車へ組み込み時に起動される他、ユーザより操作部１０１を介した距離係数再学習指示に応答して起動される処理である。また、この距離係数学習処理は、後述する衛星測位位置と、推測航法位置との所定レベル以上の差が所定期間以上継続した場合に、自動的に起動するようにしてもよい。
【００１８】
さて、図２に、この距離係数学習処理の手順を示す。
図示するように、この距離係数学習処理において、制御部１１１は、車速センサ１０６からロータリエンコーダ２が出力する車速パルス信号に、過去単位時間中に表れたパルス数を取得する（ステップ２０２）。なお、単位時間に表れるパルス数は、車速センサ１０６が出力する車速を、その時点で車速センサ１０６に設定されている距離係数で除算して求めることもできる。
【００１９】
次に、制御部１１１は、ＧＰＳ受信機１０３が衛星測位で求めた自車位置である衛星測位位置の履歴から、過去単位時間中の自動車の移動距離を算出する（ステップ２０４）。
そして、ステップ２０４で算出した移動距離を、ステップ２０２で取得したパルス数で除算した値を、係数として求める（ステップ２０６）。
次に、距離係数学習処理開始以降に、ステップ２０６で求めた係数の平均値を距離係数として算出し、算出した距離係数を車速センサ１０６に設定する（ステップ２０８）。
そして、距離係数学習処理開始以降、所定距離以上自動車が走行したかどうかを衛星測位位置の履歴等に基づいて調べ（ステップ２１０）、走行していなければステップ２０２からの処理に戻る。ここで、所定距離としては、ステップ２０８において算出する距離係数が安定するまでに、最小限必要と考えられる走行距離を予め設定する。
【００２０】
一方、所定距離以上自動車が走行している場合には、過去所定回数のステップ２０８において算出された距離係数の変動が所定レベル以下に安定したかどうかを調べ（ステップ２１２）、安定していなければステップ２０２からの処理に戻り、安定していれば距離係数学習処理を終了する。
【００２１】
以上、制御部１１１が行う距離係数学習処理について説明した。
次に、上述した、現在状態算出部１０８が行う現在位置算出処理について説明する。
図３に、この現在位置算出処理の手順を示す。
図示するように、現在位置算出処理において、現在状態算出部１０８は、距離係数を学習中であるかどうか、すなわち、制御部１１１において距離係数学習処理が実行中であるかどうかを判定し（ステップ３０２）、距離係数を学習中であれば、車速センサ１０６で算出した車速を用いずに、ＧＰＳ受信機１０３が衛星測位で算出した衛星測位位置と、ジャイロセンサ１０５で計測した角速度と、加速度センサ１０４で検出した加速度とを用いて現在位置を算出し（ステップ３０４）、距離係数を学習中でなければ、ＧＰＳ受信機１０３が衛星測位で算出した衛星測位位置と、ジャイロセンサ１０５で計測した角速度と、加速度センサ１０４で検出した加速度と、車速センサ１０６で算出した車速を用いて現在位置を算出する（ステップ３０６）処理を繰り返す。
【００２２】
ここで、ステップ３０４で行うＧＰＳ受信機１０３が衛星測位で算出した衛星測位位置と、ジャイロセンサ１０５で計測した角速度と、加速度センサ１０４で検出した加速度とを用いた現在位置の算出は、たとえば、次のように行う。
すなわち、加速度センサ１０４で検出した加速度より求まる車速と、ジャイロセンサ１０５で計測した角速度とより自車位置を推測航法位置として推定する。
そして、ＧＰＳ受信機１０３が衛星測位で衛星測位位置を正常に算出できていない場合には、測航法位置を仮現在位置として、当該仮現在位置と前回決定した現在位置の周辺の地図とのマップマッチングを行って現在位置として算出する。
一方、ＧＰＳ受信機１０３が衛星測位で衛星測位位置を正常に算出できている場合には、衛星測位位置を仮現在位置として、当該仮現在位置と前回決定した現在位置の周辺の地図とのマップマッチングを行って現在位置として算出する。
また、ステップ３０６で行うＧＰＳ受信機１０３が衛星測位で算出した衛星測位位置と、ジャイロセンサ１０５で計測した角速度と、加速度センサ１０４で検出した加速度と、車速センサ１０６で算出した車速を用いた現在位置の算出は、たとえば、次のように行う。
【００２３】
すなわち、加速度センサ１０４で検出した重力の影響を含む加速度と、車速センサ１０６で算出した車速を微分して得られる重力の影響を含まない加速度の差より走行路の傾斜を算出する。そして、ジャイロセンサ１０５で計測した角速度と車速センサ１０６で算出した車速と算出した傾斜より自車位置を推測航法位置として推定する。ただし、ここでは、加速度センサ１０４は用いずに、ジャイロセンサ１０５で計測した角速度と車速センサ１０６で算出した車速とより、自車位置を推測航法位置として推定するようにしてもよい。
【００２４】
そして、ＧＰＳ受信機１０３が衛星測位で衛星測位位置を正常に算出できていない場合には、測航法位置を仮現在位置として、当該仮現在位置と前回決定した現在位置の周辺の地図とのマップマッチングを行って現在位置として算出する。
一方、ＧＰＳ受信機１０３が衛星測位で衛星測位位置を正常に算出できている場合には、過去に算出した現在位置との継続性等から、衛星測位位置と推測航法位置との、真の自車位置としての確からしさを評価し、衛星測位位置と推測航法位置とのうちの真の自車位置として、より確からしい方の位置を仮現在位置とする。そして仮現在位置と仮現在位置として、当該仮現在位置と前回決定した現在位置の周辺の地図とのマップマッチングを行って現在位置を算出する。
【００２５】
ただし、ステップ３０４、３０６で行う現在位置の算出アルゴリズムとしては種々のアルゴリズムを採用することができ、ステップ３０４において行う現在位置の算出アルゴリズムは、車速センサ１０６の算出した車速を用いずに現在位置を算出するものであればよく、ステップ３０６において行う現在位置の算出アルゴリズムは、車速センサ１０６の算出した車速を考慮して現在位置を算出するものであればよい。
【００２６】
以上、現在状態算出部１０８が行う現在位置算出処理について説明した。
以上のような現在位置算出処理によれば、図４ａに示すように、距離係数が真値に安定せず正しく車速センサ１０６で車速を測定できない距離係数の学習中は車速センサ１０６の測定する車速を用いずに現在位置を算出する。よって、図４ｂに示すように距離係数の学習中の有無に関わらずに、車速センサ１０６の測定する車速を考慮に含めて現在位置を算出する場合とは異なり、このような距離係数の学習中の車速センサ１０６で車速を正しく測定できない期間中に誤った車速によって誤った現在位置が算出されてしまうことを抑止することができる。また、距離係数の学習が完了して正しく車速が車速センサ１０６において測定できるようになった後は、車速センサ１０６の測定する車速を考慮に含めて現在位置をより信頼性高く算出することができるようになる。
【００２７】
以上、本発明の実施形態について説明した。
【符号の説明】
【００２８】
１…ナビゲーション装置、２…ロータリエンコーダ、１０１…操作部、１０２…表示装置、１０３…ＧＰＳ受信機、１０４…加速度センサ、１０５…ジャイロセンサ、１０６…車速センサ、１０７…地図データ記憶部、１０８…現在状態算出部、１０９…ルート探索部、１１０…メモリ、１１１…制御部、１１２…案内画像生成部、１１３…ＧＵＩ制御部。
【技術分野】
【０００１】
本発明は、現在位置を算出するナビゲーション装置に関するものである。
【背景技術】
【０００２】
自動車に搭載されたナビゲーション装置における現在位置算出の技術としては、ＧＰＳ受信機による衛星測位で求めた衛星航法位置と、車速センサやジャイロセンサや加速度センサを用いて求めた推測航法位置との双方を用いて現在位置を算出する技術が知られている（たとえば、特許文献１）。
【０００３】
ここで、このような自律航法位置の算出に用いられる車速センサに関する技術としては、車輪の所定回転角度毎に出力される車速パルス数に、１車速パルスあたりの移動距離を表す距離係数を乗じて求めた移動距離より車速を検出する技術が知られている。
また、このような距離係数の設定の技術としては、ＧＰＳ受信機で算出した移動距離と、車速センサで車速パルス数に距離係数を乗じて求めた移動距離とが一致するように、距離係数を、当該距離係数が安定するまで学習して設定する技術が知られている（たとえば、特許文献２、３）。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】特開昭６３-２６５３０号公報
【特許文献２】特開２００５-１４７７８５号公報
【特許文献３】特開２００５-１８９０１０号公報
【発明の概要】
【発明が解決しようとする課題】
【０００５】
前述した距離係数を学習して設定する技術によれば、学習が完了するまでは距離係数として正しい値が設定されないために、車速センサにおいて車速を正しく算出することができない。そして、このために、車速センサを用いて推測航法位置を正しく算出できずに、結果的に、誤った現在位位置が算出されてしまうことが生じ得る。
【０００６】
そこで、本発明は、距離係数の学習中の現在位置の算出精度の劣化を抑制することを課題とする。
【課題を解決するための手段】
【０００７】
前記課題達成のために、本発明は、現在位置を算出するナビゲーション装置に、地図データを記憶した地図記憶部と、自動車の車輪が所定回転角度回転する毎にパルスが出現する車速パルス信号の単位時間あたりのパルス出現数に、設定された距離係数を乗じて車速を検出する車速センサと、前記自動車の角速度を検出するジャイロセンサと、前記自動車の加速度を検出する加速度センサと、衛星測位により前記自動車の位置を算出するＧＰＳ受信機と、前記ＧＰＳ受信機が算出した前記自動車の位置の移動量と、前記車速センサが検出した車速より求まる前記自動車の位置の移動量とが一致するように、前記距離係数を学習し、学習した距離係数を前記車速センサに設定する距離係数学習手段と、前記自動車の現在位置を算出する現在位置算出手段とを備え、前記現在位置算出手段において、前記距離係数学習手段が前記距離係数の学習を行っていない期間中は、前記ＧＰＳ受信機が算出した前記自動車の位置と、前記車速センサが検出した車速と、前記ジャイロセンサが検出した角速度と、前記地図データとに少なくとも基づいて前記現在位置を算出し、前記距離係数学習手段が前記距離係数の学習を行っている期間中は、前記ＧＰＳ受信機が算出した前記自動車の位置と、前記ジャイロセンサが検出した角速度と、前記加速度センサが検出した加速度と、前記地図データとに少なくとも基づき、かつ、前記車速センサが検出した車速に基づかずに前記現在位置を算出するようにしたものである。
【０００８】
ここで、このようなナビゲーション装置は、前記現在位置算出手段において、前記距離係数学習手段が前記距離係数の学習を行っていない期間中は、前記ＧＰＳ受信機が算出した前記自動車の位置と、前記車速センサが検出した車速と、前記ジャイロセンサが検出した角速度と、前記地図データに加えて前記加速度センサが検出した加速度を用いて、前記現在位置を算出するように構成してもよい。
【０００９】
また、このようなナビゲーション装置は、前記現在位置算出手段において、前記距離係数学習手段が前記距離係数の学習を行っていない期間中は、前記車速センサが検出した車速と前記ジャイロセンサが検出した角速度とを少なくとも用いて推測した前記自動車の位置である推測航法位置と、前記ＧＰＳ受信機が算出した前記自動車の位置である衛星航法位置との一方を所定の基準に従って仮現在位置として選択し、選択した仮現在位置を、前記地図データにマップマッチングして前記現在位置を算出し、前記距離係数学習手段が前記距離係数の学習を行っている期間中は、前記ジャイロセンサが検出した角速度と前記加速度センサが検出した加速度とを用い、前記車速センサが検出した車速を用いずに推測した前記自動車の位置である推測航法位置と、前記ＧＰＳ受信機が算出した前記自動車の位置である衛星航法位置との一方を所定の基準に従って仮現在位置として選択し、選択した仮現在位置を、前記地図データにマップマッチングして前記現在位置を算出するように構成してもよい。また、この場合には、前記現在位置算出手段において、前記距離係数学習手段が前記距離係数の学習を行っていない期間中は、前記車速センサが検出した車速と前記ジャイロセンサが検出した角速度に加えて前記加速度センサが検出した加速度を用いて前記推測航法位置を推測するようにしてもよい。
【００１０】
このようなナビゲーション装置によれば、距離係数が真値に安定せず正しく車速センサで車速を測定できない距離係数の学習中は車速センサの測定する車速を用いずに現在位置を算出する。よって、このような距離係数の学習中の車速センサで車速を正しく測定できない期間中に誤った車速によって誤った現在位置が算出されてしまうことを抑止することができる。また、距離係数の学習が完了して正しく車速が車速センサにおいて測定できるようになった後は、車速センサの測定する車速を考慮に含めて現在位置を、より信頼性高く算出することができるようになる。
【発明の効果】
【００１１】
以上のように、本発明によれば、距離係数の学習中の現在位置の算出精度の劣化を抑制することができる。
【図面の簡単な説明】
【００１２】
【図１】本発明の実施形態に係るナビゲーション装置の構成を示すブロック図である。
【図２】本発明の実施形態に係る距離係数学習処理を示すフローチャートである。
【図３】本発明の実施形態に係る現在位置算出処理を示すフローチャートである。
【図４】本発明の実施形態に係るナビゲーション装置の動作例を示す図である。
【発明を実施するための形態】
【００１３】
以下、本発明の実施形態について説明する。
図１に、本実施形態に係るナビゲーション装置の構成を示す。
図示するように、ナビゲーション装置１は、自動車に組み込まれたロータリエンコーダ２と接続されている。ここで、ロータリエンコーダ２は、車輪が所定角度回転する毎にパルスが出現する車速パルス信号を出力する。
次に、ナビゲーション装置１は、操作部１０１と、表示装置１０２と、衛星測位を行うＧＰＳ受信機１０３と、自動車の加速度を検知する加速度センサ１０４と、自動車の角速度を検出するジャイロセンサ１０５と、車速センサ１０６と、地図を表す地図データを記録したＨＤＤなどである地図データ記憶部１０７と、現在状態算出部１０８と、ルート探索部１０９と、メモリ１１０と、制御部１１１と、案内画像生成部１１２と、操作部１０１や表示装置１０２を用いたＧＵＩをユーザに提供するＧＵＩ制御部１１３とを有する。
【００１４】
但し、以上のナビゲーション装置１は、ハードウエア的には、マイクロプロセッサや、メモリや、その他のグラフィックプロセッサやジオメトリックプロセッサ等の周辺デバイスを有する一般的な構成を備えたＣＰＵ回路であって良く、この場合、以上に示したナビゲーション装置１の各部は、マイクロプロセッサが予め用意されたプログラムを実行することにより具現化するプロセスとして実現されるものであって良い。また、この場合、このようなプログラムは、記録媒体や適当な通信路を介して、ナビゲーション装置１に提供されるものであって良い。
【００１５】
以下、このような構成におけるナビゲーション装置１の動作について説明する。
まず、ナビゲーション装置１の現在状態算出部１０８は、以下の処理を繰り返し行う。
すなわち、制御部１１１は、後述する距離係数学習処理を実行し、車速センサ１０６に距離係数を設定する。
車速センサ１０６は、ロータリエンコーダ２の出力する車速パルス信号のパルスの単位時間の出現数に、制御部１１１から設定された距離係数を乗じて自動車の車速を出力する。
現在状態算出部１０８は、後述する現在位置算出処理を実行し、現在位置として最も確からしい座標と、現在の進行方向として最も確からしい方向とを、それぞれ現在位置、現在進行方位として決定し、メモリ１１０に設定する。
また、制御部１１１は、ユーザの目的地設定要求に応じて、ユーザから操作部１０１、ＧＵＩ制御部１１３を介して目的地の設定を受け付け、これをメモリ１１０にセットする。そして、制御部１１１は、目的地の設定を受け付けた後に、推奨ルート探索をユーザから指示されたならば、メモリ１１０にセットされた目的地までの推奨ルートをルート探索部１０９に探索させる。ルート探索部１０９は、必要地理的範囲の地図の地図データを地図データ記憶部１０７から読み出し、メモリ１１０に設定されている現在位置から目的地までの最小コストの経路を、距離最小などの所定のコストモデルに基づいて推奨ルートとして算出し、算出した推奨ルートの経路データを、メモリ１１０にセットする。
【００１６】
そして、案内画像生成部１１２は、地図データ記憶部１０７から読み出した地図データが表す現在位置周辺の地図を表す地図画像を、予め成されたユーザ設定や初期設定に応じた地図縮尺で、メモリ１１０にセットされた現在進行方位が上になるように表示する。また、この際に、案内画像生成部１１２は、この表示した地図画像上の、メモリ１１０にセットされた現在位置に対応する位置に現在位置マークを表示する。また、案内画像生成部１１２は、推奨ルートの経路データがメモリ１１０にセットされている場合には、推奨ルートを表す推奨ルート図形を二次元地図画像上に表示する。また、目的地が地図画像が表す地理的範囲に含まれる場合、案内画像生成部１１２は、目的地の位置を示す目的地マークも地図画像上に表示する。
【００１７】
以下、上述した、制御部１１１が、車速センサ１０６に距離係数を設定するために行う距離係数学習処理について説明する。
ここで、この距離係数学習処理は、ナビゲーション装置１の自動車へ組み込み時に起動される他、ユーザより操作部１０１を介した距離係数再学習指示に応答して起動される処理である。また、この距離係数学習処理は、後述する衛星測位位置と、推測航法位置との所定レベル以上の差が所定期間以上継続した場合に、自動的に起動するようにしてもよい。
【００１８】
さて、図２に、この距離係数学習処理の手順を示す。
図示するように、この距離係数学習処理において、制御部１１１は、車速センサ１０６からロータリエンコーダ２が出力する車速パルス信号に、過去単位時間中に表れたパルス数を取得する（ステップ２０２）。なお、単位時間に表れるパルス数は、車速センサ１０６が出力する車速を、その時点で車速センサ１０６に設定されている距離係数で除算して求めることもできる。
【００１９】
次に、制御部１１１は、ＧＰＳ受信機１０３が衛星測位で求めた自車位置である衛星測位位置の履歴から、過去単位時間中の自動車の移動距離を算出する（ステップ２０４）。
そして、ステップ２０４で算出した移動距離を、ステップ２０２で取得したパルス数で除算した値を、係数として求める（ステップ２０６）。
次に、距離係数学習処理開始以降に、ステップ２０６で求めた係数の平均値を距離係数として算出し、算出した距離係数を車速センサ１０６に設定する（ステップ２０８）。
そして、距離係数学習処理開始以降、所定距離以上自動車が走行したかどうかを衛星測位位置の履歴等に基づいて調べ（ステップ２１０）、走行していなければステップ２０２からの処理に戻る。ここで、所定距離としては、ステップ２０８において算出する距離係数が安定するまでに、最小限必要と考えられる走行距離を予め設定する。
【００２０】
一方、所定距離以上自動車が走行している場合には、過去所定回数のステップ２０８において算出された距離係数の変動が所定レベル以下に安定したかどうかを調べ（ステップ２１２）、安定していなければステップ２０２からの処理に戻り、安定していれば距離係数学習処理を終了する。
【００２１】
以上、制御部１１１が行う距離係数学習処理について説明した。
次に、上述した、現在状態算出部１０８が行う現在位置算出処理について説明する。
図３に、この現在位置算出処理の手順を示す。
図示するように、現在位置算出処理において、現在状態算出部１０８は、距離係数を学習中であるかどうか、すなわち、制御部１１１において距離係数学習処理が実行中であるかどうかを判定し（ステップ３０２）、距離係数を学習中であれば、車速センサ１０６で算出した車速を用いずに、ＧＰＳ受信機１０３が衛星測位で算出した衛星測位位置と、ジャイロセンサ１０５で計測した角速度と、加速度センサ１０４で検出した加速度とを用いて現在位置を算出し（ステップ３０４）、距離係数を学習中でなければ、ＧＰＳ受信機１０３が衛星測位で算出した衛星測位位置と、ジャイロセンサ１０５で計測した角速度と、加速度センサ１０４で検出した加速度と、車速センサ１０６で算出した車速を用いて現在位置を算出する（ステップ３０６）処理を繰り返す。
【００２２】
ここで、ステップ３０４で行うＧＰＳ受信機１０３が衛星測位で算出した衛星測位位置と、ジャイロセンサ１０５で計測した角速度と、加速度センサ１０４で検出した加速度とを用いた現在位置の算出は、たとえば、次のように行う。
すなわち、加速度センサ１０４で検出した加速度より求まる車速と、ジャイロセンサ１０５で計測した角速度とより自車位置を推測航法位置として推定する。
そして、ＧＰＳ受信機１０３が衛星測位で衛星測位位置を正常に算出できていない場合には、測航法位置を仮現在位置として、当該仮現在位置と前回決定した現在位置の周辺の地図とのマップマッチングを行って現在位置として算出する。
一方、ＧＰＳ受信機１０３が衛星測位で衛星測位位置を正常に算出できている場合には、衛星測位位置を仮現在位置として、当該仮現在位置と前回決定した現在位置の周辺の地図とのマップマッチングを行って現在位置として算出する。
また、ステップ３０６で行うＧＰＳ受信機１０３が衛星測位で算出した衛星測位位置と、ジャイロセンサ１０５で計測した角速度と、加速度センサ１０４で検出した加速度と、車速センサ１０６で算出した車速を用いた現在位置の算出は、たとえば、次のように行う。
【００２３】
すなわち、加速度センサ１０４で検出した重力の影響を含む加速度と、車速センサ１０６で算出した車速を微分して得られる重力の影響を含まない加速度の差より走行路の傾斜を算出する。そして、ジャイロセンサ１０５で計測した角速度と車速センサ１０６で算出した車速と算出した傾斜より自車位置を推測航法位置として推定する。ただし、ここでは、加速度センサ１０４は用いずに、ジャイロセンサ１０５で計測した角速度と車速センサ１０６で算出した車速とより、自車位置を推測航法位置として推定するようにしてもよい。
【００２４】
そして、ＧＰＳ受信機１０３が衛星測位で衛星測位位置を正常に算出できていない場合には、測航法位置を仮現在位置として、当該仮現在位置と前回決定した現在位置の周辺の地図とのマップマッチングを行って現在位置として算出する。
一方、ＧＰＳ受信機１０３が衛星測位で衛星測位位置を正常に算出できている場合には、過去に算出した現在位置との継続性等から、衛星測位位置と推測航法位置との、真の自車位置としての確からしさを評価し、衛星測位位置と推測航法位置とのうちの真の自車位置として、より確からしい方の位置を仮現在位置とする。そして仮現在位置と仮現在位置として、当該仮現在位置と前回決定した現在位置の周辺の地図とのマップマッチングを行って現在位置を算出する。
【００２５】
ただし、ステップ３０４、３０６で行う現在位置の算出アルゴリズムとしては種々のアルゴリズムを採用することができ、ステップ３０４において行う現在位置の算出アルゴリズムは、車速センサ１０６の算出した車速を用いずに現在位置を算出するものであればよく、ステップ３０６において行う現在位置の算出アルゴリズムは、車速センサ１０６の算出した車速を考慮して現在位置を算出するものであればよい。
【００２６】
以上、現在状態算出部１０８が行う現在位置算出処理について説明した。
以上のような現在位置算出処理によれば、図４ａに示すように、距離係数が真値に安定せず正しく車速センサ１０６で車速を測定できない距離係数の学習中は車速センサ１０６の測定する車速を用いずに現在位置を算出する。よって、図４ｂに示すように距離係数の学習中の有無に関わらずに、車速センサ１０６の測定する車速を考慮に含めて現在位置を算出する場合とは異なり、このような距離係数の学習中の車速センサ１０６で車速を正しく測定できない期間中に誤った車速によって誤った現在位置が算出されてしまうことを抑止することができる。また、距離係数の学習が完了して正しく車速が車速センサ１０６において測定できるようになった後は、車速センサ１０６の測定する車速を考慮に含めて現在位置をより信頼性高く算出することができるようになる。
【００２７】
以上、本発明の実施形態について説明した。
【符号の説明】
【００２８】
１…ナビゲーション装置、２…ロータリエンコーダ、１０１…操作部、１０２…表示装置、１０３…ＧＰＳ受信機、１０４…加速度センサ、１０５…ジャイロセンサ、１０６…車速センサ、１０７…地図データ記憶部、１０８…現在状態算出部、１０９…ルート探索部、１１０…メモリ、１１１…制御部、１１２…案内画像生成部、１１３…ＧＵＩ制御部。
【特許請求の範囲】
【請求項１】
現在位置を算出するナビゲーション装置であって、
地図データを記憶した地図記憶部と、
自動車の車輪が所定回転角度回転する毎にパルスが出現する車速パルス信号の単位時間あたりのパルス出現数に、設定された距離係数を乗じて車速を検出する車速センサと、
前記自動車の角速度を検出するジャイロセンサと、
前記自動車の加速度を検出する加速度センサと、
衛星測位により前記自動車の位置を算出するＧＰＳ受信機と、
前記ＧＰＳ受信機が算出した前記自動車の位置の移動量と、前記車速センサが検出した車速より求まる前記自動車の位置の移動量とが一致するように、前記距離係数を学習し、学習した距離係数を前記車速センサに設定する距離係数学習手段と、
前記自動車の現在位置を算出する現在位置算出手段とを有し、
前記現在位置算出手段は、
前記距離係数学習手段が前記距離係数の学習を行っていない期間中は、
前記ＧＰＳ受信機が算出した前記自動車の位置と、前記車速センサが検出した車速と、前記ジャイロセンサが検出した角速度と、前記地図データとに少なくとも基づいて前記現在位置を算出し、
前記距離係数学習手段が前記距離係数の学習を行っている期間中は、
前記ＧＰＳ受信機が算出した前記自動車の位置と、前記ジャイロセンサが検出した角速度と、前記加速度センサが検出した加速度と、前記地図データとに少なくとも基づき、かつ、前記車速センサが検出した車速に基づかずに前記現在位置を算出することを特徴とするナビゲーション装置。
【請求項２】
請求項１記載のナビゲーション装置であって、
前記現在位置算出手段は、
前記距離係数学習手段が前記距離係数の学習を行っていない期間中は、前記ＧＰＳ受信機が算出した前記自動車の位置と、前記車速センサが検出した車速と、前記ジャイロセンサが検出した角速度と、前記地図データに加えて前記加速度センサが検出した加速度を用いて、前記現在位置を算出することを特徴とするナビゲーション装置。
【請求項３】
請求項１記載のナビゲーション装置であって、
前記現在位置算出手段は、
前記距離係数学習手段が前記距離係数の学習を行っていない期間中は、
前記車速センサが検出した車速と前記ジャイロセンサが検出した角速度とを少なくとも用いて推測した前記自動車の位置である推測航法位置と、前記ＧＰＳ受信機が算出した前記自動車の位置である衛星航法位置との一方を所定の基準に従って仮現在位置として選択し、選択した仮現在位置を、前記地図データにマップマッチングして前記現在位置を算出し、
前記距離係数学習手段が前記距離係数の学習を行っている期間中は、
前記ジャイロセンサが検出した角速度と前記加速度センサが検出した加速度とを用い、前記車速センサが検出した車速を用いずに推測した前記自動車の位置である推測航法位置と、前記ＧＰＳ受信機が算出した前記自動車の位置である衛星航法位置との一方を所定の基準に従って仮現在位置として選択し、選択した仮現在位置を、前記地図データにマップマッチングして前記現在位置を算出することを特徴とするナビゲーション装置。
【請求項４】
請求項３記載のナビゲーション装置であって、
前記現在位置算出手段は、
前記距離係数学習手段が前記距離係数の学習を行っていない期間中は、前記車速センサが検出した車速と前記ジャイロセンサが検出した角速度に加えて前記加速度センサが検出した加速度を用いて前記推測航法位置を推測することを特徴とするナビゲーション装置。
【請求項１】
現在位置を算出するナビゲーション装置であって、
地図データを記憶した地図記憶部と、
自動車の車輪が所定回転角度回転する毎にパルスが出現する車速パルス信号の単位時間あたりのパルス出現数に、設定された距離係数を乗じて車速を検出する車速センサと、
前記自動車の角速度を検出するジャイロセンサと、
前記自動車の加速度を検出する加速度センサと、
衛星測位により前記自動車の位置を算出するＧＰＳ受信機と、
前記ＧＰＳ受信機が算出した前記自動車の位置の移動量と、前記車速センサが検出した車速より求まる前記自動車の位置の移動量とが一致するように、前記距離係数を学習し、学習した距離係数を前記車速センサに設定する距離係数学習手段と、
前記自動車の現在位置を算出する現在位置算出手段とを有し、
前記現在位置算出手段は、
前記距離係数学習手段が前記距離係数の学習を行っていない期間中は、
前記ＧＰＳ受信機が算出した前記自動車の位置と、前記車速センサが検出した車速と、前記ジャイロセンサが検出した角速度と、前記地図データとに少なくとも基づいて前記現在位置を算出し、
前記距離係数学習手段が前記距離係数の学習を行っている期間中は、
前記ＧＰＳ受信機が算出した前記自動車の位置と、前記ジャイロセンサが検出した角速度と、前記加速度センサが検出した加速度と、前記地図データとに少なくとも基づき、かつ、前記車速センサが検出した車速に基づかずに前記現在位置を算出することを特徴とするナビゲーション装置。
【請求項２】
請求項１記載のナビゲーション装置であって、
前記現在位置算出手段は、
前記距離係数学習手段が前記距離係数の学習を行っていない期間中は、前記ＧＰＳ受信機が算出した前記自動車の位置と、前記車速センサが検出した車速と、前記ジャイロセンサが検出した角速度と、前記地図データに加えて前記加速度センサが検出した加速度を用いて、前記現在位置を算出することを特徴とするナビゲーション装置。
【請求項３】
請求項１記載のナビゲーション装置であって、
前記現在位置算出手段は、
前記距離係数学習手段が前記距離係数の学習を行っていない期間中は、
前記車速センサが検出した車速と前記ジャイロセンサが検出した角速度とを少なくとも用いて推測した前記自動車の位置である推測航法位置と、前記ＧＰＳ受信機が算出した前記自動車の位置である衛星航法位置との一方を所定の基準に従って仮現在位置として選択し、選択した仮現在位置を、前記地図データにマップマッチングして前記現在位置を算出し、
前記距離係数学習手段が前記距離係数の学習を行っている期間中は、
前記ジャイロセンサが検出した角速度と前記加速度センサが検出した加速度とを用い、前記車速センサが検出した車速を用いずに推測した前記自動車の位置である推測航法位置と、前記ＧＰＳ受信機が算出した前記自動車の位置である衛星航法位置との一方を所定の基準に従って仮現在位置として選択し、選択した仮現在位置を、前記地図データにマップマッチングして前記現在位置を算出することを特徴とするナビゲーション装置。
【請求項４】
請求項３記載のナビゲーション装置であって、
前記現在位置算出手段は、
前記距離係数学習手段が前記距離係数の学習を行っていない期間中は、前記車速センサが検出した車速と前記ジャイロセンサが検出した角速度に加えて前記加速度センサが検出した加速度を用いて前記推測航法位置を推測することを特徴とするナビゲーション装置。
【図１】
【図２】
【図３】
【図４】
【図２】
【図３】
【図４】
【公開番号】特開２０１２−１１２８２５（Ｐ２０１２−１１２８２５Ａ）
【公開日】平成２４年６月１４日（２０１２．６．１４）
【国際特許分類】
【出願番号】特願２０１０−２６２５９３（Ｐ２０１０−２６２５９３）
【出願日】平成２２年１１月２５日（２０１０．１１．２５）
【出願人】（０００１０１７３２）アルパイン株式会社 (2,424)
【Ｆターム（参考）】
【公開日】平成２４年６月１４日（２０１２．６．１４）
【国際特許分類】
【出願日】平成２２年１１月２５日（２０１０．１１．２５）
【出願人】（０００１０１７３２）アルパイン株式会社 (2,424)
【Ｆターム（参考）】
[ Back to top ]