JPH10170290A - ナビゲーション装置 - Google Patents

Abstract

(57)【要約】 【課題】 積算ピッチ角の累積誤差の増大を防止するこ
とができるナビゲーション装置を提供すること。 【解決手段】 移動体の加速度を検出する加速度センサ
１と、加速度センサ出力の加速度を補正する速度補正手
段を有し、前記補正された加速度から移動体の移動速度
を求め、移動速度を積算して移動体の移動距離を算出す
る移動距離算出手段５と、移動体のピッチ角速度を検出
するジャイロセンサ２とを有するナビゲーション装置で
あって、検出されたピッチ角速度を所定微小時間だけ積
算して得られた所定微小時間積算ピッチ角と基準値とを
比較して所定微小時間積算ピッチ角を補正するピッチ角
判定手段４を備えることにより、積算ピッチ角の累積誤
差の増大を防止することができるナビゲーション装置が
得られる。

Description

【発明の詳細な説明】

【０００１】

【発明の属する技術分野】本発明は、加速度センサを用
いて移動体たとえば車両の位置を算出するナビゲーショ
ン装置に関する。

【０００２】

【従来の技術】図３は従来のナビゲーション装置を示す
ブロック図である。図３において、Ａは中央制御部、１
は車両の進行方向の加速度を非接触にて検出する加速度
センサ、２は車両のピッチ動作方向における角速度（ピ
ッチ角速度）を検出するジャイロセンサ（ピッチ角速度
検出部）、３は車両のヨー動作方向における角速度（ヨ
ー角速度）を検出するジャイロセンサ、５は加速度セン
サ１出力の加速度から車両の移動距離を算出する移動距
離算出手段、６はジャイロセンサ２出力のピッチ角速度
からピッチ角を算出し、加速度センサ１出力の加速度に
対してピッチ成分の速度を補正する速度補正手段、７は
ジャイロセンサ３で検出したヨー角速度から車両の移動
方位角（ヨー角）を算出する移動方位算出手段、８は移
動距離算出手段５および移動方位算出手段７から出力さ
れる車両の移動距離および移動方位角を前回の車両の位
置に加算して現在の車両の位置を演算する相対位置演算
手段、９は車両の位置情報や地図データなどを表示する
表示部、１０はデジタル地図データが記憶された地図記
憶部、１１は相対位置演算手段８から出力される車両の
位置情報に基づき、その車両の位置が該当する所定の領
域の地図データを地図記憶部１０から読み出し、車両の
位置情報と地図データとを表示部９に出力する表示制御
手段であり、手段５〜８、１１は中央制御部Ａを構成す
る。

【０００３】図４はナビゲーション装置の車両搭載状態
を示す車載概念図である。図４において、加速度センサ
１、ジャイロセンサ２、３は図３と同様のものなので、
同一符号を付し、説明は省略する。１２は車両、１３は
中央制御部Ａ、表示部９および地図記憶部１０から成る
装置本体である。図４に示すように、加速度センサ１は
車両１２の進行方向における加速度を検出することがで
きるように車両１２に配置され、ジャイロセンサ２は車
両１２のピッチ角速度を検出することができるように、
ジャイロセンサ３は車両１２のヨー角速度を検出するこ
とができるように配置されている。

【０００４】以上のように構成、配置されたナビゲーシ
ョン装置について、その動作を説明する。図３に示すよ
うに、加速度センサ１およびジャイロセンサ２、３の出
力データから相対位置演算手段８により車両１２の位置
の演算を行う。まず、移動距離算出手段５は、所定の周
期（所定微小時間）Δｔ毎に加速度センサ１から出力さ
れるデータ（加速度データ）を時間軸で２回積分演算を
行う。つまり、（数１）、（数２）の演算を行うことに
より、車両１２の速度ｖｎおよび移動距離Δｄｎを得
る。ただし、加速度センサ１からデータの得られる時間
周期をΔｔ、時刻ｎにおける車両１２の加速度をａｎ、
時刻ｎにおける車両１２の速度をｖｎ、時間周期Δｔに
おける車両１２の移動距離をΔｄｎ、車両１２の初期速
度をＶ０とする。

【０００５】

【数１】

【０００６】

【数２】

