JPH08114455A - ジャイロのドリフト補正方法及び補正回路 - Google Patents

Abstract

(57)【要約】 （修正有） 【目的】停車しなくてもドリフトを補正し得るジャイロ
のドリフト補正方法及びドリフト補正回路と地図データ
のある場所からない場所へ車が移動した場合もドリフト
の補正を続けるジャイロのドリフト補正回路の提供。 【構成】ジャイロセンサ３の出力をＡ／Ｄ変換手段６で
一定時間毎にＡ／Ｄ変換しデータＡを得てＦＩＲフィル
タ２１に入力してその出力Ｂを得る。次に、マップマッ
チング手段７から車の方位データを一定時間毎にインタ
ーフェイス回路２４を通して微分回路２５に入力しその
出力Ｃを得てＦＩＲフィルタ２６に入力しその出力をＤ
とする。フィルタ出力Ｂ，Ｄを減算器２２に入力してド
リフト補正値Ｅ＝ＢーＤを得る。そして、Ａ／Ｄ変換手
段６からのデータＡと補正値Ｅを減算器２２に入力して
出力Ｆ＝ＡーＥを得る。この出力Ｆをジャイロ補正値と
してデットレコニング手段８に与える。

Description

【発明の詳細な説明】

【０００１】

【発明の属する技術分野】本発明は移動体のナビゲーシ
ョン・システム等に用いるジャイロに関し、特に、その
ドリフト補正方法及びドリフト補正回路に関する。

【０００２】

【従来の技術】移動体、例えば、車のナビゲーション装
置は、角度センサにより方位の変化を測定し、その結果
を用いて表示装置に表示された地図上に自車位置を表示
し、運転者に現在位置を認識させることを目的としてい
る。

【０００３】図８は上述の車載用ナビゲーション装置１
００の主要部分の構成例を示すブロック図であり、ジャ
イロセンサ（圧電振動ジャイロ（角度センサ））３の出
力電圧をＡ／Ｄ変換手段６でＡ／Ｄ変換しこの出力デー
タ（デジタル信号）をデットレコニング手段８に入力す
る。そして、距離センサとしてのスピードセンサー２か
らのデータをインターフェイス５を介してデットレコニ
ング手段８に取込みデットレコニング手段８でデットレ
コニング処理を行ない、その結果（座標データ）をマッ
プマッチング手段７に与える。マップマッチング手段７
はＧＰＳ１からの座標データに基づいて地図データを格
納している地図データ検索手段９から取り出し、デット
レコニング手段８により得られた座標データを比較し、
描画手段１０により地図及び車両位置のイメージデータ
を合成し、表示手段１１上に表示する（車載用ナビゲー
ション装置１００はＧＰＳデータを用いるナビゲーショ
ン方式を例としているが、ＧＰＳデータを用いないナビ
ゲーション方式であっても、ジャイロセンサ３，Ａ／Ｄ
変換手段６，及びデットレコニング手段８間の構成は同
様である）。

【０００４】なお、マップマッチング手段７，デットレ
コニング手段８，検索手段９，描画手段１０は通常プロ
グラム（以下、ナビゲーションプログラム）によって行
われ、これらのナビゲーションプログラムの実行及びナ
ビゲーション装置全体の制御は制御部（図示せず）によ
って行われる。

【０００５】上記従来のナビゲーション装置では、位置
表示を短い周期（例えば、１〜２秒周期）で行う場合、
デットレコニング処理とマップマッチング処理（後述）
をその周期で行っており、角度センサとして圧電振動ジ
ャイロを使用する場合、圧電振動ジャイロの出力電圧を
一定時間毎にサンプリングし、Ａ／Ｄ変換してマイクロ
コンピュータに取り込みこれを１秒間周期で積分して積
分値を１秒間の角度変化量として求め、次に、この角度
変化量と距離センサからの移動距離により移動ベクトル
を求めて前回の座標にこれを加算することで新しい座標
を求めていた。また、車両の方位も前回の方位に角度変
化量を加算することにより新しい方位を求め（デットレ
コニング処理）ていた。

【０００６】更に、ナビゲーション装置が持つ地図デー
タと上記車両の座標を比較することにより、表示地図上
で車両位置を修正していた（マップマッチング処理）。
しかしながら、圧電振動ジャイロでは停止中や直線走行
のようにセンサ出力がゼロであるべきときでも、温度や
湿度等の影響によるドリフト（Drift；ぶれ）が生ずる
ので出力電圧が完全には０（ゼロ）にならず、積分を続
けると誤差が大きくなってしまうという問題点があっ
た。

【０００７】そして、このようなドリフトの補正方法と
して、 特公昭５８−３９３６０号公報には、一定時間が経
過したら車両が停止している間に圧電振動ジャイロの出
力電圧を計測してその直流成分Ｘ（ボルト）を求めてお
き、車両が走行している間はこのＸを出力電圧から減算
してドリフトを除去する技術、すなわち、停止時の電圧
を基準電圧として一定時間毎に測定し、補正する方法が
開示されており、また、 特開平６−４２９７６号公報には、マップマッチン
グ処理時に、直線道路を走行している場合にその道路の
方位を車両の方位とする技術、すなわち、地図情報によ
る（ジャイロ出力のオフセット補正による方位の修正）
方法が開示されている。更に、 特開平４−３４６０２３号公報には、車両がマップ
マッチング状態で、自車が走行中であると推定された道
路の地図データから第１のリンク情報を記憶し、この値
と一定時間経過した時点の第２のリンク方位からリンク
方位差を算出し、この期間のジャイロの方位変化量との
誤差からオフセット値を推定してジャイロのドリフトを
補正する技術が開示されている。なお、この技術ではＧ
ＰＳの方位データが得られている場合はこのデータとジ
ャイロの出力から求めた方位データを比較してオフセッ
ト値を求めて補正する。

【０００８】

【発明が解決しようとする課題】しかしながら、上記従
来技術による圧電振動ジャイロのドリフト補正方法の特
徴は、 車の静止時の圧電振動ジャイロの出力電圧成分を用
いて車の走行時の圧電振動ジャイロの出力電圧を補正す
る、 車の直進時に、記憶されている地図情報に基づく道
路の方位を用いて積分後の角度を補正する、 車両がマップマッチング状態である場合にジャイロ
出力から得られたリンク方位とマップマッチングから得
られたリンク方位を比較し、その差を蓄積する事により
ドリフト補正値を求める、点にあり、それぞれ次の
（１），（２），（３）に示すような問題点があった。

【０００９】（１） 上記の点に関しては、高速道路
や信号機のない道路（例えば、山間の細道）では停車す
る機会がなく静止時の電圧の計測ができない点。 （２） 上記の点に関しては、直線道路がない場合、
地図データのない場所では修正ができない。また、修正
可能な場合でも修正対象が積分データでありセンサデー
タ（例えば、圧電振動ジャイロの出力）ではない点。 （３） 上記の点に関しては、マップマッチング状態
を前提としているため、地図データの無い場所では補正
できず、そして現在のナビゲーション装置では車両の通
行できる全ての地図データを持っているわけではないの
で、補正のできる可能性が低い点。 また、車両は常に移動しているためマップマッチング状
態にあっても一時的に地図のない場所へ移動してしまう
可能性が高く、マップマッチング状態を維持することが
困難である点。さらに、マップマッチング状態にあって
も、リンク方位と車両の進行方向が一致しているとは限
らない点。例えば、 ａ．車線変更の為にハンドルを操作した場合にはリンク
方位と車両の進行方向が不一致となり、また、 ｂ．高速道路等でパーキングエリアに入った場合にはリ
ンク方位と車両の進行方向が一致する可能性が低く、 ｃ．曲り角の場合には、デジタル地図データでは曲り角
を２本のリンクで表現し、９０度の曲りに対して１本の
リンクを０度、他の１本のリンクを９０度と仮定してい
るが、実際の車両方位は時刻の経過と共に０度→１度→
２度→・・・・→８９度→９０度のように連続的に変化
するのに対し、リンク方位は上述したように０度か９０
度のどちらかで現されるだけなので、リンク方位と実際
の車両方位からオフセット値を推定すると、一時的に大
きな誤差が生じてしまいジャイロのドリフト補正に悪い
影響があった。 更にまた、ＧＰＳの方位データは、車両の移動速度が遅
いと誤差が増大し、停止した場合には計算不能となり、
また、ＧＰＳ受信機に人工衛星からの電波が入らない場
合にも計算が不可能になる点。ここで、上記問題の解決
課題として、停車できなくてもドリフト補正が実現でき
ればドリフトが発生しないためマップ・マッチング処理
の精度が向上する。また、地図データのある場所からな
い場所へ車が移動した場合でもドリフトの補正を続ける
ことができればナビゲーション装置の現在位置表示性能
が向上する。

【００１０】本発明は上記問題点の解消及び上記課題の
解決を目的になされたものであり、（イ）停車しなくて
もドリフトを補正し得る圧電振動ジャイロのドリフト補
正方法及びドリフト補正回路の提供、及び、（ロ）地図
データのある場所からない場所へ車が移動した場合でも
ドリフトの補正を続け得るジャイロのドリフト補正回路
の提供、を目的とする。（ハ）さらに、車両がマップマ
ッチング状態に無く、地図データが無い場合でもジャイ
ロの補正ができるジャイロのドリフト補正方法及びドリ
フト補正回路の提供、及び、（ニ）補正値を求めるとき
に一時的な誤差を生じないジャイロのドリフト補正方法
及びドリフト補正回路の提供、及び、（ホ）ＧＰＳから
正確な方位データが得られない場合でもジャイロのオフ
セット補正ができるジャイロのドリフト補正方法及びド
リフト補正回路の提供、を目的とする。

【００１１】

【課題を解決するための手段】上記の目的を達成するた
めに第１の発明のジャイロのドリフト補正方法は、角度
変化を検出するジャイロセンサとマップマッチング手段
を含む移動体のナビゲーション装置において、（１）ジ
ャイロセンサからの出力信号から一定時間毎にデジタル
データを得て、該デジタルデータから所定時間内の第１
の移動平均値を求め、（２）マップマッチング処理によ
って得られた車両の方位データを一定時間毎に取り出し
てその差分値を得て、該差分値に基づいて所定時間内の
第２の移動平均値を求め、（３）上記第１の移動平均値
と第２の移動平均値との差を求めてドリフト補正値と
し、（４）デジタルデータと上記ドリフト補正値の差を
算出し補正済ジャイロデータを得る、ことを特徴とす
る。

【００１２】第２の発明は上記第１の発明のジャイロの
ドリフト補正方法において、更に、ステップ（３）で求
めたドリフト補正値を保存し、ステップ（４）での補正
済ジャイロデータの計算時に当該保存されたドリフト補
正値を取り出して用いる、ことを特徴とする。

【００１３】第３の発明は、上記第１または第２の発明
のジャイロのドリフト補正方法において、移動体が当該
移動体のナビゲーション装置の格納部に格納されている
地図データに規定する範囲以外の場所に移動した時には
ドリフト補正値の更新を停止して、ドリフト補正を継続
することを特徴とする。

【００１４】第４の発明のジャイロのドリフト補正回路
は、角度変化を検出するジャイロセンサと、マップマッ
チング手段と、を含む移動体のナビゲーション装置にお
いて、上記ジャイロセンサからの出力データを入力して
一定時間毎の第１の移動平均値を求める第１の演算手段
と、前記マップマッチング手段からの移動体の方位デー
タの差分値を入力して一定時間毎の第２の移動平均値を
求める第２の演算手段と、第１の移動平均量から第２の
移動平均量を減算してドリフト補正量を求める第１の減
算手段と、前記ジャイロセンサからの出力データよりド
リフト補正量を減算して補正済ジャイロデータを得る第
２の減算手段と、を備えたことを特徴とする。

【００１５】第５の発明は、第４の発明の回路におい
て、第１の演算手段と第２の演算手段との入力側に、前
記ジャイロセンサからの出力データを所定時間遅延させ
る遅延手段を設けたことを特徴とする。

【００１６】第６の発明のジャイロのドリフト補正回路
は、角度変化を検出するジャイロセンサと、マップマッ
チング手段と、を含む移動体のナビゲーション装置にお
いて、上記ジャイロセンサからの出力データの現在から
過去のＮ回分の第１の和データを計算する第１の和演算
手段と、前記マップマッチング手段からの移動体の方位
データの差分値の現在から過去のＮ回分の第２の和デー
タを計算する第２の和演算手段と、第１の和データから
第２の和データを減算して差出力を得る第１の減算手段
と、上記差出力を入力データと比較する比較手段と、上
記比較手段の出力を積分しその積分出力を上記入力デー
タとして比較手段に戻すと共に該積分出力を時間で除算
してドリフト補正値を得る演算手段と、前記ジャイロセ
ンサからの出力データよりドリフト補正値を減算して補
正済ジャイロデータを得る第２の減算手段と、を備えた
ことを特徴とする。

【００１７】第７の発明のジャイロのドリフト補正回路
は、角度変化を検出するジャイロセンサと、マップマッ
チング手段と、を含む移動体のナビゲーション装置にお
いて、上記ジャイロセンサからの出力データの現在から
過去のＮ回分の第１の和データを計算する第１の和演算
手段と、前記マップマッチング手段からの移動体の方位
データの差分値の現在から過去のＮ回分の第２の和デー
タを計算する第２の和演算手段と、第１の和データから
第２の和データを減算して差出力を得る第１の減算手段
と、上記差出力を入力データと比較する比較手段と、上
記比較手段の出力を積分しその積分出力を上記入力デー
タとして比較手段に戻すと共に該積分出力をＦＩＲフィ
ルタに入力させてドリフト補正値を得る演算手段と、前
記ジャイロセンサからの出力データよりドリフト補正値
を減算して補正済ジャイロデータを得る第２の減算手段
と、を備えたことを特徴とする。

【００１８】第８の発明のジャイロのドリフト補正回路
は、角度変化を検出するジャイロセンサと、マップマッ
チング手段と、を含む移動体のナビゲーション装置にお
いて、上記ジャイロセンサからの出力データの現在から
過去のＮ回分の第１の和データを計算する第１の和演算
手段と、前記マップマッチング手段からの移動体の方位
データの差分値の現在から過去のＮ回分の第２の和デー
タを計算する第２の和演算手段と、第１の和データから
第２の和データを減算して差出力を得る第１の減算手段
と、上記差出力を入力データと比較する比較手段と、上
記比較手段の出力データの現在から過去のＮ回分の第３
の和データを計算し該第３の和データを上記入力データ
として比較手段に戻すと共に該第３の和データを所定の
定数で除算してドリフト補正値を得る演算手段と、前記
ジャイロセンサからの出力データよりドリフト補正値を
減算して補正済ジャイロデータを得る第２の減算手段
と、を備えたことを特徴とする。

【００１９】第９の発明は第４の回路の発明において、
第１及び第２の演算手段がＦＩＲフィルタであることを
特徴とする。

【００２０】第１０の発明のジャイロのドリフト補正回
路は、角度変化を検出するジャイロセンサと、地図情報
を格納した格納部と、ジャイロセンサ出力から電圧変化
データを得る変換手段と、該変換手段の出力及び距離セ
ンサから得た移動距離量から座標変化量を得て前回の座
標に今回の変化量を加算して座標データを得るデットレ
コニング手段と、デットレコニング手段からの方位デー
タと前記地図情報に基づいて移動体の現在位置を得るマ
ップマッチング手段と、を含む移動体のナビゲーション
装置のジャイロのドリフト補正回路であって、変換手段
からの電圧変化データを入力して一定時間内の第１の移
動平均量を得る第１のフィルタ手段と、マップマッチン
グ手段からの移動体の方位データの差分値に基づいて一
定時間内の第２の移動平均量を得る第２のフィルタ手段
と、第１の移動平均量と第２の移動平均量との差を得る
第１の減算手段と、電圧変化データと第１の減算手段の
出力の差を得て前記デットレコニング手段に与える第２
の減算手段と、を有することを特徴とする。

【００２１】第１１の発明は、上記第１０の発明のドリ
フト補正回路において、更に、第１及び第２のフィルタ
手段に時間情報を与えるクロックパルス発生手段と、移
動体が当該移動体のナビゲーション装置の格納部に格納
されている地図データに規定する範囲以外の場所に移動
した時にはドリフト補正値の更新をしないようクロック
パルス発生手段からの時間情報を遮断するスイッチ手段
と、を有することを特徴とする。

【００２２】第１２の発明は、上記第１０または第１１
の発明のドリフト補正回路において、更に、変換手段と
第１のフィルタ手段との間にマップマッチング手段にお
ける差分値出力時間相当分の遅延を行わせる遅延手段を
設けることを特徴とする。

【００２３】第１３の発明は、角度変化を検出するジャ
イロセンサと、地図情報を格納した格納部と、ジャイロ
センサ出力から電圧変化データを得る変換手段と、該変
換手段の出力及び前記距離センサから得た移動距離量か
ら座標変化量を得て前回の座標に今回の変化量を加算し
て座標データを得るデットレコニング手段と、デットレ
コニング手段からの座標データと地図情報に基づいて移
動体の現在位置を得るマップマッチング手段と、を含む
移動体のナビゲーション装置のジャイロのドリフト補正
回路であって、変換手段からの電圧変化データを入力し
て現在から過去のＮ回分のデータの和を計算する第１の
Ｎ点和演算手段と、前記マップマッチング手段から移動
体の方位データを得て方位データの差分値を得る微分手
段と、前記微分手段の出力を入力して現在から過去のＮ
回分のデータの和を計算する第２のＮ点和演算手段と、
第１及び第２のＮ点和演算手段の出力の差を出力する第
１の減算手段と、第１の減算手段の出力に基づいてドリ
フト補正値の応答をマップマッチング手段における差分
値出力時間相当分遅延させてドリフト補正値を得る補正
値応答遅延手段と、電圧変化データからドリフト補正値
を減算する第２の減算手段と、を有することを特徴とす
る。

【００２４】第１４の発明のジャイロのドリフト補正方
法は、角度変化を検出するジャイロセンサと、デットレ
コニング手段と、マップマッチング手段と、を含む移動
体のナビゲーション装置において、下記（１）乃至
（５）のステップを含むことを特徴とする。 （１）表示車両方位を得て時刻と共に記憶し、 （２）ジャイロセンサからの出力を積分してジャイロ方
位とし、一定時間経過した場合はステップ（３）を実行
し、経過していない場合は上記積分を繰返す。 （３）上記一定時間が経過した時点の表示車両方位を取
得し、方位差を得る。 （４）方位差とジャイロ方位の差分を求め、該差分を上
記一定時間で除算することによりオフセット補正値を得
る、 （５）ジャイロ出力から上記オフセット補正値を減算し
てジャイロ出力の補正を行う。

【００２５】第１５の発明は上記第１４の発明のジャイ
ロのドリフト補正方法において、マップマッチング手段
で得た座標を自車位置と推定して該推定値により道路上
に自車位置が決定された場合に該道路の方向を表示車両
方位とし、マップマッチング手段で得た推定値により道
路上に自車位置が決定できない場合にはデットレコニン
グ処理で得た推測位置を現在位置として車両方向を表示
車両方位とする、ことを特徴とする。

【００２６】第１６の発明は上記第１４の発明のジャイ
ロのドリフト補正方法において、自律航法で得た座標と
ＧＰＳから得た座標の差が大きいときはＧＰＳから得た
方位を表示車両方位とし、ＧＰＳの受信ができないと
き、或いはＧＰＳから得た座標とマップマッチング手段
で得た座標の差が少ないときには、マップマッチング手
段で得た座標を自車位置と推定して該推定値により道路
上に自車位置が決定された場合に該道路の方向を表示車
両方位とし、マップマッチング手段で得た推定値により
道路上に自車位置が決定できない場合にはデットレコニ
ング処理で得た推測位置を現在位置として車両方向を表
示車両方位とする、ことを特徴とする。

【００２７】第１７の発明のジャイロのドリフト補正装
置は、ＧＰＳ受信機と、角度変化を検出するジャイロセ
ンサと、デットレコニング手段と、マップマッチング手
段と、とを含む移動体のナビゲーション装置において、
自律航法で得た座標とＧＰＳから得た座標の差が大きい
ときはＧＰＳから得た方位を表示車両方位とし、ＧＰＳ
の受信ができないとき、或いはＧＰＳから得た座標とマ
ップマッチング手段で得た座標の差が少ないときには、
マップマッチング手段で得た座標を自車位置と推定して
該推定値により道路上に自車位置が決定された場合に該
道路の方向を表示車両方位とし、マップマッチング手段
で得た推定値により道路上に自車位置が決定できない場
合にはデットレコニング処理で得た推測位置を現在位置
として車両方向を表示車両方位とする表示車両方位選択
手段と、表示車両方位選択手段から表示車両方位を得て
時刻と共に記憶する記憶手段と、ジャイロセンサからの
出力を一定時間積分してジャイロ方位データを得る積分
手段と、前記一定時間経過後にその時点の表示車両方位
を取得し前記記憶された表示車両方位データとの方位差
を得る方位差検出手段と、上記方位差とジャイロ方位の
差分を求め、該差分を上記一定時間で除算することによ
りオフセット補正値を得るオフセット補正値算出手段
と、前記ジャイロ出力から上記オフセット補正値を減算
してジャイロ出力の補正を行うオフセット補正手段と、
とを有することを特徴とする。