【０００７】ここで、車両１２がピッチ方向に傾いてい
る場合、加速度センサ１の出力データには重力加速度の
ピッチ成分が含まれるため、加速度をそのまま用いて計
算しては移動距離算出に誤差が生じる。そこで、次に示
すような重力加速度成分除去のための補正を速度補正手
段６で行う。

【０００８】速度補正手段６では、ジャイロセンサ２か
らの出力データ（ピッチ角速度データ）に対して時間軸
で積分演算を行う。つまり、（数３）の演算を行うこと
により、車両１２のピッチ角（積算ピッチ角）αｎを得
る。ただし、ジャイロセンサ２からデータの得られる時
間周期をΔｔ、時刻ｎにおける車両１２のピッチ角速度
をωｎ、時刻ｎで時間周期Δｔにおける車両１２のピッ
チ角をαｎ、初期ピッチ角をα０とする。

【０００９】

【数３】

【００１０】この（数３）により求められたピッチ角α
ｎを用いて（数４）により加速度センサ１出力データの
補正を行う。ただし、補正された時刻ｎにおける車両１
２の加速度Ａｎ、加速度センサ１から出力された車両１
２の加速度をａｎ、重力加速度をｇとする。

【００１１】

【数４】

【００１２】（数４）のＡｎを（数１）、（数２）のａ
ｎに代入して、時刻ｎにおける車両１２の速度Ｖｎと時
間周期Δｔにおける車両１２の移動距離ΔＤｎとを得
る。これを（数５）、（数６）として示す。

【００１３】

【数５】

【００１４】

【数６】

【００１５】次に、移動方位算出手段７は、所定の時間
周期（所定微小時間）Δｔ毎にジャイロセンサ３から出
力されるデータ（ヨー角速度データ）に対して時間軸で
積分演算を行う。つまり、（数７）の演算を行うことに
より、車両１２の方位角（積算ヨー角）θｎを得る。た
だし、ジャイロセンサ３からデータの得られる時間周期
をΔｔ、時刻ｎにおける車両１２の方位角速度（ヨー角
速度）をωｎ、時刻ｎで時間周期Δｔにおける車両１２
の移動方位角をθｎ、初期方位角をθ０とする。

【００１６】

【数７】

【００１７】図５はナビゲーション装置における位置演
算を説明するための位置演算の概念図である。相対位置
演算手段８は、前述したように車両１２の移動距離ΔＤ
ｎおよび移動方位角θｎを求めると、図５に示す考え方
（移動距離に移動方位角を乗算して所定時間Δｔにおけ
るＸ、Ｙ方向の移動距離を求めるという考え方）を用い
て、（数８）、（数９）に基づき、車両１２の初期位置
から累積演算して車両１２の位置を求める。ただし、時
刻ｎにおける車両１２の位置座標を（ｘｎ、ｙｎ）、初
期位置を（ｘ０、ｙ０）とする。なお、移動距離算出に
おいて、水平面となすピッチ角の影響については考慮さ
れていないが、これは簡単に演算可能であると共にわず
かなピッチ角では誤差はあまり生じないので、説明は省
略する。

【００１８】

【数８】

【００１９】

【数９】

【００２０】相対位置演算手段８からは車両１２の位置
データが表示制御手段１１に出力される。表示制御手段
１１は、車両１２の位置データを受け取ると、地図記憶
部１０から、所定の領域のデジタル地図データを読み出
し、表示部９に出力する。

【００２１】このように、従来のナビゲーション装置で
は、加速度センサ１による速度算出を精度良く行うため
に、車両１２のピッチ角を検出するためのジャイロセン
サ２からの出力データ（ピッチ角速度データ）により、
加速度センサ１からの出力データ（加速度データ）に対
して補正を行う。

【００２２】

【発明が解決しようとする課題】しかしながら、上記従
来のナビゲーション装置では、加速度センサ１からの加
速度に対して補正を行うためのピッチ角速度を検出する
ジャイロセンサ２からの出力にドリフト成分があると、
ジャイロセンサ２により車両のピッチ角速度を検出しよ
うとする場合、速度補正手段６はジャイロセンサ２の出
力データを積算していくため、ジャイロセンサ２の出力
ドリフトまで積算されることになり、積算ピッチ角の累
積誤差が増大し、速度精度（従って移動距離算出精度）
や移動方位角精度が非常に悪くなるという問題点を有し
ていた。