【００２８】第１８の発明は上記第１７の発明のジャイ
ロのドリフト補正回路において、更に、地磁気センサを
備え、マップマッチング手段で得た推定値により道路上
に自車位置が決定できない場合に前記補正されたジャイ
ロ出力に代えて上記地磁気センサからの角度データ値を
デットレコニング手段の入力として用いることを特徴と
する。

【００２９】

【発明の実施の態様】第１の発明のジャイロのドリフト
補正方法では、ジャイロセンサからの出力信号から一定
時間毎にデジタルデータを得て、該デジタルデータから
所定時間内の第１の移動平均値を求め、マップマッチン
グ処理によって得られた車両の方位データを一定時間毎
に取り出してその差分値を得て、該差分値に基づいて所
定時間内の第２の移動平均値を求め、第１の移動平均値
と第２の移動平均値との差を求めてドリフト補正値と
し、デジタルデータと上記ドリフト補正値の差を算出し
補正済ジャイロデータを得るので、車両の（停止又は移
動）状態に拘らずドリフト補正値を得ることができる。

【００３０】第２の発明のドリフト補正方法では、第１
の発明において、求めたドリフト補正値を保存し、補正
済ジャイロデータの計算時に当該保存されたドリフト補
正値を取り出して用いるので、移動体が地図データに規
定する範囲以外の場所に位置する場合等、地図データが
ない場所に移動した時には、保存されている前回の補正
値が今回の補正済ジャイロデータの計算データとして用
いられる。

【００３１】第３の発明のジャイロのドリフト補正方法
では、上記第１または第２の発明において、移動体が当
該移動体のナビゲーション装置の格納部に格納されてい
る地図データに規定する範囲（例えば、地図データに規
定する道路）以外の場所に位置する時にはドリフト補正
値の更新を停止して、ドリフト補正を継続するので、前
回の補正値により補正済ジャイロデータが計算される。

【００３２】第４の発明では、ジャイロセンサからの出
力データ及びマップマッチング手段からの方位データよ
り一定時間毎に第１及び第２の移動平均値を求め、両者
を減算することによってドリフト値を得て、補正済ジャ
イロデータを求める。

【００３３】第５の発明では第４の発明において、ジャ
イロセンサからの出力データを所定時間遅延させ、マッ
プマッチング手段での計算時間に対応できるようにす
る。

【００３４】第６の発明では、第４の発明での第１及び
第２の移動平均量に代えて、現在から過去のＮ回分の第
１及び第２の和データを計算すると共にその差出力の比
較、積分及び時間除算を行ってドリフト補正値を得る。

【００３５】第７の発明では、第６の発明での時間除算
に代えてＦＩＲフィルタによる演算を行わせる。

【００３６】第８の発明では、第６の発明での積分及び
時間除算に代えて、比較出力データの現在から過去のＮ
回分の第３の和データを計算し、該第３の和データを定
数で除算してドリフト補正値を得る。

【００３７】第９の発明では、第６の発明での第１及び
第２の移動平均量を、ＦＩＲフィルタで求める。

【００３８】第１０の発明のジャイロのドリフト補正回
路では、第１のフィルタ手段により変換手段からの電圧
変化データを入力して一定時間内の第１の移動平均量を
得て、第２のフィルタ手段によりマップマッチング手段
から移動体の方位データの差分値を基に一定時間内の第
２の移動平均量を得て、第１の減算手段により第１の移
動平均量と第２の移動平均量との差（ドリフト補正値）
を得て、車両の（停止又は移動）状態に拘らずドリフト
補正値を得ることができる。また，第２の減算手段によ
り電圧変化データと第１の減算手段の出力の差を得てデ
ットレコニング手段に与えるので、デットレコニング手
段によるより正確な方位決定を可能とする。

【００３９】第１１の発明のジャイロのドリフト補正回
路は、第１０の発明において、移動体が当該移動体のナ
ビゲーション装置の格納部に格納されている地図データ
に規定する範囲以外の場所に位置する時にはドリフト補
正値の更新を停止して、ドリフト補正を継続するので、
前回の補正値により補正済ジャイロデータが計算され
る。

【００４０】第１２の発明のジャイロのドリフト補正回
路は、第１０または第１１の発明において、変換手段と
第１のフィルタ手段との間にマップマッチング手段にお
ける差分値出力時間相当分の遅延を行わせる遅延手段を
設けるので、マップマッチング手段による差分出力時間
内に生じ得るドリフト補正値の大きな変動が抑制され
る。

【００４１】第１３の発明のジャイロのドリフト補正回
路は、ドリフト補正値の応答をマップマッチング手段に
おける差分値出力時間相当分遅延させてドリフト補正値
を得る補正値応答遅延手段により、マップマッチング手
段による差分値出力時間内に生じ得るドリフト補正値の
大きな変動が抑制される。

【００４２】第１４の発明のジャイロのドリフト補正方
法は、表示車両方位を得て時刻と共に記憶し、ジャイロ
センサからの出力を積分してジャイロ方位とし、一定時
間経過した場合は上記一定時間が経過した時点の表示車
両方位を取得し、方位差を得る。次に、方位差とジャイ
ロ方位の差分を求め、該差分を上記一定時間で除算する
ことによりオフセット補正値を得てジャイロ出力から上
記オフセット補正値を減算してジャイロ出力の補正を行
う。

【００４３】第１５の発明は上記第１４の発明のジャイ
ロのドリフト補正方法において、マップマッチング手段
で得た推定値により道路上に自車位置が決定できない場
合にはデットレコニング処理で得た推測位置を現在位置
として車両方向を表示車両方位として、オフセット補正
値を得てジャイロ出力の補正を行う。

【００４４】第１６の発明は上記第１４の発明のジャイ
ロのドリフト補正方法において、ＧＰＳから得た方位，
マップマッチング手段で得た車両方位，デットレコニン
グ処理で得た車両方向のいずれかをその時点のＧＰＳま
たはマップマッチングの状態により選択して表示車両方
位として、オフセット補正値を得てジャイロ出力の補正
を行う。

【００４５】第１７の発明のジャイロのドリフト補正装
置は、表示車両方位選択手段から表示車両方位を得て時
刻と共に記憶し、ジャイロセンサからの出力を一定時間
積分してジャイロ方位データを得て、表示車両方位と記
憶された表示車両方位データとの方位差を得て、方位差
とジャイロ方位の差分を求めて時間で除算することによ
りオフセット補正値を得る。そして、ジャイロ出力から
上記オフセット補正値を減算してジャイロ出力の補正を
行う。これにより多くの情報からその時点で一番正確と
判定された情報をナビゲーション装置が選択して得た表
示車両方位を用いることになり、個々の情報の欠点を補
った精度の高いジャイロのドリフト補正が実現する。な
お、地図データの無い場所では、表示車両方位を求める
ために使用できるデータが方位センサからのデータとＧ
ＰＳの方位データだけとなる。よって、表示車両方位は
方位センサからの方位データ、またはＧＰＳが受信可能
で信頼できる場合にＧＰＳの方位データそのものとな
る。そこで、方位センサのデータで表示車両方位が求ま
るとき、ジャイロの出力を方位センサとして用いると誤
差検出手段の出力がゼロとなってしまう。しかし、車両
が地図データがない場所に移動する以前に地図データの
ある場所を走行していた場合にはその間に積分手段にオ
フセット値が累積している。これに対し、方位差検出手
段ではオフセット値の累積がないため車両が地図データ
が無い場所に移動してからしばらくの間はオフセット補
正が可能となる。そして、オフセット補正量が時間の経
過と共に減少していき最終的にゼロとなる。したがっ
て、地図データのある場所を走行したあとなら短時間で
あれば地図データの無い場所を走行してもオフセットが
補正される。また、その途中でＧＰＳの方位データが得
られる場合には、その時点までのマップマッチングに蓄
積されたオフセット値が捨てられるため長時間地図デー
タの無い場所を走行していてもオフセットが補正でき
る。

【００４６】第１８の発明では、地磁気センサを方位セ
ンサとして用いるので地磁気センサの角度のオフセット
にジャイロ出力の積分値が追従する。よって積分制御と
なり、ジャイロのオフセットはゼロに補正される。

【００４７】

【実施例】本発明に基づくジャイロのドリフト補正方法
は、図８のナビゲーション装置１００を例とすれば、ジ
ャイロセンサ３からの出力信号を一定時間毎にＡ／Ｄ変
換してデータＡを得て、データＡから所定時間ｔの移動
平均値Ｂを求める（但し、地図データがない時には後述
の補正値Ｅを計算しない）。次に、ナビゲーション装置
１００のマップマッチング手段７から車両の方位データ
を一定時間毎に取り出しその差分値Ｃを求め、差分値Ｃ
から所定時間ｔの移動平均値Ｄを求める。上記２つの移
動平均値Ｂ，Ｄから差（Ｂ−Ｄ）を求め補正値Ｅとす
る。そして、データＡと補正値Ｅの差（Ｅ−Ａ）を計算
し補正済ジャイロデータＦを得る。なお、補正値Ｅは毎
回保存され、保存された補正値は補正済ジャイロデータ
Ｆの計算時に取り出される。

【００４８】＜実施例１＞図２は、本発明に基づくジャ
イロのドリフト補正方法の一実施例を示すフローチャー
トであり、コンピュータプログラムにより実現した例で
ある（説明上、本実施例のプログラムを実行するナビゲ
ーション装置の構成として図８のナビゲーション装置１
００を例とする）。なお、ここで、ジャイロのドリフト
プログラムはナビゲーション装置１００のナビゲーショ
ン動作を実行するナビゲーションプログラムの一部分
（サブルーチン）としてＲＯＭ（図示せず）に格納さ
れ、ナビゲーション装置１００のナビゲーション動作の
実行時に取り出されてナビゲーション装置１００のＣＰ
Ｕ（図示せず）により実行制御される。

【００４９】図１において、ステップＳ１ではジャイロ
センサ３からの出力信号を一定時間毎にＡ／Ｄ変換され
たデジタルデータを読んでデータＡとし、ステップＳ２
に移行する。ステップＳ２で、マップマッチング手段７
を介して地図データ検索手段９から現在位置付近の地図
データが得られるか否か（地図データの有無）を判定
し、地図データが得られる場合にはステップＳ３に移行
し、地図データが得られない場合にはステップＳ７に移
行する。ステップＳ３で、ステップＳ１で得たデータＡ
から１０分間の移動平均値を計算しその結果をＢとして
ステップＳ４に移行する。ステップＳ４で、ナビゲーシ
ョン装置１００のマップマッチング手段７から車両の方
位データ（ナビゲーション装置１００ではマップマッチ
ング手段７の車両方位データを車両位置の描画に用いて
いるのでこの車両方位データを流用する）を一定時間毎
に取りだしメモリ（図示せず）に保存している前回の方
位データとの差を求め差分値Ｃとし、ステップＳ５に移
行する。