【００２３】このナビゲーション装置では、積算ピッチ
角の累積誤差の増大を防止することができることが要求
されている。

【００２４】本発明は、積算ピッチ角の累積誤差の増大
を防止することができるナビゲーション装置を提供する
ことを目的とする。

【００２５】

【課題を解決するための手段】この課題を解決するため
に本発明によるナビゲーション装置は、移動体の加速度
を検出する加速度センサと、加速度センサ出力の加速度
の補正を行う速度補正手段を有し、前記補正された加速
度から移動体の移動速度を求め、移動速度を積算して移
動体の移動距離を算出する移動距離算出手段と、移動体
のピッチ角速度を検出するピッチ角速度検出部とを有す
るナビゲーション装置であって、検出されたピッチ角速
度を所定微小時間だけ積算して得られた所定微小時間積
算ピッチ角と基準値とを比較して所定微小時間積算ピッ
チ角を補正するピッチ角判定手段を備えるように構成し
た。

【００２６】これにより、積算ピッチ角の累積誤差の増
大を防止することができるナビゲーション装置が得られ
る。

【００２７】

【発明の実施の形態】本発明の請求項１に記載の発明
は、移動体の加速度を検出する加速度センサと、加速度
センサ出力の加速度の補正を行う速度補正手段を有し、
前記補正された加速度から移動体の移動速度を求め、移
動速度を積算して移動体の移動距離を算出する移動距離
算出手段と、移動体のピッチ角速度を検出するピッチ角
速度検出部とを有するナビゲーション装置であって、検
出されたピッチ角速度を所定微小時間だけ積算して得ら
れた所定微小時間積算ピッチ角と基準値とを比較して所
定微小時間積算ピッチ角を補正するピッチ角判定手段を
備えることとしたものであり、所定微小時間積算ピッチ
角が基準値を越えているか否かに応じて補正されるとい
う作用を有する。

【００２８】請求項２に記載の発明は、請求項１に記載
の発明において、ピッチ角判定手段は、所定微小時間積
算ピッチ角が基準値を越えたとき、所定微小時間積算ピ
ッチ角を基準値に補正することとしたものであり、所定
微小時間積算ピッチ角が基準値を越えたときには基準値
に等しい角度に補正されるという作用を有する。

【００２９】請求項３に記載の発明は、請求項１に記載
の発明において、ピッチ角判定手段は、所定微小時間積
算ピッチ角が基準値を越えたとき、所定微小時間積算ピ
ッチ角を測定時間当りの平均値に補正することとしたも
のであり、所定微小時間積算ピッチ角が基準値を越えた
ときには測定時間当りの平均値たとえば走行時間におけ
る平均値に等しい角度に補正されるという作用を有す
る。

【００３０】請求項４に記載の発明は、請求項１に記載
の発明において、ピッチ角判定手段は、所定微小時間積
算ピッチ角が基準値を越えたとき、所定微小時間積算ピ
ッチ角を加速度センサ出力の加速度から推測される値に
補正することとしたものであり、所定微小時間積算ピッ
チ角が基準値を越えたときには加速度センサ出力の加速
度から推測される値に等しい角度に補正されるという作
用を有する。

【００３１】請求項５に記載の発明は、請求項１乃至４
のいずれか１に記載の発明において、ピッチ角判定手段
は、ＣＤ−ＲＯＭに記憶された地図の高度変化情報に基
づいて基準値を設定することとしたものであり、基準値
が適正な値に設定されるという作用を有する。

【００３２】以下、本発明の実施の形態について、図
１、図２を用いて説明する。 （実施の形態１）図１は本発明の実施の形態１によるナ
ビゲーション装置を示すブロック図である。図１におい
て、加速度センサ１、ジャイロセンサ２、３、移動距離
算出手段５、速度補正手段６、移動方位算出手段７、相
対位置演算手段８、表示部９、地図記憶部１０、表示制
御手段１１は図３と同様のものなので、同一符号を付
し、説明は省略する。Ｂは演算、制御の処理を行う中央
制御部、４はジャイロセンサ２の出力データ（ピッチ角
速度データ）を所定微小時間だけ積算して得られた所定
微小時間積算ピッチ角と基準値（閾値）とを比較してジ
ャイロセンサ２の出力データを補正するピッチ角判定手
段である。

【００３３】以上のように構成されたナビゲーション装
置について、その動作を説明する。まず、移動距離算出
手段５は、加速度センサ１の出力データ（加速度デー
タ）から車両１２の速度を求め、この車両速度を積分す
ることにより車両１２の移動距離を算出し、移動方位算
出手段７は、ジャイロセンサ３の出力データ（方位角速
度データ）を入力し、この方位角速度を積分することに
より車両１２の方位角を算出する。さらに、相対位置演
算手段８は、移動距離算出手段５と移動方位算出手段７
から出力される車両移動距離と車両方位角から車両１２
の位置データを算出し、表示制御手段１１に出力する。
このとき、速度補正手段６は、ジャイロセンサ２の出力
データから算出した車両１２のピッチ角を用いて、加速
度センサ１の出力データを補正する。これらの動作は従
来と同様である。

【００３４】ジャイロセンサ２の出力には通常ドリフト
成分が含まれているが、従来は、速度補正手段６でその
ドリフト成分も積算され、累積された誤差成分を含んだ
車両ピッチ角により加速度センサ１の出力データが補正
されていた。このため、移動距離算出手段５により算出
した車両１２の移動距離は実際の車両１２の移動距離と
は異なって誤差を含むことになり、また、その誤差が累
積により増大してしまうという問題点を有していた。こ
のような誤差を除去するためにピッチ角判定手段４を設
けた。

【００３５】次に、ピッチ角判定手段４におけるドリフ
ト成分除去のための補正動作について説明する。時間周
期（所定微小時間）Δｔにジャイロセンサ２から得られ
るピッチ角速度の積分値（所定微小時間積算ピッチ角）
をＩｎ、基準値（閾値）をＩｘとする。この閾値Ｉｘ
は、補正動作が最適動作となるように、実験等により求
めた起こり得る最大ピッチ角速度を基準に設定した基準
値である。ピッチ角判定手段４は、Ｉｎ≦Ｉｘの場合
は、車両１２に通常有り得るピッチ角が発生していると
みなし、ジャイロセンサ２の出力データの積算値（所定
微小時間積算ピッチ角）を補正せずに速度補正手段６へ
出力する。また、ピッチ角判定手段４は、Ｉｎ＞Ｉｘの
場合は、ジャイロセンサ２の出力にドリフト成分を含ん
でいるため、通常有り得ないピッチ角速度をジャイロセ
ンサ２が出力しているとみなし、次にパターン１〜パタ
ーン３として示すような補正値を速度補正手段６へ出力
する。どの補正値を選択するかについては、過去の実験
データ等からピッチ角の増減がどのような傾向にあるか
を判別して決定される。

【００３６】まずパターン１について説明する。この場
合、ピッチ角判定手段４は、ジャイロセンサ２から得ら
れる出力データの積算値（所定微小時間積算ピッチ角）
を閾値Ｉｘに補正して（Ｉｎ＝Ｉｘとして）速度補正手
段６へ出力する。速度補正手段６は、加速度センサ１出
力の加速度をＩｎ＝Ｉｘに基づいて（数４）を用いて補
正する。

【００３７】次にパターン２について説明する。この場
合、ピッチ角判定手段４は、ジャイロセンサ２から得ら
れるピッチ角速度の所定微小時間における積算値である
所定微小時間積算ピッチ角を測定時間当りの平均値（例
えば走行時間における平均値）に補正して速度補正手段
６へ出力する。

【００３８】最後にパターン３について説明する。この
場合、ピッチ角判定手段４は、ジャイロセンサ２から得
られるピッチ角速度の所定微小時間における積算値であ
る所定微小時間積算ピッチ角を加速度センサ１から推測
される値に補正して速度補正手段６へ出力する。例えば
加速度センサ１の出力加速度が一定でＩｎ＞Ｉｘの時
は、実際は加速度が減少しながらジャイロセンサ２のド
リフトが増加していることになるので、所定微小時間積
算ピッチ角を減少させていくように補正する。また、加
速度センサ１の出力加速度が増加してＩｎ＞Ｉｘの時
は、実際は加速度が増加しながらジャイロセンサ２にド
リフトが生じていることになるので、所定微小時間積算
ピッチ角を閾値Ｉｘで一定になるように補正する。この
とき閾値ＩｘとしてＣＤ−ＲＯＭ等の記憶手段に記憶さ
れた地図の高度変化情報を用いてもよい。