【００５０】ステップＳ５で、差分値Ｃから１０分間の
移動平均値を計算してその結果をＤとし、ステップＳ６
に移行する。ステップＳ６で、補正値Ｅ＝Ｂ−Ｄを算出
し、その結果をメモリ（図示せず）に保存してステップ
Ｓ７に移行する。ステップＳ７で、メモリに保存した補
正値Ｅを取りだし、データＡと補正値Ｅの差（Ｅ−Ａ）
を計算し補正済ジャイロデータＦを得る。なお、補正値
Ｅは毎回保存され、保存された補正値は補正済ジャイロ
データＦの計算時に取り出されるので、ステップＳ２の
判定で地図データがない場合には、保存されている前回
の補正値Ｅが今回の補正済ジャイロデータＦの計算デー
タとして用いられる。そして、得られた補正済ジャイロ
データＦをナビゲーション装置１００のデットレコニン
グ手段８にジャイロセンサ出力の補正済みデータとして
引き渡す。

【００５１】＜実施例２＞図２で（ａ）は本発明に基づ
くジャイロのドリフト補正回路の一実施例の構成を示す
ブロック図であり、ドリフト補正回路２０はナビゲーシ
ョン装置１００のＡ／Ｄ変換手段６，デットレコニング
手段８，及びマップマッチング手段７に接続する回路で
ある。なお、本実施例では、説明上、ナビゲーション装
置１００の各構成部分１〜１１は図８と同様とする。ド
リフト補正回路２０で、２１は第１のＦＩＲフィルタ、
２２，２３は減算器、２４はインターフェイス、２５は
微分回路、２６は第２のＦＩＲフィルタ、２７はクロッ
ク発生器、２８はスイッチである。また、図２で（ｂ）
はドリフト補正回路２０のＦＩＲフィルタ２１，２６の
構成例、（ｃ）はドリフト補正回路２０の微分回路２５
の構成例である。

【００５２】図２で、ジャイロセンサ３の出力をＡ／Ｄ
変換手段６で一定時間毎にＡ／Ｄ変換し、デジタルデー
タＡを得て第１のＦＩＲフィルタ２１に入力してその出
力をＢとする。次に、ナビゲーション装置１００のマッ
プマッチング手段７から車両の方位データを一定時間毎
にインターフェイス回路２４を通して微分回路２５に入
力しその出力Ｃを得て、出力Ｃを第２のＦＩＲフィルタ
２６に入力しその出力をＤとする。これら２つのフィル
タ出力を減算器２２に入力してドリフト補正値Ｅ＝Ｂ−
Ｄを得る。そして、Ａ／Ｄ変換手段６からのデータＡと
補正値Ｅを減算器２２に加えて出力Ｆ＝Ａ−Ｅを得る。
この出力Ｆをジャイロ補正値としてデットレコニング手
段８に与える。

【００５３】なお、ここで、図２（ａ）の例に示すよう
に第１のＦＩＲフィルタ２１及び第２のＦＩＲフィルタ
２６にはクロック発生器２７からクロックが供給される
が、地図データがない場合にはスイッチ２８をＯＦＦに
してクロックの供給を停止し、補正値Ｅをホールドす
る。これにより、地図データがない場合には減算器２３
にはデータＡと前回の補正値Ｅが与えられることとな
る。

【００５４】ＦＩＲフィルタ２１，２６は図２（ｂ）の
ブロック図に示すように、Ｎ個の遅延回路２２１（遅延
時間Ｔ）と、Ｎ＋１個の乗算器２２２及びＮ個の加算器
２２３を有し、入力信号（ＩＮ）はまず、１次のフィル
タ段階で乗算回路２２２−０により係数ｈ０が掛けられ
加算器２２３−１に入力される。また、遅延回路２２１
−１で時間Ｔだけ遅延され入力信号（ＩＮ）に乗算回路
２２２−１により係数ｈ１が掛けられ加算器２２３−１
に入力されこれら２つの信号が加算される。

【００５５】２次のフィルタ段階では遅延回路２２１−
２で時間２Ｔだけ遅延され入力信号（ＩＮ）に乗算回路
２２２−２により係数ｈ２が掛けられ加算器２２３−２
に入力される。また、加算器２２３−２には加算器２２
２ー２の結果が入力されこれら２つの信号が加算され
る。

【００５６】同様に、ｉ次のフィルタ段階では遅延回路
２２１−ｉで時間ｉ・Ｔだけ遅延され入力信号（ＩＮ）
に乗算回路２２２−ｉより係数ｈｉが掛けられ加算器２
２３−ｉに入力される。また、加算器２２３−ｉには加
算器２２２−（ｉー１）の結果が入力されこれら２つの
信号が加算される。このように、ＦＩＲフィルタを用い
ることにより係数ｈ０〜Ｈｎを適当に選ぶことにより移
動平均値を得ることができる。

【００５７】微分回路２５は図２（ｃ）の例に示すよう
に遅延回路２５１（遅延時間Ｔ）と減算回路２５２から
なり、入力信号（ＩＮ）の一方を減算器２５２の正端子
に加え、入力信号（ＩＮ）の他方を遅延回路２５１を通
して時間Ｔだけ遅延させ減算器２５２の負端子に加える
ことにより差分値を得る。

【００５８】＜実施例３＞上記実施例１のドリフト補正
方法及び実施例２のドリフト補正回路２０では車両が交
差点を曲った時にマップマッチング手段７からその曲り
に相当する差分値が直ちに得られるものと仮定してい
る。しかしながら、マップマッチング手段７による計算
には１〜５秒程度の時間が必要であり、この期間にはド
リフト補正値が大きく変動する可能性がある。そこで、
本実施例では車両が交差点を曲がった時に要するマップ
マッチング処理による差分値計算時間内のドリフト補正
値の変動抑制機能を加えたドリフト補正回路の構成例に
ついて、図３のブロック図により説明する。

【００５９】図３は本発明に基づくジャイロのドリフト
補正回路の一実施例の構成を示すブロック図であり、ド
リフト補正回路３０はナビゲーション装置１００のＡ／
Ｄ変換手段６，デットレコニング手段８，及びマップマ
ッチング手段７に接続する回路である。なお、本実施例
では、説明上、ナビゲーション装置１００の各構成部分
１〜１１は図８と同様とする。

【００６０】ドリフト補正回路３０で、２１は第１のＦ
ＩＲフィルタであり第１のフィルタ手段に相当し、２
２，２３は減算器、２４はインターフェイス、２５は微
分回路、２６は第２のＦＩＲフィルタ、３１は遅延回路
であり、第１のＦＩＲフィルタ２１〜第２のＦＩＲフィ
ルタ２６までの構成は図２のドリフト補正回路２０と同
様である。なお、本実施例では微分回路２５及び第２の
ＦＩＲフィルタは第２のフィルタ手段を構成する。本実
施例のドリフト補正回路３０ではＡ／Ｄ変換手段６から
のデータＡに遅延回路３１により遅延時間を与えてマッ
プマッチング手段７によるマップマッチング処理の計算
時間に相当する時間だけ遅延させる。これによりマップ
マッチング手段による差分出力相当時間内に生じ得るド
リフト補正値の大きな変動を小さくし、抑制する。他の
処理は図２のドリフト補正回路３０と同様であり、説明
を省略する。

【００６１】＜実施例４＞本実施例は一時的に演算回路
４１，５１の出力に誤差が大きく発生した場合に、これ
にリミッタをかける回路を示す。図４で、ドリフト補正
回路４０はナビゲーション装置１００のＡ／Ｄ変換手段
６，デットレコニング手段８，及びマップマッチング手
段７に接続する回路である。なお、本実施例では、説明
上、ナビゲーション装置１００の各構成部分１〜１１は
図８と同様とする。

【００６２】ドリフト補正回路４０で、４１，５１はＮ
点和の演算回路、４２は減算回路、４３はコンパレー
タ、４４は積分回路、４５はクロックパルス発生回路、
４６はカウンタ回路、４７は除算回路、４８は減算器、
４９はインターフェイス、５０は微分回路である。な
お、本実施例ではコンパレータ４３，積分器４４，クロ
ックパルス発生回路４５，カウンタ回路４６，及び除算
回路４７はリミッタを構成する。ドリフト補正回路４０
では図２のＦＩＲフィルタ（第１のＦＩＲフィルタ２
１，第２のＦＩＲフィルタ２６）をＮ点和の演算回路４
１，５１と乗算回路（実際には除算回路４７）に分割し
て、その間でコンパレータ４３と積分回路４４を用いる
ことによりドリフト補正値の一時的な変動を抑制する。
ここで、Ｎ点和の演算回路４１，５１は図７（ａ）に示
す構成の回路であり、Ｎ点の有限離散時間ｘ（ｎ）に対
し、下記式（１）による演算を行う回路である。

【００６３】

【数１】

【００６４】すなわち、Ｎ個の遅延回路４１１（遅延時
間Ｔ）と、Ｎ個の加算器４１２を有し、入力信号（Ｉ
Ｎ）は、先ず、遅延回路４１１−１で時間Ｔだけ遅延さ
れ、加算器４１２−２に入力される。また、加算器４１
２−２には入力信号（ＩＮ）が入力されこれら２つの信
号が加算される。次に、入力信号は遅延回路４１１−２
で時間２Ｔだけ遅延され加算器４１２−２に入力され
る。また、加算器４１２−２には加算器４１２−１の結
果が入力されこれら２つの信号が加算される。同様に、
入力信号は遅延回路４１１−ｉで時間ｉ・Ｔだけ遅延さ
れ加算器４１２−ｉに入力される。また、加算器４１２
−ｉには加算器４１２（ｉ−１）の結果が入力されこれ
ら２つの信号が加算される。これにより、時系列データ
に対し現在から過去のＮ回分のデータの和が計算され
る。

【００６５】図４のドリフト補正回路４０では、Ｎ点和
の演算回路４１，５１の出力を減算回路４２に加え差出
力を得て、コンパレータ４３に入力する。コンパレータ
４３はもう一方の入力データ（積分回路４４の出力）と
の比較を行い、２つの入力の差が一定範囲ε内（ε≧
０）であれば０（ゼロ）を出力し、差出力側が大きけれ
ば正の値を、その反対なら負の値を出力する。この値を
図７（ｂ）に示すような積分回路４４に入力して積分を
行い、その出力をコンパレータ４３に戻す。このような
動作により積分回路４４の出力には差出力に追従した出
力が得られる。なお、クロックパルス発生器４５とカウ
ンタ回路４６により時間データが得られる。上記出力を
除算回路４７で時間で除算することにより変動の小さい
ドリフト補正値が得られる。このドリフト補正値を減算
器４８に入力し、データＡからの差Ｆ＝Ａ−Ｅを得る。
この出力Ｆをジャイロ補正値としてデットレコニング手
段８に与える。

【００６６】＜実施例５＞本実施例は一時的に演算回路
４１，５１の出力に誤差が大きく発生した場合に、これ
にリミッタをかける回路を示す。図５で、ドリフト補正
回路５０はナビゲーション装置１００のＡ／Ｄ変換手段
６，デットレコニング手段８，及びマップマッチング手
段７に接続する回路である。なお、本実施例では、説明
上、ナビゲーション装置１００の各構成部分１〜１１は
図８と同様とする。ドリフト補正回路５０は、図４のド
リフト補正回路４０において除算回路４７の代りにＦＩ
Ｒフィルタ５５を用いるものであり、コンパレータ４３
と積分回路４４を用いることによりドリフト補正値の一
時的な変動を抑制する。

【００６７】＜実施例６＞本実施例は一時的に演算回路
４１，５１の出力に誤差が大きく発生した場合に、これ
にリミッタをかける回路を示す。図６で、ドリフト補正
回路６０はナビゲーション装置１００のＡ／Ｄ変換手段
６，デットレコニング手段８，及びマップマッチング手
段７に接続する回路である。なお、本実施例では、説明
上、ナビゲーション装置１００の各構成部分１〜１１は
図８と同様とする。ドリフト補正回路６０は、図４のド
リフト補正回路４０において積分回路４４の代りにＮ点
和の演算回路６１を用い、時間による除算を行う除算回
路４７を定数により除算を行う除算回路６２としたもの
であり、コンパレータ４３を用いることによりドリフト
補正値の一時的な変動を抑制する。

【００６８】上記実施例３〜実施例６でドリフト補正値
の変動を小さくする回路（図３〜図６のドリフト補正回
路３０，４０，５０，６０）を示したが、実施例１の場
合と同様にプログラムによりこれらの回路を実現するこ
とができる。

【００６９】＜実施例７＞図９は本発明のナビゲーショ
ン装置の他の実施例の構成を示すブロック図であり、Ｇ
ＰＳ受信機２０１，距離センサ２０２，地磁気センサ２
０３，ジャイロセンサ２０４，デットレコニング手段２
０６，マップマッチング手段２０７，地図データ２１
０，表示車両方位選択手段２１１，表示装置２１２は前
述の実施例１〜６で説明したナビゲーション装置の構成
と同様であり、本実施例でナビゲーション装置２００は
それらに積分手段２２１〜オフセット補正手段２３５か
らなるオフセット補正部を付加した構成をなす。また、
オフセット補正手段は望ましくはナビゲーション装置２
００のナビゲーション動作を実行するナビゲーションプ
ログラムの一部分（サブルーチン）としてＲＯＭ（図示
せず）に格納され、ナビゲーション装置２００のナビゲ
ーション動作の実行時に取り出されてナビゲーション装
置２００のＣＰＵ（図示せず）により実行制御される。

【００７０】図９に示すように、ナビゲーション装置２
００はＧＰＳ受信機２０１，距離センサ２０２，地磁気
センサ２０３やジャイロセンサ２０４のような方位セン
サ等から情報を得てデットレコニング手段２０６及びマ
ップマッチング手段２０７等による処理を経て自車位置
を推定して地図データ２１０を検索し、表示データ作成
手段２１１によりオフセット補正に用いる表示車両方位
をＧＰＳまたはマップマッチングの状態から判定して選
択し表示データを作成して、表示装置２１２上に地図を
描画し、図１０の例に示すように地図３００上に自車位
置マーク３０１を表示する。

【００７１】デットレコニング手段２０６では距離セン
サ２０２からの移動距離と方位センサからの方位変化量
θを用いて次式により移動ベクトルを求める。推定車両
方位は前回の方位をθ0 とするとθ0 ＋θとなる。 Δｘ＝１ｃｏｓ（θ0 ＋ θ） Δｙ＝１ｓｉｎ（θ0 ＋ θ） この（ｘ，ｙ）が推測位置であり、マップマッチング手
段２０７の入力データとなる。マップマッチング手段２
０７では上記推測位置と地図データ２０９を用いて地図
上の自車位置を推定する。マップマッチング手段２０７
は、まず、車両が直進しているか旋回しているかを判定
する。直進している場合には車両の進行方位に近い道路
を選択する。次に、過去にマップマッチングでできた道
路に接続される道路を選択する。そして、推測位置から
最も近い道路を１本選択し、この選択された道路に推測
位置から垂線を下し、道路との交点を自車位置とする。
旋回している場合には、車両の方位変化の過程と道路の
方位変化の形状を比較して道路を１本選択し、この選択
された道路に推測位置から垂線を下し、道路との交点を
自車位置とする。ただし、進行方向に近い道路がなかっ
たり、接続されている道路がなかったり、道路の形状が
一致しなかった場合には自車位置を推測位置とする。

【００７２】さらに、道路を見付けた場合にはマップマ
ッチングの車両方位を道路の方位とする。自車位置を推
測位置とした場合には、マップマッチングの車両方位を
道路の方位とする。自車位置を推測位置とした場合には
θ0 ＋θをマップマッチング処理で得た車両方位とす
る。ここまででマップマッチング処理が完了するが、Ｇ
ＳＰデータが信頼できるときには次の処理を行う。マッ
プマッチング処理の結果得た自車位置座標とＧＰＳデー
タの座標が大きくずれている場合には自車位置のデータ
を捨ててＧＰＳデータを自車位置とし、ＧＰＳデータの
方位データを表示車両方位とする。このようにして、セ
ンサとＧＰＳから自車位置と表示車両方位が得られる
が、これでも正確に実際の車両方位が得られるとは限ら
ない。例えば駐車場でナビゲーションシステムの電源を
切ったままターンテーブルで車両を回転させたり、立体
駐車場で旋回を繰返した場合等ではＧＰＳの方位デー
タ、地図データ、ジャイロセンサのデータのいずれもが
使えない。これに対しては表示車両方位のマニアル修正
が有効となる。ナビゲーションシステムでは一般的に
「自車位置修正」、「自車方位修正」の機能が備えられ
ており、これらは地図表示画面で自車位置と表示車両方
位を自車マークを使って表示しているとき、実際の位置
または方位と表示が一致していないと運転者が認識した
場合に情報入力手段により運転者の推定した位置または
方位に修正を行う機能であり、この機能を用いることに
より前述の様な特殊な状態の場合でも正確な表示車両方
位が決められる。このようにマップマッチング処理によ
り自車位置とマップマッチングの車両方位が決定される
と自車位置を中心とした地図データ２１０を読み出しこ
のデータにより地図描画手段２１１”が表示装置２１２
上に地図を描画する。自車位置マーク３０１は地図上に
推定した自車位置を示すと共に、車両の進行する方位
（表示方位と呼ぶ）を示している。この表示方法はナビ
ゲーション装置が動作している間は常時１つの値を保持
し、常に新しい情報で更新されているので、マップマッ
チングできない時でも方位センサ、ＧＰＳ等からのデー
タにより更新される。

【００７３】本発明におけるジャイロの補正方法につい
て図１のナビゲーション装置２００のオフセット補正手
段および図１１のフローチャートを基に以下説明する。
ステップＳ１０１では、ナビゲーション装置２００から
表示車両方位を取得し、記憶手段２３１により記憶しス
テップＳ１０２に移行する（ここで、記憶した値をＭと
する）。ステップＳ１０２ではジャイロ２０４の出力を
積分しジャイロ方位としてステップＳ１０３に移行する
（ここでのジャイロ方位をＧとする）。ステップＳ１０
３では一定時間Ｔだけ経過したか否かを調べ経過してい
ない場合はステップＳ１０２に戻りジャイロ出力の積分
を繰返す。経過した場合はステップＳ１０４に移行す
る。ステップＳ１０４では一定時間が経過した時点の表
示車両方位を取得し、値Ｍとの差（方位差）Ｄを方位差
検出手段２３２により計算しステップＳ１０５に移行す
る（Ｄ＝現在車両方位−Ｍ）。ステップＳ１０５では方
位差Ｄとジャイロ方位Ｇの差（誤差）Ｅを誤差検出手段
２３３により求めステップＳ１０６に移行する（Ｅ＝Ｄ
−Ｇ）。誤差Ｅからオフセット算出手段２３４によりオ
フセット補正値を計算してステップＳ１０７に移行す
る。オフセット算出手段２３４はＥの値をステップＳ２
での経過時間Ｔで除算することにより角速度データに変
換してオフセット補正値Ｏを得る（Ｏ＝Ｅ／Ｔ）。ここ
で、ステップＳ２での経過時間Ｔはオフセット算出手段
２３４による除算演算で誤差が増加しないように選ばれ
る。オフセット補正手段２３５によりジャイロ２０４の
出力からオフセット補正値Ｏを減算して補正を行う（補
正済ジャイロ出力＝補正前ジャイロ出力−Ｏ）。

【００７４】＜具体例＞図１２は上述のジャイロ出力の
オフセット補正方法の説明図であり、図では処理や入出
力機器を矩形のブロックで示し、データを円で示してあ
る。また、説明上、ナビゲーション装置２００’の各構
成部分２０１〜２３５は図９とほぼ同様であり、記号の
同じ各構成部分の機能及び構成は図９の場合と同様であ
る（表示データ作成手段２１１は表示車両方位選択手段
２１１’および地図描画手段２１１”を含むものとす
る）。本発明のジャイロ出力のオフセット補正では、ナ
ビゲーション装置２００’の表示方位のデータを基準方
位として使用しオフセット値を制御するため、ナビゲー
ション装置２００’の内部状態の影響を受ける。よって
ナビゲーション装置２００’の状態も含めて説明を行
う。また、ナビゲーション装置２００’ではその内部状
態がＧＰＳ受信機２０１の測位中か否か、マップマッチ
ングが可能か否かでデータの処理方法が異なってくるの
で、これらを場合分けして説明する。