【００３９】図２はピッチ角判定手段４の動作を示すフ
ローチャートである。まず、ジャイロセンサ２から出力
される所定微小時間のピッチ角速度を積算し、所定微小
時間積算ピッチ角Ｉｎを得る（Ｓ１）。次に、所定微小
時間積算ピッチ角Ｉｎを閾値Ｉｘとを比較し（Ｓ２）、
Ｉｎ≦Ｉｘか否かを判定する（Ｓ３）。Ｉｎ≦Ｉｘの場
合には移動距離算出手段５は所定微小時間積算ピッチ角
Ｉｎに対して補正をかけることなく（Ｓ４）、速度補正
および移動距離算出を行う（Ｓ５）。Ｉｎ≦Ｉｘでない
場合には移動距離算出手段５は所定微小時間積算ピッチ
角Ｉｎに対して上記パターン１〜３のいずれかのパター
ンにより補正を行う（Ｓ６）。これを走行時間中、繰り
返す（Ｓ２〜Ｓ６）。

【００４０】このように、ジャイロセンサ２の出力がド
リフト成分を含んでいると判定されたときには（Ｉｎ＞
Ｉｘのときには）、ピッチ角判定手段４は、パターン１
〜３のいずれかにより所定微小時間積算ピッチ角の補正
を行うようにしたので、ジャイロセンサ２にドリフトが
発生している場合でもドリフト成分がピッチ角として積
算されることがなく、したがって、ドリフト成分に基づ
く積算ピッチ角の誤差累積を防止することができ、移動
距離算出における誤差増大を防止することができる。

【００４１】ジャイロセンサ３についてもジャイロセン
サ２と同様のことが言える。この場合は図１のピッチ角
判定手段４に相当するものとしてヨー角判定手段（図示
せず）をジャイロセンサ３と移動方位算出手段７との間
に配置する。ヨー角判定手段は、所定微小時間積算ヨー
角が閾値以下か否かを比較し、閾値以下の場合は、車両
１２に通常有り得るピッチ角が発生しているとみなし、
ジャイロセンサ３の出力データの積算値（所定微小時間
積算ヨー角）を補正せずに移動方位算出手段７へ出力す
る。また、ヨー角判定手段は、所定微小時間積算ヨー角
が閾値以下か否かを比較し、閾値を越えている場合は、
ジャイロセンサ３の出力にドリフト成分を含んでいるた
め、通常有り得ないヨー角速度をジャイロセンサ３が出
力しているとみなし、所定パターンの補正値を移動方位
算出手段７へ出力する。

【００４２】このように、ジャイロセンサ３の出力がド
リフト成分を含んでいると判定されたときには、ヨー角
判定手段は、所定パターンにより所定微小時間積算ヨー
角の補正を行うようにしたので、ジャイロセンサ３にド
リフトが発生している場合でもドリフト成分がヨー角と
して積算されることがなく、従って、ドリフト成分に基
づく積算ヨー角の誤差累積を防止することができ、移動
距離算出における誤差増大を防止することができる。

【００４３】なお、本実施の形態では、中央制御部Ｂの
各手段４〜８、１１はハードウェア構成として説明した
が、本発明はこれに限らず、各手段４〜８、１１をソフ
トウェアで構成すること、すなわちＣＰＵがプログラム
を実行することにより各手段４〜８、１１を実現するよ
うにしてもよい。

【００４４】以上のように本実施の形態によれば、ジャ
イロセンサ２、３の出力がドリフト成分を含んでいると
判定されたときには、ピッチ角判定手段４、ヨー角判定
手段は、パターン１〜３のいずれかにより又は所定パタ
ーンにより所定微小時間積算ピッチ角、所定微小時間積
算ヨー角の補正を行うようにしたので、ジャイロセンサ
２、３にドリフトが発生している場合でもドリフト成分
がピッチ角、ヨー角として積算されることがなく、従っ
て、ドリフト成分に基づく積算ピッチ角、積算ヨー角の
誤差累積を防止することができ、移動距離算出における
誤差増大を防止することができる。

【００４５】