【００７５】（１）ＧＰＳ測位中の場合：表示車両方位
選択手段２１１’は自律航法で求めた座標とＧＰＳ受信
により求めた座標に大きな誤差がある場合には、ＧＰＳ
受信の状態がよければＧＰＳからの座標を現在位置と推
定する。ＧＰＳの受信状態が悪ければ自律航法の座標を
現在位置とする。ＧＰＳの座標を現在位置とした場合、
ジャイロの補正は以下のように実行される。 （ａ）方位センサ（地磁気センサ２０３，ジャイロ２０
４）および距離センサからのデータを捨ててデットレコ
ニング手段２０６及びマップマッチング手段２０７で求
めた座標と方位データを捨てる。そして、ＧＰＳ受信に
より求めた座標と方位データを現在位置のデータとしこ
れにより地図の表示を行う。 （ｂ）上記表示車両方位データと記憶手段２３１に記憶
されているデータから方位差検出手段２３２により差を
求め方位差とする。記憶手段２３１にはナビゲーション
装置２００’の起動時の表示車両方位データおよびその
ときの時刻を記憶しておく。或いは、走行中に停車して
ジャイロ２０４のキャリブレーションを実施したときの
表示車両方位データおよびそのときの時刻を記憶してお
いてもよい。 （ｃ）積分手段２２１では、上記記憶手段２３１にデー
タを記憶した時刻から積分を開始し、ジャイロ２０４の
角速度データから角度データを得る。 （ｄ）誤差検出手段２３３では、上記（ｂ）の方位デー
タと（ｃ）の角度データから差を求め、これを角度誤差
とする。 （ｅ）オフセット算出手段２３４では（ｄ）の角度誤差
を時間データで除算しオフセット誤差を求める。時間デ
ータとしては現在時刻から（ｂ）のデータを記憶した時
刻を減算した経過時間を用いる。 （ｆ）オフセット補正手段２３４ではジャイロからの角
速度データから（ｅ）のオフセット誤差を減算すること
により誤差を除去する。

【００７６】次に、ＧＰＳ測位中の場合について具体的
な数値で補正の過程を示す。 （ａ’）ＧＰＳの方位データを北を基準として時計回り
に３６０度で表すとき、現在の方位データを４８度と仮
定する。 （ｂ’）記憶手段２３１の方位データが４８度で時刻が
８時３２分０秒であったと仮定すると、方位差は次式で
求められる。 （方位差）＝（表示車両方位データ）−（記憶データ）
＝４８−４８＝０ （ｃ’）ジャイロ２０４の角速度データをＥｓｉｎωｔ
＋０．０１と仮定する。つまり、振幅Ｅで正弦波で角速
度が発生しオフセットが０．０１ｖあるとする。この角
速度データを１０００秒間積分するとωｔ＝２ｎπとな
ると仮定すれば（ｎ：整数）、ｓｉｎωｔ＝０となり、
ｓｉｎωｔの積分値もゼロとなりオフセット分（０．０
１ｖ×１０００＝１０ｖ）だけが残る。このデータを変
換感度２０ｍｖ／ｄｅｇで角度に換算すると、 １０ｖ／（２０ｍｖ／ｄｅｇ）＝５００ｄｅｇ となる。これが角度データとなる。 （ｄ’）角度誤差は（ｂ’）と（ｃ’）から５００度と
なる。すなわち、 （角度誤差）＝（角度データ）−（方位差）＝５００−
０＝５００ｄｅｇ （ｅ’）現在時刻を８時４８分４０秒と仮定すると、時
間データは１６分４０秒＝１０００秒となり、この値で
角度誤差を除算する。すなわち、 （オフセット誤差）＝（角度誤差／時間データ）×（変
換感度）＝（５００／１０００）×（２０／１０００）
＝０．０１ｖ （ｆ’）ジャイロ２０４の角速度データからオフセット
誤差を減算すると、 （補正後のジャイロデータ）＝（角速度データ）−（オ
フセット誤差）＝Ｅｓｉｎωｔ＋０．０１−０．０１＝
Ｅｓｉｎωｔ となり、直流分のオフセットが除去できる。

【００７７】（２）マップマッチング中の場合：表示車
両方位選択手段２１１’は、ＧＰＳの受信ができない場
合、或いはＧＰＳの受信状態が良くてＧＰＳからの座標
とマップマッチング手段２０７で求めた座標が近似して
いる場合にはマップマッチング手段２０７で求めた座標
を現在位置と推定する。そして、マップマッチング手段
２０７は自車位置のある道路を見付けた場合にジャイロ
２０４の補正を次のようにして実行する（道路が見付か
らなかった場合には後述の（３）によりジャイロの補正
を行う）。 （ａ）ジャイロ２０４からの角速度データはオフセット
補正が行われる。この補正はオフセット誤差データを角
速度データに加算することであり、初期値がゼロで時系
列に沿って以下の処理により求められるオフセット誤差
を用いる。 （ｂ）オフセットの補正された角速度データは積分手段
２２１により積分されて角度データとなる。また、地磁
気センサ２０３の値が正しいと考えられる場合には地磁
気センサ２０３からの角度データを使用する。 （ｃ）距離センサからの距離データと（ｂ）の角度デー
タからデットレコニング手段２０６により推測位置を求
める。また、角度データをそのまま推測方位とする。 （ｄ）推測位置と推測方位からマップマッチング手段２
０６により自車位置のある道路を探す。道路を見付けた
場合にはその道路上で自車位置を決定し、その道路の方
向を車両方位として角度データを捨てる。 （ｅ）上記（ｄ）で求められた自車位置を表示車両方位
選択手段２１１’でＧＰＳ受信機２０１からの座標と比
較する。ＧＰＳの受信状態が良くて２つの座標が遠い場
合には前述した（１）の処理を行い、近い場合には上記
（ｄ）の自車位置を表示車両位置とし、車両方向を表示
車両方位として地図描画手段２１１”により地図の表示
を行う。 （ｆ）上記表示車両方位データと記憶手段２３１に記憶
されているデータから方位差検出手段２３２により差を
求め方位差とする。記憶手段２３１にはナビゲーション
装置２００’の起動時の表示車両方位データおよびその
ときの時刻を記憶しておく。或いは、走行中に停車して
ジャイロ２０４のキャリブレーションを実施したときの
表示車両方位データおよびそのときの時刻を記憶してお
いてもよい。 （ｇ）積分手段２２１では、上記記憶手段２３１にデー
タを記憶した時刻から積分を開始し、ジャイロ２０４の
角速度データから角度データを得る。 （ｈ）誤差検出手段２３３では、（ｆ）の方位データと
（ｇ）の角度データから差を求め、これを角度誤差とす
る。 （ｉ）オフセット算出手段２３４では（ｈ）の角度誤差
を時間データで除算しオフセット誤差を求める。時間デ
ータとしては現在時刻から（ｆ）のデータを記憶した時
刻を減算した経過時間を用いる。 （ｊ）オフセット補正手段２３４ではジャイロからの角
速度データから（ｉ）のオフセット誤差を減算すること
により誤差を除去する。

【００７８】次に、マップマッチング中の場合について
具体的な数値で補正の過程を示す。 （ａ’）ジャイロ２０４の角速度データをＥｓｉｎωｔ
＋０．０１と仮定する。 （ｂ’）この角速度データを１秒間積分した結果を変換
感度２０ｍｖ／ｄｅｇで角度に換算すると、１秒間の回
転量をθｄｅｇとして、 θ＋０．０１ｖ／（２０ｍｖ／ｄｅｇ）＝θ＋０．５ｄ
ｅｇ となり、また、θ＝｛∫（Ｅｓｉｎωｔ）ｄｔ｝／０．
０２より求められる（但し積分∫はここではΔｔ＝０か
ら１までの積分を意味する）。すなわち、ジャイロ２０
４の回転量とオフセットによる０．５度の誤差が加算さ
れて角度データとなる。 （ｃ’）推測方位データは前回の方位をθ0として、θ0
＋θ＋０．５度となる。 （ｄ’）ここでは道路の方向が（θ0＋θ）度であると
仮定する。 （ｅ’）このとき表示車両方位は（θ0＋θ）度とな
る。 （ｆ’）記憶手段２３１の方位データが０度で時刻が８
時３２分０秒であったと仮定すると、方位差は次式によ
り求められる。 （方位差）＝（表示車両方位データ）−（記憶データ）
＝θ0＋θ−θ0＝θｄｅｇ （ｇ’）積分手段２３１では（ｂ’）と同じ結果（θ＋
０．５度）となる。 （ｈ’）角度誤差は（ｆ）と（ｇ）より、 （角度誤差）＝（角度データ）−（方位差）＝θ＋０．
５−θ＝０．５ｄｅｇ （ｉ’）上記のような角度誤差の発生が１０００秒継続
すると、現在時刻が８時４８分４０秒となり角度誤差も
１０００倍の５００度となる。この角度誤差からオフセ
ット誤差を求める。すなわち、 （オフセット誤差）＝（角度誤差／時間データ）×（変
換感度）＝（５００／１０００）×０．０２＝０．０１
ｖ （ｊ’）ジャイロ２０４の角速度データからオフセット
誤差を減算すると、 （補正後のジャイロデータ）＝（角速度データ）−（オ
フセット誤差）＝Ｅｓｉｎωｔ＋０．０１−０．０１＝
Ｅｓｉｎωｔ となり、直流分のオフセットが除去される。

【００７９】（３）デットレコニング中の場合：表示車
両方位選択手段２１１’は、ＧＰＳが受信できない場
合、或いは、ＧＰＳの受信状態が良くてＧＰＳからの座
標とデットレコニング手段２０６で求めた座標が近い場
合にデットレコニング手段２０６による推測位置を現在
位置と推定する（但し、マップマッチングで道路がみつ
からない場合）。 （ａ）ジャイロ２０４からの角速度データに対してはオ
フセット補正が行われる。この補正は、オフセット誤差
データを角速度データに加算することであり、初期値が
ゼロで時系列に沿って以下の処理により求められるオフ
セット誤差を用いる。 （ｂ）オフセットの補正された角速度データは積分手段
２２１により積分されて角度データとなる。また、地磁
気センサ２０３の値が正しいと考えられる場合には地磁
気センサ２０３からの角度データを使用する。 （ｃ）距離センサからの距離データと（ｂ）の角度デー
タからデットレコニング手段２０６により推測位置を求
める。また、角度データをそのまま推測方位とする。そ
してマップマッチング手段２０７でこの位置に対する道
路がみつからない場合に推測位置と推測方位を自車位置
と車両方位とする。 （ｄ）上記（ｃ）で求められた自車位置を表示車両方位
選択手段２１１’でＧＰＳ受信機２０１からの座標と比
較する。ＧＰＳの受信状態が良くて２つの座標が遠い場
合には上述した（１）の処理を行うこととなり、近い場
合には上記（ｃ）の自車位置を表示車両位置とし、車両
方向を表示車両方位として地図描画手段２１１”により
地図の表示を行う。 （ｅ）上記表示車両方位データと記憶手段２３１に記憶
されているデータから方位差検出手段２３２により差を
求め方位差とする。記憶手段２３１にはナビゲーション
装置２００’の起動時の表示車両方位データおよびその
ときの時刻を記憶しておく。或いは、走行中に停車して
ジャイロ２０４のキャリブレーションを実施したときの
表示車両方位データおよびそのときの時刻を記憶してお
いてもよい。 （ｆ）積分手段２２１では、上記記憶手段２３１にデー
タを記憶した時刻から積分を開始し、ジャイロ２０４の
角速度データから角度データを得る。 （ｇ）誤差検出手段２３３では、（ｅ）の方位データと
（ｆ）の角度データから差を求め、これを角度誤差とす
る。 （ｈ）オフセット算出手段２３４では（ｇ）の角度誤差
を時間データで除算しオフセット誤差を求める。時間デ
ータとしては現在時刻から（ｅ）のデータを記憶した時
刻を減算した経過時間を用いる。 （ｉ）オフセット補正手段２３４ではジャイロからの角
速度データから（ｈ）のオフセット誤差を減算すること
により誤差を除去する。