【発明の効果】以上のように本発明のナビゲーション装
置によれば、所定微小時間積算ピッチ角が基準値を越え
ているか否かに応じて所定微小時間積算ピッチ角を補正
することができるので、積算ピッチ角の累積誤差が増大
しないように補正することができるという有利な効果が
得られる。

【００４６】また、ピッチ角判定手段は、所定微小時間
積算ピッチ角が基準値を越えたとき、所定微小時間積算
ピッチ角を基準値に補正することにより、所定微小時間
積算ピッチ角が基準値を越えたとき発生していると推定
されるドリフト分を上記基準値により減少させることが
できるので、積算ピッチ角の累積誤差の増大を防止する
ことができるという有利な効果が得られる。

【００４７】さらに、ピッチ角判定手段は、所定微小時
間積算ピッチ角が基準値を越えたとき、所定微小時間積
算ピッチ角を測定時間当りの平均値に補正することによ
り、所定微小時間積算ピッチ角が基準値を越えたとき発
生していると推定されるドリフト分を上記平均値により
減少させることができるので、積算ピッチ角の累積誤差
の増大を防止することができるという有利な効果が得ら
れる。

【００４８】さらに、ピッチ角判定手段は、所定微小時
間積算ピッチ角が基準値を越えたとき、所定微小時間積
算ピッチ角を加速度センサ出力の加速度から推測される
値に補正することにより、所定微小時間積算ピッチ角が
基準値を越えたとき発生していると推定されるドリフト
分を加速度に基づいて減少させることができるので、積
算ピッチ角の累積誤差の増大を防止することができると
いう有利な効果が得られる。

【００４９】さらに、ピッチ角判定手段は、ＣＤ−ＲＯ
Ｍに記憶された地図の高度変化情報に基づいて基準値を
設定することにより、基準値を適正な値に設定すること
ができるという有利な効果が得られる。

【図面の簡単な説明】

【図１】本発明の実施の形態１によるナビゲーション装
置を示すブロック図

【図２】図１のナビゲーション装置の動作を示すフロー
チャート

【図３】従来のナビゲーション装置を示すブロック図

【図４】ナビゲーション装置の車両搭載状態を示す車載
概念図

【図５】位置演算の概念図

【符号の説明】

１ 加速度センサ ２、３ ジャイロセンサ ４ ピッチ角判定手段 ５ 移動距離算出手段 ６ 速度補正手段 ７ 移動方位算出手段 ８ 相対位置演算手段 ９ 表示部 １０ 地図記憶部

Claims (5)

【特許請求の範囲】
1. 【請求項１】移動体の加速度を検出する加速度センサ
   と、前記加速度センサ出力の加速度の補正を行う速度補
   正手段を有し、前記補正された加速度から移動体の移動
   速度を求め、前記移動速度を積算して移動体の移動距離
   を算出する移動距離算出手段と、移動体のピッチ角速度
   を検出するピッチ角速度検出部とを有するナビゲーショ
   ン装置であって、前記検出されたピッチ角速度を所定微
   小時間だけ積算して得られた所定微小時間積算ピッチ角
   と基準値とを比較して前記所定微小時間積算ピッチ角を
   補正するピッチ角判定手段を備えたナビゲーション装
   置。
2. 【請求項２】前記ピッチ角判定手段は、前記所定微小時
   間積算ピッチ角が前記基準値を越えたとき、前記所定微
   小時間積算ピッチ角を前記基準値に補正する請求項１に
   記載のナビゲーション装置。
3. 【請求項３】前記ピッチ角判定手段は、前記所定微小時
   間積算ピッチ角が前記基準値を越えたとき、前記所定微
   小時間積算ピッチ角を測定時間当りの平均値に補正する
   請求項１に記載のナビゲーション装置。
4. 【請求項４】前記ピッチ角判定手段は、前記所定微小時
   間積算ピッチ角が前記基準値を越えたとき、前記所定微
   小時間積算ピッチ角を前記加速度センサ出力の加速度か
   ら推測される値に補正する請求項１に記載のナビゲーシ
   ョン装置。
5. 【請求項５】前記ピッチ角判定手段は、ＣＤ−ＲＯＭに
   記憶された地図の高度変化情報に基づいて前記基準値を
   設定する請求項１乃至４のいずれか１に記載のナビゲー
   ション装置。