【００８０】次に、マップマッチング中の場合について
具体的な数値で補正の過程を示す。 （ａ’）ジャイロ２０４の角速度データをＥｓｉｎωｔ
＋０．０１と仮定する。 （ｂ’）この角速度データを１秒間積分した結果を変換
感度２０ｍｖ／ｄｅｇで角度に換算すると、１秒間の回
転量をθｄｅｇとして、 θ＋０．０１ｖ／（２０ｍｖ／ｄｅｇ）＝θ＋０．５ｄ
ｅｇ となり、また、θ＝｛∫（Ｅｓｉｎωｔ）ｄｔ｝／０．
０２より求められる（但し積分∫はここではΔｔ＝０か
ら１までの積分を意味する）。すなわち、ジャイロ２０
４の回転量とオフセットによる０．５度の誤差が加算さ
れて角度データとなる。 （ｃ’）推測方位データは前回の方位をθ0として、θ0
＋θ＋０．５度となる。 （ｄ’）表示車両方位もθ0＋θ＋０．５度となる。 （ｅ’）方位差は次式により求まる。 （方位差）＝（表示車両方位データ）−（前回の方位デ
ータ）＝θ0＋θ＋０．５−θ0＝＋θ＋０．５ｄｅｇ （ｆ’）積分手段２３１では上記（ｂ’）と同じ結果
（θ＋０．５ｄｅｇ）となる。 （ｇ’）角度誤差は（ｅ）と（ｆ）よりゼロとなる。す
なわち、 （角度誤差）＝（角度データ）−（方位差）＝θ＋０．
５−（θ＋０．５）＝０

【００８１】以上のようにデットレコニングによる推測
データしか使えない場合には角度誤差がゼロとなり、オ
フセット誤差もゼロとなって補正ができないこととな
る。これは地図データのない場所を走行することに相当
し、補正のための基準となるデータが何もないときに起
こる。なお、この場合でも、地磁気センサ２０３からの
角度データがあれば（ｂ’）で角度データがθ度とな
り、（ｇ’）で角度誤差が０．５度となってオフセット
補正が可能になる。さらに、所定時間以上前述の（１）
または（２）の状態で積分手段２３１にオフセットを含
んだ角速度データが積分された状態で保存されていた場
合、一時的に地図データのない場所を走行して方位差の
変化分と積分手段２３１の変化分が一致する場合にも、
誤差検出手段２３３から角度誤差が生じるのでオフセッ
トの補正が可能である。

【００８２】この場合の過程を前記（ａ）の各速度デー
タが１０００秒経過した例をもとに説明する。 （ｅ’）初期状態よりジャイロ２０４の回転量が０度と
すると、 （方位差）＝（表示車両方位データ）−（前回の方位デ
ータ）＝４８−４８＝０ｄｅｇ （ｆ’）積分手段２３１でもオフセット分だけが残る。
すなわち、 ０．０１ｖ×１０００／（０．０２ｖ／ｄｅｇ）＝５０
０ｄｅｇ （ｇ’）角度誤差は（ｅ”）と（ｆ）より、 （角度誤差）＝（角度データ）−（方位差）＝５００−
０＝５００ｄｅｇ （ｈ’）経過時間を１０００秒とすると、 （オフセット誤差）＝（角度誤差／時間データ）×（変
換感度）＝（５００／１００）×０．０２＝０．０１ｖ （ｉ’）オフセット補正では以下のようにオフセットが
除去される。 （補正後のジャイロデータ）＝（角速度データ）−（オ
フセット誤差）＝Ｅｓｉｎωｔ＋０．０１−０．０１＝
Ｅｓｉｎωｔ

【００８３】ここで、地図データのない場所へ入ると次
のようになる。 （ｅ”）表示車両方位データがＥｓｉｎωｔ＋０．０１
となりオフセット分だけを考えると、（方位差）＝４８
＋（０．０１／０．０２）−４８＝０．５ｄｅｇ （ｆ”）積分手段２３１の値は、 ５００＋（０．０１／０．０２）＝５００．５ｄｅｇ （ｇ”）角度誤差は、 （角度誤差）＝５００．５−０．５＝５００ｄｅｇ （ｈ”）オフセット誤差は、 （オフセット誤差）＝（５００／１００１）×０．０２
≒０．００９９９ｖ （ｉ”）オフセット補正は、 （補正後のジャイロデータ）＝Ｅｓｉｎωｔ＋０．０１
−０．００９９９＝Ｅｓｉｎωｔ＋０．００００１ となり、徐々に補正値が減少していくが、その期間、積
分されたデータにより補正がされる。

【００８４】

【発明の効果】以上説明したように本発明によれば、車
両が停止状態或いは移動状態のいずれであってもドリフ
トの補正が可能となるので、高速道路や信号機のない道
路での方位検出が正確になり、その結果ナビゲーション
装置の表示性能が向上する。また、直線道路がない場合
でも、ドリフトの除去されたデータをナビゲーション装
置に入力するので修正自体が不要となる。更に、事前に
地図データのある場所を走行して車両及びジャイロセン
サの温度変化がなくなっている場合に補正値が安定して
くる。この場合、車が地図データのない場所に移動して
も補正値は大きく変化しないため、単純に補正値をホー
ルドするだけでドリフトの補正が可能となり、ナビゲー
ション装置の現在位置表示性能が向上する。更にまた、
第１２〜第１３の発明ではドリフト補正回路にリミッタ
を設けることにより一時的な変動を抑制することができ
る。また、第１４〜１７の発明では車両がマップマッチ
ング状態かどうかに拘らず、補正が可能である。また、
地図のない場所では地磁気センサ，ＧＰＳ受信機からの
情報により補正が可能である。更に、リンク方位ではな
い連続的に変化する表示車両方位を使っているため、一
時的な誤差を生じない。また、第１７の発明では、多く
の情報からその時点で一番正確と判定された情報をナビ
ゲーション装置が選択して得た表示車両方位を用いてい
るので個々の情報の欠点を補った精度の高いジャイロの
ドリフト補正が実現される。

【図面の簡単な説明】

【図１】本発明に基づくジャイロのドリフト補正方法の
一実施例を示すフローチャートである。

【図２】本発明に基づくジャイロのドリフト補正回路の
一実施例の構成を示すブロック図である。

【図３】本発明に基づくジャイロのドリフト補正回路の
他の実施例の構成を示すブロック図である。

【図４】本発明に基づくジャイロのドリフト補正回路の
他の実施例の構成を示すブロック図である。

【図５】本発明に基づくジャイロのドリフト補正回路の
他の実施例の構成を示すブロック図である。

【図６】本発明に基づくジャイロのドリフト補正回路の
他の実施例の構成を示すブロック図である。

【図７】Ｎ点和の演算回路及び積分回路の構成例を示す
ブロック図である。

【図８】従来のナビゲーション装置の構成例を示すブロ
ック図である。

【図９】本発明のナビゲーション装置の一実施例の構成
を示すブロック図である。

【図１０】地図の表示例である。

【図１１】ジャイロの補正方法の一例を示すフローチャ
ートである。

【図１２】ジャイロ出力のオフセット補正方法の説明図
である。

【符号の説明】

３，２０４ ジャイロセンサ ６ Ａ／Ｄ変換回路（変換手段） ７，２０８ マップマッチング手段 ８，２０７ デットレコニング手段 ２０，３０，４０，５０，６０ ドリフト補正回路 ２１ ＦＩＲフィルタ（第１のフィルタ手段） ２２，２３ 減算器（減算手段） ２５ 微分回路（第２のフィルタ手段） ２６ ＦＩＲフィルタ（第２のフィルタ手段） ３１ 遅延回路（遅延手段） ４１，５１ Ｎ点和の演算回路 ４２，４８ 減算器（減算手段） ４３ コンパレータ（補正値応答遅延手段） ４４ 積分回路（補正値応答遅延手段） ４７ 除算回路（補正値応答遅延手段） ６１ Ｎ点和の演算回路（補正値応答遅延手段） ６２ 定数除算回路（補正値応答遅延手段） １００，２００，２００’ ナビゲーション装置 ２０１ ＧＰＳ受信機 ２０３ 距離センサ ２１０ 地図データ ２１１ 表示データ作成手段 ２１１’ 表示車両方位選択手段 ２１２ 表示装置 ２２１，２２２ 積分手段 ２３１ 記憶手段 ２３２ 方位差検出手段 ２３３ 誤差検出手段 ２３４ オフセット算出手段 ２３５ オフセット補正手段

Claims (18)

【特許請求の範囲】
1. 【請求項１】 角度変化を検出するジャイロセンサと、
   マップマッチング手段を含む移動体のナビゲーション装
   置において、（１）ジャイロセンサからの出力信号から
   一定時間毎にデジタルデータを得て、該デジタルデータ
   から所定時間内の第１の移動平均値を求め、（２）マッ
   プマッチング処理によって得られた車両の方位データを
   一定時間毎に取り出してその差分値を得て、該差分値に
   基づいて所定時間内の第２の移動平均値を求め、（３）
   上記第１の移動平均値と第２の移動平均値との差を求め
   てドリフト補正値とし、（４）前記デジタルデータと上
   記ドリフト補正値の差を算出し補正済ジャイロデータを
   得る、 ことを特徴とするジャイロのドリフト補正方法。
2. 【請求項２】 請求項１記載のジャイロのドリフト補正
   方法において、更に、ステップ（３）で求めたドリフト
   補正値を保存し、ステップ（４）での補正済ジャイロデ
   ータの計算時に当該保存されたドリフト補正値を取り出
   して用いる、ことを特徴とするジャイロのドリフト補正
   方法。
3. 【請求項３】 請求項１または２記載のジャイロのドリ
   フト補正方法において、移動体が当該移動体のナビゲー
   ション装置の格納部に格納されている地図データに規定
   する範囲以外の場所に移動した時にはドリフト補正値の
   更新を停止して、ドリフト補正を継続することを特徴と
   するジャイロのドリフト補正方法。
4. 【請求項４】 角度変化を検出するジャイロセンサと、
   マップマッチング手段と、を含む移動体のナビゲーショ
   ン装置において、 上記ジャイロセンサからの出力データを入力して一定時
   間毎の第１の移動平均値を求める第１の演算手段と、 前記マップマッチング手段からの移動体の方位データの
   差分値を入力して一定時間毎の第２の移動平均値を求め
   る第２の演算手段と、 第１の移動平均量から第２の移動平均量を減算してドリ
   フト補正量を求める第１の減算手段と、 前記ジャイロセンサからの出力データよりドリフト補正
   量を減算して補正済ジャイロデータを得る第２の減算手
   段と、 を備えたことを特徴とするジャイロのドリフト補正方
   法。
5. 【請求項５】 第１の演算手段と第２の演算手段との入
   力側に、前記ジャイロセンサからの出力データを所定時
   間遅延させる遅延手段を設けたことを特徴とする請求項
   ４に記載のジャイロのドリフト補正方法。
6. 【請求項６】 角度変化を検出するジャイロセンサと、
   マップマッチング手段と、を含む移動体のナビゲーショ
   ン装置において、 上記ジャイロセンサからの出力データの現在から過去の
   Ｎ回分の第１の和データを計算する第１の和演算手段
   と、 前記マップマッチング手段からの移動体の方位データの
   差分値の現在から過去のＮ回分の第２の和データを計算
   する第２の和演算手段と、 第１の和データから第２の和データを減算して差出力を
   得る第１の減算手段と、 上記差出力を入力データと比較する比較手段と、 上記比較手段の出力を積分しその積分出力を上記入力デ
   ータとして比較手段に戻すと共に該積分出力を時間で除
   算してドリフト補正値を得る演算手段と、 前記ジャイロセンサからの出力データよりドリフト補正
   値を減算して補正済ジャイロデータを得る第２の減算手
   段と、を備えたことを特徴とするジャイロのドリフト補
   正回路。
7. 【請求項７】 角度変化を検出するジャイロセンサと、
   マップマッチング手段と、を含む移動体のナビゲーショ
   ン装置において、 上記ジャイロセンサからの出力データの現在から過去の
   Ｎ回分の第１の和データを計算する第１の和演算手段
   と、 前記マップマッチング手段からの移動体の方位データの
   差分値の現在から過去のＮ回分の第２の和データを計算
   する第２の和演算手段と、 第１の和データから第２の和データを減算して差出力を
   得る第１の減算手段と、 上記差出力を入力データと比較する比較手段と、 上記比較手段の出力を積分しその積分出力を上記入力デ
   ータとして比較手段に戻すと共に該積分出力をＦＩＲフ
   ィルタに入力させてドリフト補正値を得る演算手段と、 前記ジャイロセンサからの出力データよりドリフト補正
   値を減算して補正済ジャイロデータを得る第２の減算手
   段と、を備えたことを特徴とするジャイロのドリフト補
   正回路。
8. 【請求項８】 角度変化を検出するジャイロセンサと、
   マップマッチング手段と、を含む移動体のナビゲーショ
   ン装置において、 上記ジャイロセンサからの出力データの現在から過去の
   Ｎ回分の第１の和データを計算する第１の和演算手段
   と、 前記マップマッチング手段からの移動体の方位データの
   差分値の現在から過去のＮ回分の第２の和データを計算
   する第２の和演算手段と、 第１の和データから第２の和データを減算して差出力を
   得る第１の減算手段と、 上記差出力を入力データと比較する比較手段と、 上記比較手段の出力データの現在から過去のＮ回分の第
   ３の和データを計算し該第３の和データを上記入力デー
   タとして比較手段に戻すと共に該第３の和データを所定
   の定数で除算してドリフト補正値を得る演算手段と、 前記ジャイロセンサからの出力データよりドリフト補正
   値を減算して補正済ジャイロデータを得る第２の減算手
   段と、を備えたことを特徴とするジャイロのドリフト補
   正回路。
9. 【請求項９】 前記第１及び第２の演算手段がＦＩＲフ
   ィルタであることを特徴とする請求項４に記載のジャイ
   ロのドリフト補正回路。
10. 【請求項１０】 角度変化を検出するジャイロセンサ
    と、地図情報を格納した格納部と、ジャイロセンサ出力
    から電圧変化データを得る変換手段と、該変換手段の出
    力及び距離センサから得た移動距離量から座標変化量を
    得て前回の座標に今回の変化量を加算して座標データを
    得るデットレコニング手段と、デットレコニング手段か
    らの座標データと前記地図情報に基づいて移動体の現在
    位置を得るマップマッチング手段と、を含む移動体のナ
    ビゲーション装置において、 前記変換手段からの電圧変化データを入力して一定時間
    内の第１の移動平均量を得る第１のフィルタ手段と、 前記マップマッチング手段からの移動体の方位データの
    差分値に基づいて一定時間内の第２の移動平均量を得る
    第２のフィルタ手段と、 前記第１の移動平均量と第２の移動平均量との差を得る
    第１の減算手段と、 前記電圧変化データと前記第１の減算手段の出力の差を
    得て前記デットレコニング手段に与える第２の減算手段
    と、 を有することを特徴とするジャイロのドリフト補正回
    路。
11. 【請求項１１】 請求項１０記載のドリフト補正回路に
    おいて、更に、第１及び第２のフィルタ手段に時間情報
    を与えるクロックパルス発生手段と、移動体が当該移動
    体のナビゲーション装置の格納部に格納されている地図
    データに規定する範囲以外の場所に移動した時にはドリ
    フト補正値の更新をしないよう前記クロックパルス発生
    手段からの時間情報を遮断するスイッチ手段と、を有す
    ることを特徴とするジャイロのドリフト補正回路。
12. 【請求項１２】 請求項１０または１１記載のドリフト
    補正回路において、更に、変換手段と第１のフィルタ手
    段との間にマップマッチング手段における差分値出力時
    間相当分の遅延を行わせる遅延手段を設けることを特徴
    とするジャイロのドリフト補正回路。
13. 【請求項１３】 角度変化を検出するジャイロセンサ
    と、地図情報を格納した格納部と、ジャイロセンサ出力
    から電圧変化データを得る変換手段と、該変換手段の出
    力及び距離センサから得た移動距離量から角度変化量を
    得て前回の座標に今回の変化量を加算して座標デの和を
    計算する第１のＮ点和演算手段と、 前記マップマッチング手段から移動体の方位データを得
    て方位データの差分値を得る微分手段と、 前記微分手段の出力を入力して現在から過去のＮ回分の
    データの和を計算する第２のＮ点和演算手段と、 前記第１及び第２のＮ点和演算手段の出力の差を出力す
    る第１の減算手段と、 第１の減算手段の出力に基づいてドリフト補正値の応答
    をマップマッチング手段における差分値出力時間相当分
    遅延させてドリフト補正値を得る補正値応答遅延手段
    と、前記電圧変化データから前記ドリフト補正値を減算
    する第２の減算手段と、を有することを特徴とするジャ
    イロのドリフト補正回路。
14. 【請求項１４】 角度変化を検出するジャイロセンサ
    と、デットレコニング手段と、マップマッチング手段
    と、を含む移動体のナビゲーション装置において、下記
    （１）乃至（５）のステップを含むことを特徴とするジ
    ャイロのドリフト補正方法。 （１）表示車両方位を得て時刻と共に記憶し、 （２）ジャイロセンサからの出力を積分してジャイロ方
    位とし、一定時間経過した場合はステップ（３）を実行
    し、経過していない場合は上記積分を繰返す。 （３）上記一定時間が経過した時点の表示車両方位を取
    得し、方位差を得る。 （４）方位差とジャイロ方位の差分を求め、該差分を上
    記一定時間で除算することによりオフセット補正値を得
    る、 （５）ジャイロ出力から上記オフセット補正値を減算し
    てジャイロ出力の補正を行う。
15. 【請求項１５】 マップマッチング手段で得た座標を自
    車位置と推定して該推定値により道路上に自車位置が決
    定された場合に該道路の方向を表示車両方位とし、 マップマッチング手段で得た推定値により道路上に自車
    位置が決定できない場合にはデットレコニング処理で得
    た推測位置を現在位置として車両データの差分値を入力
    して一定時間毎の第２の移動平均値を求める第２の演算
    手段と、 第１の移動平均量から第２の移動平均量を減算してドリ
    フト補正量を求める第１の減算手段と、 前記ジャイロセンサからの出力データよりドリフト補正
    量を減算して補正済ジャイロデータを方向を表示車両方
    位とする、ことを特徴とする請求項１４に記載のジャイ
    ロのドリフト補正方法。
16. 【請求項１６】 自律航法で得た座標とＧＰＳから得た
    座標の差が大きいときはＧＰＳから得た方位を表示車両
    方位とし、 ＧＰＳの受信ができないとき、或いはＧＰＳから得た座
    標とマップマッチング手段で得た座標の差が少ないとき
    には、マップマッチング手段で得た座標を自車位置と推
    定して該推定値により道路上に自車位置が決定された場
    合に該道路の方向を表示車両方位とし、 マップマッチング手段で得た推定値により道路上に自車
    位置が決定できない場合にはデットレコニング処理で得
    た推測位置を現在位置として車両方向を表示車両方位と
    する、ことを特徴とする請求項１４に記載のジャイロの
    ドリフト補正方法。
17. 【請求項１７】 ＧＰＳ受信機と、角度変化を検出する
    ジャイロセンサと、デットレコニング手段と、マップマ
    ッチング手段と、とを含む移動体のナビゲーション装置
    において、 自律航法で得た座標とＧＰＳから得た座標の差が大きい
    ときはＧＰＳから得た方位を表示車両方位とし、ＧＰＳ
    の受信ができないとき、或いはＧＰＳから得た座標とマ
    ップマッチング手段で得た座標の差が少ないときには、
    マップマッチング手段で得た座標を自車位置と推定して
    該推定値により道路上に自車位置が決定された場合に該
    道路の方向を表示車両方位とし、マップマッチング手段
    で得た推定値により道路上に自車位置が決定できない場
    合にはデットレコニング処理で得た推測位置を現在位置
    として車両方向を表示車両方位とする表示車両方位選択
    手段と、 表示車両方位選択手段から表示車両方位を得て時刻と共
    に記憶する記憶手段と、 ジャイロセンサからの出力を一定時間積分してジャイロ
    方位データを得る積分手段と、 前記一定時間経過後にその時点の表示車両方位を取得し
    前記記憶された表示車両方位データとの方位差を得る方
    位差検出手段と、 上記方位差とジャイロ方位の差分を求め、該差分を上記
    一定時間で除算することによりオフセット補正値を得る
    オフセット補正値算出手段と、 前記ジャイロ出力から上記オフセット補正値を減算して
    ジャイロ出力の補正を行うオフセット補正手段と、とを
    有することを特徴とするジャイロのドリフト補正回路。
18. 【請求項１８】 更に、地磁気センサを備え、マップマ
    ッチング手段で得た推定値により道路上に自車位置が決
    定できない場合に前記補正されたジャイロ出力に代えて
    上記地磁気センサからの角度データ値をデットレコニン
    グ手段の入力として用いることを特徴とするジャイロの
    ドリフト補正回路。