JPH07280575A - 車両用位置検出装置 - Google Patents
車両用位置検出装置Info
- Publication number
- JPH07280575A JPH07280575A JP6586594A JP6586594A JPH07280575A JP H07280575 A JPH07280575 A JP H07280575A JP 6586594 A JP6586594 A JP 6586594A JP 6586594 A JP6586594 A JP 6586594A JP H07280575 A JPH07280575 A JP H07280575A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- reliability
- vehicle position
- gps
- calculated
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Abstract
(57)【要約】
【目的】 車両位置と車両進行方向を精度よく検出す
る。 【構成】 車速センサ１、方位センサ２、ＧＰＳ受信機
３、ＣＰＵ５とを有する車両用位置検出装置に適用さ
れ、ＣＰＵ５は微少時間ごとに車速センサ１から出力さ
れた車速パルス数を計測し、約１００ｍｓｅｃごとに車
速パルスと方位センサ２出力とによって車両位置と車両
進行方向を検出する。またＣＰＵ５は約１ｓｅｃごとに
ＧＰＳ測定処理を行う。このＧＰＳ測定処理では、ＧＰ
Ｓ信号によって求めた車両位置と車両進行方向の各信頼
度を推定し、これら信頼度に基づいて車両位置および車
両進行方向を修正する。これにより、車両位置と車両進
行方向が精度よく求まる。
る。 【構成】 車速センサ１、方位センサ２、ＧＰＳ受信機
３、ＣＰＵ５とを有する車両用位置検出装置に適用さ
れ、ＣＰＵ５は微少時間ごとに車速センサ１から出力さ
れた車速パルス数を計測し、約１００ｍｓｅｃごとに車
速パルスと方位センサ２出力とによって車両位置と車両
進行方向を検出する。またＣＰＵ５は約１ｓｅｃごとに
ＧＰＳ測定処理を行う。このＧＰＳ測定処理では、ＧＰ
Ｓ信号によって求めた車両位置と車両進行方向の各信頼
度を推定し、これら信頼度に基づいて車両位置および車
両進行方向を修正する。これにより、車両位置と車両進
行方向が精度よく求まる。
Description
【０００１】
【産業上の利用分野】本発明は、マップマッチング手法
とＧＰＳ信号測定とによって、車両位置と車両進行方向
を検出する車両用位置検出装置に関する。
とＧＰＳ信号測定とによって、車両位置と車両進行方向
を検出する車両用位置検出装置に関する。
【０００２】
【従来の技術】走行している車両の現在位置（以下、車
両位置と呼ぶ）は、いわゆるマップマッチング手法によ
って求めることができる。この手法は、車速センサによ
って検出される車両の走行距離と、方位センサによって
検出される車両の進行方位とに基づいて車両の走行軌跡
を求めた後、ＣＤ−ＲＯＭ等に記憶されている道路地図
データの中から車両の走行軌跡と一致する道路を検索し
て車両位置を検出するものである。しかし、車速センサ
等の出力は誤差を含むため、マップマッチング手法だけ
では精度よく車両位置を検出できない。そこで、マップ
マッチング手法によって求めた車両位置を、ＧＰＳ衛星
からのＧＰＳ（Global Positioning System）信号によ
って修正する車両用位置検出装置が提案されている（特
開平２−２７５３１０号公報参照）。この種のＧＰＳ信
号を用いた車両位置測定（以下、ＧＰＳ測定と呼ぶ）
は、複数の衛星から発信されるＧＰＳ信号を受信し、各
信号に含まれる衛星の位置情報と時刻情報に基づいて各
衛星からの距離を算出し、三角測量の原理により車両位
置を求めるものである。
両位置と呼ぶ）は、いわゆるマップマッチング手法によ
って求めることができる。この手法は、車速センサによ
って検出される車両の走行距離と、方位センサによって
検出される車両の進行方位とに基づいて車両の走行軌跡
を求めた後、ＣＤ−ＲＯＭ等に記憶されている道路地図
データの中から車両の走行軌跡と一致する道路を検索し
て車両位置を検出するものである。しかし、車速センサ
等の出力は誤差を含むため、マップマッチング手法だけ
では精度よく車両位置を検出できない。そこで、マップ
マッチング手法によって求めた車両位置を、ＧＰＳ衛星
からのＧＰＳ（Global Positioning System）信号によ
って修正する車両用位置検出装置が提案されている（特
開平２−２７５３１０号公報参照）。この種のＧＰＳ信
号を用いた車両位置測定（以下、ＧＰＳ測定と呼ぶ）
は、複数の衛星から発信されるＧＰＳ信号を受信し、各
信号に含まれる衛星の位置情報と時刻情報に基づいて各
衛星からの距離を算出し、三角測量の原理により車両位
置を求めるものである。
【０００３】上記公報に記載された車両用位置検出装置
では、ＧＰＳ測定の信頼度を推定し、その信頼度に応じ
て、マップマッチング手法によって演算した車両位置
（以下、マップマッチング演算値と呼ぶ）と、ＧＰＳ信
号を用いて演算した車両位置（以下、ＧＰＳ演算値と呼
ぶ）とのいずれかを選択して車両位置を定めている。
では、ＧＰＳ測定の信頼度を推定し、その信頼度に応じ
て、マップマッチング手法によって演算した車両位置
（以下、マップマッチング演算値と呼ぶ）と、ＧＰＳ信
号を用いて演算した車両位置（以下、ＧＰＳ演算値と呼
ぶ）とのいずれかを選択して車両位置を定めている。
【０００４】以下、図９を用いてマップマッチング手法
とＧＰＳ測定とを組み合わせた従来の車両位置検出方法
を説明する。図９はディスプレイに表示される道路地図
を示し、車両位置を車両マークＭで示している。図９
（ａ）は、分岐角が小さいＹ字形状の交差点付近を車両
が走行する例を示す。車両が地点Ｐから交差点Ｑに達す
るまでは、マップマッチングが精度よく行われたとす
る。ここで、車両が交差点Ｑから左方向の経路を進んだ
ときに、マップマッチングした結果、車両が右方向の経
路を進んでいると誤って判断されたとする。このような
誤った判断は、分岐角が小さい交差点や複数の道路が近
接している場合等に特に起こりやすく、主に方位センサ
の測定誤差によって生じる。このような場合、ＧＰＳ信
号を用いて車両位置を修正することになるが、ＧＰＳ信
号によって求めた車両位置は、受信された衛星数、衛星
の天空上の配置および受信感度等により、大体数１０〜
数１００メートルの誤差を有する。
とＧＰＳ測定とを組み合わせた従来の車両位置検出方法
を説明する。図９はディスプレイに表示される道路地図
を示し、車両位置を車両マークＭで示している。図９
（ａ）は、分岐角が小さいＹ字形状の交差点付近を車両
が走行する例を示す。車両が地点Ｐから交差点Ｑに達す
るまでは、マップマッチングが精度よく行われたとす
る。ここで、車両が交差点Ｑから左方向の経路を進んだ
ときに、マップマッチングした結果、車両が右方向の経
路を進んでいると誤って判断されたとする。このような
誤った判断は、分岐角が小さい交差点や複数の道路が近
接している場合等に特に起こりやすく、主に方位センサ
の測定誤差によって生じる。このような場合、ＧＰＳ信
号を用いて車両位置を修正することになるが、ＧＰＳ信
号によって求めた車両位置は、受信された衛星数、衛星
の天空上の配置および受信感度等により、大体数１０〜
数１００メートルの誤差を有する。
【０００５】図９（ａ）の円Ｑ１は、車両が地点Ｒを走
行していると誤って判断された時点でのＧＰＳ測定の誤
差範囲を示し、誤差円とも呼ばれる。この誤差円の中心
がＧＰＳ測定による車両位置を示すが、ＧＰＳ測定だけ
では誤差円の中のどこに車両が存在するかを特定できな
い。このため、車両が誤差円の中にあるときは、ＧＰＳ
測定の結果を用いずにマップマッチング手法によって求
めた車両位置に基づいてディスプレイに車両マークを表
示する。一方、車両が地点Ｓに達すると、マップマッチ
ング手法によって求めた車両位置Ｓ１はＧＰＳ測定によ
る誤差円Ｑ２の外になる。このため、車両位置Ｓ１は誤
っていると判断され、車両位置は誤差円Ｑ２の中心位置
Ｓ２に修正される。そして、その後マップマッチング手
法によって、実際に車両が走行している経路上の地点Ｔ
に修正される。
行していると誤って判断された時点でのＧＰＳ測定の誤
差範囲を示し、誤差円とも呼ばれる。この誤差円の中心
がＧＰＳ測定による車両位置を示すが、ＧＰＳ測定だけ
では誤差円の中のどこに車両が存在するかを特定できな
い。このため、車両が誤差円の中にあるときは、ＧＰＳ
測定の結果を用いずにマップマッチング手法によって求
めた車両位置に基づいてディスプレイに車両マークを表
示する。一方、車両が地点Ｓに達すると、マップマッチ
ング手法によって求めた車両位置Ｓ１はＧＰＳ測定によ
る誤差円Ｑ２の外になる。このため、車両位置Ｓ１は誤
っていると判断され、車両位置は誤差円Ｑ２の中心位置
Ｓ２に修正される。そして、その後マップマッチング手
法によって、実際に車両が走行している経路上の地点Ｔ
に修正される。
【０００６】
【発明が解決しようとする課題】このように、マップマ
ッチング手法とＧＰＳ測定とを組み合わせた従来の車両
用位置検出装置では、通常はマップマッチング手法によ
って求めた車両位置をディスプレイに表示し、マップマ
ッチング手法による車両位置がＧＰＳ測定による誤差円
の範囲を越えると、ＧＰＳ測定に基づいて車両位置を修
正する。ところが、図示のようにＧＰＳ測定に基づいて
車両位置を修正する際に、ディスプレイ上の車両位置が
突然大きく変化するため、不自然な感じを与える。
ッチング手法とＧＰＳ測定とを組み合わせた従来の車両
用位置検出装置では、通常はマップマッチング手法によ
って求めた車両位置をディスプレイに表示し、マップマ
ッチング手法による車両位置がＧＰＳ測定による誤差円
の範囲を越えると、ＧＰＳ測定に基づいて車両位置を修
正する。ところが、図示のようにＧＰＳ測定に基づいて
車両位置を修正する際に、ディスプレイ上の車両位置が
突然大きく変化するため、不自然な感じを与える。
【０００７】またこの種の従来の車両用位置検出装置に
おいて、例えば図９（ｂ）に示すように、ＣＤ−ＲＯＭ
等の地図記憶メモリに記憶されていない経路を車両が走
行する場合、車両位置を正確に検出できないという問題
がある。図９（ｂ）において、経路Ｕは地図記憶メモリ
に記憶されているため、この経路Ｕを走行している間は
経路Ｕに沿って精度よく車両位置が検出される。一方、
車両が地図記憶メモリに記憶されていない経路Ｖに左折
すると、マップマッチングの精度が悪くなり、図示の点
線で示すように、実際の進行経路とかけ離れた位置に車
両マークが表示される。図示の地点Ｗに達すると、ＧＰ
Ｓの誤差円をはずれるため、車両位置が地点Ｘに変化
し、ここからまた点線のように、経路Ｖとかけ離れた位
置に車両マークが表示される。このように、マップマッ
チング手法を中心として車両位置を検出すると、道路地
図データが用意されていない場合等に検出位置の誤差が
大きくなる。
おいて、例えば図９（ｂ）に示すように、ＣＤ−ＲＯＭ
等の地図記憶メモリに記憶されていない経路を車両が走
行する場合、車両位置を正確に検出できないという問題
がある。図９（ｂ）において、経路Ｕは地図記憶メモリ
に記憶されているため、この経路Ｕを走行している間は
経路Ｕに沿って精度よく車両位置が検出される。一方、
車両が地図記憶メモリに記憶されていない経路Ｖに左折
すると、マップマッチングの精度が悪くなり、図示の点
線で示すように、実際の進行経路とかけ離れた位置に車
両マークが表示される。図示の地点Ｗに達すると、ＧＰ
Ｓの誤差円をはずれるため、車両位置が地点Ｘに変化
し、ここからまた点線のように、経路Ｖとかけ離れた位
置に車両マークが表示される。このように、マップマッ
チング手法を中心として車両位置を検出すると、道路地
図データが用意されていない場合等に検出位置の誤差が
大きくなる。
【０００８】これに対して、特開平２−２９６１７２号
公報に記載された装置では、マップマッチング演算値の
誤差とＧＰＳ演算値の誤差を定期的に求め、これら誤差
に基づいて車両位置を推定するようにしている。すなわ
ち、マップマッチング演算値とＧＰＳ演算値の双方の誤
差量を重み付けして車両位置を決定するため、ディスプ
レイ上の車両位置が途中で大きく変化することはない。
しかし、上記公報では、マップマッチングを行う際に用
いる方位センサの誤差を考慮に入れていないため、方位
センサの出力が誤差を含む場合には、精度の高い車両位
置検出ができない。また、マップマッチングとＧＰＳ測
定を組み合わせて車両位置を検出しても、車両進行方向
が精度よく検出できなければ、車両位置の修正後すぐに
また車両位置がずれてしまう。一方、複数の衛星から発
信されるＧＰＳ信号を受信すると、車両の位置測定がで
きるだけでなく、車両の進行方向も検出することができ
る。そこで、上述した方位センサの出力の修正も、ＧＰ
Ｓ信号を用いて行うのが望ましい。
公報に記載された装置では、マップマッチング演算値の
誤差とＧＰＳ演算値の誤差を定期的に求め、これら誤差
に基づいて車両位置を推定するようにしている。すなわ
ち、マップマッチング演算値とＧＰＳ演算値の双方の誤
差量を重み付けして車両位置を決定するため、ディスプ
レイ上の車両位置が途中で大きく変化することはない。
しかし、上記公報では、マップマッチングを行う際に用
いる方位センサの誤差を考慮に入れていないため、方位
センサの出力が誤差を含む場合には、精度の高い車両位
置検出ができない。また、マップマッチングとＧＰＳ測
定を組み合わせて車両位置を検出しても、車両進行方向
が精度よく検出できなければ、車両位置の修正後すぐに
また車両位置がずれてしまう。一方、複数の衛星から発
信されるＧＰＳ信号を受信すると、車両の位置測定がで
きるだけでなく、車両の進行方向も検出することができ
る。そこで、上述した方位センサの出力の修正も、ＧＰ
Ｓ信号を用いて行うのが望ましい。
【０００９】図１０は、ＧＰＳ信号による車両位置検
出、車速センサによる走行距離検出、ＧＰＳ信号による
車両進行方向検出および方位センサによる車両進行方向
検出の各特徴を長所・短所に分けてまとめた図である。
図１０に示すように、ＧＰＳ信号を用いて車両位置検出
を行うと、時間積分することなく絶対位置を算出できる
ため、測定するたびに誤差が累積することがなく、長期
的に見て安定した結果が得られる。一方、衛星からのＧ
ＰＳ信号が受信できなければ演算できないため、トンネ
ルやビル等の電波障害物があると演算ができなくなる。
また、ＧＰＳ信号を受信できる衛星数や衛星間の配置に
よって誤差が大きく変動する。
出、車速センサによる走行距離検出、ＧＰＳ信号による
車両進行方向検出および方位センサによる車両進行方向
検出の各特徴を長所・短所に分けてまとめた図である。
図１０に示すように、ＧＰＳ信号を用いて車両位置検出
を行うと、時間積分することなく絶対位置を算出できる
ため、測定するたびに誤差が累積することがなく、長期
的に見て安定した結果が得られる。一方、衛星からのＧ
ＰＳ信号が受信できなければ演算できないため、トンネ
ルやビル等の電波障害物があると演算ができなくなる。
また、ＧＰＳ信号を受信できる衛星数や衛星間の配置に
よって誤差が大きく変動する。
【００１０】一方、車速センサは、車両の走行距離を正
確に算出できるが、タイヤ交換やタイヤの磨耗等によっ
てタイヤ径が変化すると、正確な走行距離を算出できな
くなる。また、ＧＰＳ信号を用いて車両の進行方向を検
出すると、絶対方位を安定して検出できるが、車速が約
２０ｋｍ以下になると正確な方位を検出できなくなる。
一方、方位センサは、車両に発生した角速度を測定して
車両進行方向を検出するため、微少な方位変化も精度よ
く検出できるが、測定した角速度を時間積分して車両進
行方向を求めるため、ゼロレベル調整を行ってからの時
間が長いほど、信頼度が低下する。
確に算出できるが、タイヤ交換やタイヤの磨耗等によっ
てタイヤ径が変化すると、正確な走行距離を算出できな
くなる。また、ＧＰＳ信号を用いて車両の進行方向を検
出すると、絶対方位を安定して検出できるが、車速が約
２０ｋｍ以下になると正確な方位を検出できなくなる。
一方、方位センサは、車両に発生した角速度を測定して
車両進行方向を検出するため、微少な方位変化も精度よ
く検出できるが、測定した角速度を時間積分して車両進
行方向を求めるため、ゼロレベル調整を行ってからの時
間が長いほど、信頼度が低下する。
【００１１】このように、各センサ等にはそれぞれ長所
・短所があるため、それぞれの長所をうまく利用して車
両の位置検出および進行方向検出を行うのが望ましい。
例えば、トンネル等のＧＰＳ信号が受信できない地域を
走行する場合には、ＧＰＳ信号を用いずに位置検出を行
い、一方タイヤが磨耗している場合等は車速センサ出力
を用いずに位置検出を行うのが望ましい。
・短所があるため、それぞれの長所をうまく利用して車
両の位置検出および進行方向検出を行うのが望ましい。
例えば、トンネル等のＧＰＳ信号が受信できない地域を
走行する場合には、ＧＰＳ信号を用いずに位置検出を行
い、一方タイヤが磨耗している場合等は車速センサ出力
を用いずに位置検出を行うのが望ましい。
【００１２】本発明の目的は、ＧＰＳ信号に基づく車両
位置検出の信頼度と、車両に発生した角速度検出の信頼
度を推定することにより、車両位置を精度よく検出でき
るようにした車両用位置検出装置を提供することにあ
る。また、本発明の他の目的は、ＧＰＳ信号に基づく車
両進行方向検出の信頼度と、車両に発生した角速度検出
の信頼度を推定することにより、車両進行方向を精度よ
く検出できるようにした車両用位置検出装置を提供する
ことにある。
位置検出の信頼度と、車両に発生した角速度検出の信頼
度を推定することにより、車両位置を精度よく検出でき
るようにした車両用位置検出装置を提供することにあ
る。また、本発明の他の目的は、ＧＰＳ信号に基づく車
両進行方向検出の信頼度と、車両に発生した角速度検出
の信頼度を推定することにより、車両進行方向を精度よ
く検出できるようにした車両用位置検出装置を提供する
ことにある。
【００１３】
【課題を解決するための手段】実施例を示す図１に対応
づけて本発明を説明すると、本発明は、車両に発生した
角速度を検出する角速度検出手段２と、車両の走行速度
を検出する車速検出手段１と、道路地図データを記憶す
る地図記憶手段４と、角速度、走行速度および道路地図
データに基づいて車両位置を演算する車両位置演算手段
５とを備える車両用位置検出装置に適用され、ＧＰＳ信
号を受信する受信手段３と、ＧＰＳ信号に基づいて車両
位置を演算するＧＰＳ位置演算手段５と、ＧＰＳ位置演
算手段５によって演算された車両位置の信頼度を推定す
るＧＰＳ位置信頼度推定手段５と、角速度検出手段２に
よって検出された角速度の信頼度を推定する角速度信頼
度推定手段５と、ＧＰＳ位置信頼度推定手段５によって
推定された信頼度と、角速度信頼度推定手段５によって
推定された信頼度と、ＧＰＳ位置演算手段５によって演
算された車両位置とに基づいて、車両位置演算手段５に
よって演算された車両位置を修正する車両位置修正手段
５とを備えることにより上記目的は達成される。請求項
２に記載された発明は、請求項１に記載された車両用位
置検出装置において、角速度のゼロレベル調整を行って
からの経過時間に基づいて信頼度を推定するように角速
度信頼度推定手段５を構成するものである。請求項３に
記載された発明は、請求項１または２に記載された車両
用位置検出装置において、ＧＰＳ位置信頼度推定手段５
によって推定された信頼度が高いほど、また角速度信頼
度推定手段５によって推定された信頼度が低いほど、車
両位置演算手段５によって演算された車両位置をＧＰＳ
位置演算手段５によって演算された車両位置に近づける
ように修正するように車両位置修正手段５を構成するも
のである。請求項４に記載された発明は、請求項１〜３
のいずれかに記載された車両用位置検出装置において、
車両位置修正手段５による車両位置の修正は繰り返し行
われ、車両位置修正手段５によって修正された車両位置
を記憶する車両位置記憶手段７と、車両位置演算手段５
によって演算された車両位置と、車両位置記憶手段７に
記憶された車両位置との距離差および方向差を演算する
第１距離差方向差演算手段５と、ＧＰＳ位置演算手段５
によって演算された車両位置と車両位置記憶手段７に記
憶された車両位置との距離差および方向差を演算する第
２距離差方向差演算手段５と、ＧＰＳ位置信頼度推定手
段５によって推定された信頼度と角速度信頼度推定手段
５によって推定された信頼度とに応じて変化する修正係
数を演算する修正係数演算手段５とを備え、第１距離差
方向差演算手段５によって演算された距離差および方向
差と、第２距離差方向差演算手段５によって演算された
距離差および方向差と、修正係数演算手段５によって演
算された修正係数とに基づいて、車両位置演算手段５に
よって演算された車両位置を修正するように車両位置修
正手段５を構成するものである。
づけて本発明を説明すると、本発明は、車両に発生した
角速度を検出する角速度検出手段２と、車両の走行速度
を検出する車速検出手段１と、道路地図データを記憶す
る地図記憶手段４と、角速度、走行速度および道路地図
データに基づいて車両位置を演算する車両位置演算手段
５とを備える車両用位置検出装置に適用され、ＧＰＳ信
号を受信する受信手段３と、ＧＰＳ信号に基づいて車両
位置を演算するＧＰＳ位置演算手段５と、ＧＰＳ位置演
算手段５によって演算された車両位置の信頼度を推定す
るＧＰＳ位置信頼度推定手段５と、角速度検出手段２に
よって検出された角速度の信頼度を推定する角速度信頼
度推定手段５と、ＧＰＳ位置信頼度推定手段５によって
推定された信頼度と、角速度信頼度推定手段５によって
推定された信頼度と、ＧＰＳ位置演算手段５によって演
算された車両位置とに基づいて、車両位置演算手段５に
よって演算された車両位置を修正する車両位置修正手段
５とを備えることにより上記目的は達成される。請求項
２に記載された発明は、請求項１に記載された車両用位
置検出装置において、角速度のゼロレベル調整を行って
からの経過時間に基づいて信頼度を推定するように角速
度信頼度推定手段５を構成するものである。請求項３に
記載された発明は、請求項１または２に記載された車両
用位置検出装置において、ＧＰＳ位置信頼度推定手段５
によって推定された信頼度が高いほど、また角速度信頼
度推定手段５によって推定された信頼度が低いほど、車
両位置演算手段５によって演算された車両位置をＧＰＳ
位置演算手段５によって演算された車両位置に近づける
ように修正するように車両位置修正手段５を構成するも
のである。請求項４に記載された発明は、請求項１〜３
のいずれかに記載された車両用位置検出装置において、
車両位置修正手段５による車両位置の修正は繰り返し行
われ、車両位置修正手段５によって修正された車両位置
を記憶する車両位置記憶手段７と、車両位置演算手段５
によって演算された車両位置と、車両位置記憶手段７に
記憶された車両位置との距離差および方向差を演算する
第１距離差方向差演算手段５と、ＧＰＳ位置演算手段５
によって演算された車両位置と車両位置記憶手段７に記
憶された車両位置との距離差および方向差を演算する第
２距離差方向差演算手段５と、ＧＰＳ位置信頼度推定手
段５によって推定された信頼度と角速度信頼度推定手段
５によって推定された信頼度とに応じて変化する修正係
数を演算する修正係数演算手段５とを備え、第１距離差
方向差演算手段５によって演算された距離差および方向
差と、第２距離差方向差演算手段５によって演算された
距離差および方向差と、修正係数演算手段５によって演
算された修正係数とに基づいて、車両位置演算手段５に
よって演算された車両位置を修正するように車両位置修
正手段５を構成するものである。
【００１４】請求項５に記載された発明は、車両に発生
した角速度を検出する角速度検出手段２と、角速度に基
づいて車両進行方向を演算する車両進行方向演算手段５
とを備える車両用位置検出装置に適用され、ＧＰＳ信号
を受信する受信手段３と、ＧＰＳ信号に基づいて車両進
行方向を演算するＧＰＳ方位演算手段５と、このＧＰＳ
方位演算手段５によって演算された車両進行方向の信頼
度を推定するＧＰＳ方位信頼度推定手段５と、このＧＰ
Ｓ方位信頼度推定手段５によって信頼度と、ＧＰＳ方位
演算手段５によって演算された車両進行方向とに基づい
て、車両進行方向演算手段５によって演算された車両進
行方向を修正する車両進行方向修正手段５とを備えるこ
とにより、上記目的は達成される。請求項６に記載され
た発明は、請求項５に記載された車両用位置検出装置に
おいて、車両の走行速度に基づいて信頼度を推定するよ
うにＧＰＳ方位信頼度推定手段５を構成するものであ
る。請求項７に記載された発明は、請求項５または６に
記載された車両用位置検出装置において、ＧＰＳ方位信
頼度推定手段５によって推定された信頼度が高いほど、
あるいは角速度信頼度推定手段５によって推定された信
頼度が低いほど、車両進行方位演算手段によって演算さ
れた車両進行方向をＧＰＳ方位演算手段５によって演算
された車両進行方向に近づけるように修正するように車
両進行方向修正手段５を構成するものである。請求項８
に記載された発明は、請求項５〜７のいずれかに記載さ
れた車両用位置検出装置において、車両進行方向演算手
段５によって演算された車両進行方向と、ＧＰＳ方位演
算手段５によって演算された車両進行方向との方向差を
演算する方向差演算手段５と、ＧＰＳ方位信頼度推定手
段５によって推定された信頼度と、角速度信頼度推定手
段５によって推定された信頼度とに応じて変化する修正
係数を演算する修正係数演算手段５とを備え、方向差演
算手段５によって演算された方向差と修正係数演算手段
５によって演算された修正係数とに基づいて、車両進行
方向演算手段５によって演算された車両進行方向を修正
するように車両進行方向推定手段を構成するものであ
る。
した角速度を検出する角速度検出手段２と、角速度に基
づいて車両進行方向を演算する車両進行方向演算手段５
とを備える車両用位置検出装置に適用され、ＧＰＳ信号
を受信する受信手段３と、ＧＰＳ信号に基づいて車両進
行方向を演算するＧＰＳ方位演算手段５と、このＧＰＳ
方位演算手段５によって演算された車両進行方向の信頼
度を推定するＧＰＳ方位信頼度推定手段５と、このＧＰ
Ｓ方位信頼度推定手段５によって信頼度と、ＧＰＳ方位
演算手段５によって演算された車両進行方向とに基づい
て、車両進行方向演算手段５によって演算された車両進
行方向を修正する車両進行方向修正手段５とを備えるこ
とにより、上記目的は達成される。請求項６に記載され
た発明は、請求項５に記載された車両用位置検出装置に
おいて、車両の走行速度に基づいて信頼度を推定するよ
うにＧＰＳ方位信頼度推定手段５を構成するものであ
る。請求項７に記載された発明は、請求項５または６に
記載された車両用位置検出装置において、ＧＰＳ方位信
頼度推定手段５によって推定された信頼度が高いほど、
あるいは角速度信頼度推定手段５によって推定された信
頼度が低いほど、車両進行方位演算手段によって演算さ
れた車両進行方向をＧＰＳ方位演算手段５によって演算
された車両進行方向に近づけるように修正するように車
両進行方向修正手段５を構成するものである。請求項８
に記載された発明は、請求項５〜７のいずれかに記載さ
れた車両用位置検出装置において、車両進行方向演算手
段５によって演算された車両進行方向と、ＧＰＳ方位演
算手段５によって演算された車両進行方向との方向差を
演算する方向差演算手段５と、ＧＰＳ方位信頼度推定手
段５によって推定された信頼度と、角速度信頼度推定手
段５によって推定された信頼度とに応じて変化する修正
係数を演算する修正係数演算手段５とを備え、方向差演
算手段５によって演算された方向差と修正係数演算手段
５によって演算された修正係数とに基づいて、車両進行
方向演算手段５によって演算された車両進行方向を修正
するように車両進行方向推定手段を構成するものであ
る。
【００１５】
【作用】請求項１に記載の発明では、角速度、走行速度
および道路地図データに基づいて、車両位置演算手段５
によって車両位置を演算する。車両位置修正手段５は、
ＧＰＳ位置信頼度推定手段５によって推定された信頼度
と、角速度信頼度推定手段５によって推定された信頼度
と、ＧＰＳ位置演算手段５によって演算された車両位置
とに基づいて、車両位置演算手段５が演算した車両位置
を修正する。これにより、車両位置が正確に算出され
る。請求項２に記載の発明では、角速度のゼロレベル調
整を行ってからの経過時間が長いほど、角速度検出手段
２によって検出される角速度の信頼度が低下するため、
この経過時間の長さによって角速度信頼度推定手段５は
信頼度を推定する。請求項３に記載の発明では、ＧＰＳ
位置信頼度推定手段５によって推定された信頼度が高い
ほど、また角速度信頼度推定手段５によって推定された
信頼度が低いほど、車両位置演算手段５によって演算さ
れた車両位置よりも、ＧＰＳ位置演算手段５によって演
算された車両位置の方が信頼度が高くなるため、このよ
うな場合、車両位置修正手段５はＧＰＳ位置演算手段５
によって演算された車両位置に近い位置に車両位置を修
正する。請求項４に記載の発明では、車両位置の修正を
繰り返し行い、修正した車両位置を車両位置記憶手段７
に記憶する。第１距離差方向差演算手段５は、車両位置
演算手段５によって演算された車両位置と車両位置記憶
手段７に記憶された車両位置との距離差および方向差を
演算し、第２距離差方向差演算手段５は、ＧＰＳ位置演
算手段５によって演算された車両位置と車両位置記憶手
段７に記憶された車両位置との距離差および方向差を演
算する。また修正係数演算手段５は、ＧＰＳ位置信頼度
推定手段５によって推定された信頼度と角速度信頼度推
定手段５によって推定された信頼度とに応じて変化する
修正係数を演算する。そして、車両位置修正手段５は、
第１距離差方向差演算手段５によって演算された距離差
および方向差と、第２距離差方向差演算手段５によって
演算された距離差および方向差と、修正係数演算手段５
によって演算された修正係数とに基づいて、車両位置演
算手段５によって演算された車両位置を修正する。
および道路地図データに基づいて、車両位置演算手段５
によって車両位置を演算する。車両位置修正手段５は、
ＧＰＳ位置信頼度推定手段５によって推定された信頼度
と、角速度信頼度推定手段５によって推定された信頼度
と、ＧＰＳ位置演算手段５によって演算された車両位置
とに基づいて、車両位置演算手段５が演算した車両位置
を修正する。これにより、車両位置が正確に算出され
る。請求項２に記載の発明では、角速度のゼロレベル調
整を行ってからの経過時間が長いほど、角速度検出手段
２によって検出される角速度の信頼度が低下するため、
この経過時間の長さによって角速度信頼度推定手段５は
信頼度を推定する。請求項３に記載の発明では、ＧＰＳ
位置信頼度推定手段５によって推定された信頼度が高い
ほど、また角速度信頼度推定手段５によって推定された
信頼度が低いほど、車両位置演算手段５によって演算さ
れた車両位置よりも、ＧＰＳ位置演算手段５によって演
算された車両位置の方が信頼度が高くなるため、このよ
うな場合、車両位置修正手段５はＧＰＳ位置演算手段５
によって演算された車両位置に近い位置に車両位置を修
正する。請求項４に記載の発明では、車両位置の修正を
繰り返し行い、修正した車両位置を車両位置記憶手段７
に記憶する。第１距離差方向差演算手段５は、車両位置
演算手段５によって演算された車両位置と車両位置記憶
手段７に記憶された車両位置との距離差および方向差を
演算し、第２距離差方向差演算手段５は、ＧＰＳ位置演
算手段５によって演算された車両位置と車両位置記憶手
段７に記憶された車両位置との距離差および方向差を演
算する。また修正係数演算手段５は、ＧＰＳ位置信頼度
推定手段５によって推定された信頼度と角速度信頼度推
定手段５によって推定された信頼度とに応じて変化する
修正係数を演算する。そして、車両位置修正手段５は、
第１距離差方向差演算手段５によって演算された距離差
および方向差と、第２距離差方向差演算手段５によって
演算された距離差および方向差と、修正係数演算手段５
によって演算された修正係数とに基づいて、車両位置演
算手段５によって演算された車両位置を修正する。
【００１６】請求項５に記載の発明では、角速度検出手
段２によって検出された角速度に基づいて、車両進行方
向演算手段５によって車両進行方向を演算する。車両進
行方向演算手段５は、ＧＰＳ方位信頼度推定手段５によ
って演算された信頼度と、ＧＰＳ方位演算手段５によっ
て演算された車両進行方向とに基づいて、車両進行方向
演算手段５が演算した車両進行方向を修正する。これに
より、車両進行方向が正確に算出される。請求項６に記
載の発明では、一般に車両の走行速度が低くなると、Ｇ
ＰＳ方位演算手段５によって演算される車両進行方向の
精度は悪くなるため、ＧＰＳ方位信頼度推定手段５は、
車両の走行速度に基づいて信頼度を推定する。請求項７
に記載の発明では、ＧＰＳ方位信頼度推定手段５によっ
て推定された信頼度が高いほど、また角速度信頼度推定
手段５によって推定された信頼度が低いほど、車両進行
方向演算手段５によって演算された車両進行方向より
も、ＧＰＳ方位演算手段５によって演算された車両進行
方向の方が信頼度が高くなるため、このような場合、車
両進行方向修正手段５はＧＰＳ方位演算手段５によって
演算された車両進行方向に近い位置に車両進行方向を修
正する。請求項８に記載の発明では、車両進行方向演算
手段５によって演算された車両進行方向とＧＰＳ方位演
算手段５によって演算された車両進行方向との方向差を
方向差演算手段５によって演算する。修正係数演算手段
５は、ＧＰＳ方位信頼度推定手段５によって推定された
信頼度と角速度信頼度推定手段５によって推定された信
頼度とに応じて変化する修正係数を演算する。そして車
両位置修正手段５は、方向差演算手段５によって演算さ
れた方向差と修正係数演算手段５によって演算された修
正係数とに基づいて、車両進行方向演算手段５によって
演算された車両進行方向を修正する。
段２によって検出された角速度に基づいて、車両進行方
向演算手段５によって車両進行方向を演算する。車両進
行方向演算手段５は、ＧＰＳ方位信頼度推定手段５によ
って演算された信頼度と、ＧＰＳ方位演算手段５によっ
て演算された車両進行方向とに基づいて、車両進行方向
演算手段５が演算した車両進行方向を修正する。これに
より、車両進行方向が正確に算出される。請求項６に記
載の発明では、一般に車両の走行速度が低くなると、Ｇ
ＰＳ方位演算手段５によって演算される車両進行方向の
精度は悪くなるため、ＧＰＳ方位信頼度推定手段５は、
車両の走行速度に基づいて信頼度を推定する。請求項７
に記載の発明では、ＧＰＳ方位信頼度推定手段５によっ
て推定された信頼度が高いほど、また角速度信頼度推定
手段５によって推定された信頼度が低いほど、車両進行
方向演算手段５によって演算された車両進行方向より
も、ＧＰＳ方位演算手段５によって演算された車両進行
方向の方が信頼度が高くなるため、このような場合、車
両進行方向修正手段５はＧＰＳ方位演算手段５によって
演算された車両進行方向に近い位置に車両進行方向を修
正する。請求項８に記載の発明では、車両進行方向演算
手段５によって演算された車両進行方向とＧＰＳ方位演
算手段５によって演算された車両進行方向との方向差を
方向差演算手段５によって演算する。修正係数演算手段
５は、ＧＰＳ方位信頼度推定手段５によって推定された
信頼度と角速度信頼度推定手段５によって推定された信
頼度とに応じて変化する修正係数を演算する。そして車
両位置修正手段５は、方向差演算手段５によって演算さ
れた方向差と修正係数演算手段５によって演算された修
正係数とに基づいて、車両進行方向演算手段５によって
演算された車両進行方向を修正する。
【００１７】なお、本発明の構成を説明する上記課題を
解決するための手段と作用の項では、本発明を分かり易
くするために実施例の図を用いたが、これにより本発明
が実施例に限定されるものではない。
解決するための手段と作用の項では、本発明を分かり易
くするために実施例の図を用いたが、これにより本発明
が実施例に限定されるものではない。
【００１８】
【実施例】図１は本発明による車両用経路誘導装置の一
実施例のブロック図である。図１において、１は車速を
検出する車速センサであり、例えば車両のトランスミッ
ションに取り付けられ、車輪の１回転当たり所定数のパ
ルスを出力する。２は車両の進行方向を検出する方位セ
ンサであり、車両のヨー方向の角速度を出力する。この
角速度を積分することで車両進行方向が検出される。３
は不図示のＧＰＳ衛星からのＧＰＳ信号を受信するＧＰ
Ｓ受信機である。４は交差点ネットワークデータを含む
道路地図データを記憶する地図記憶メモリであり、交差
点やカーブ地点を示すノードの位置情報、ノード間を接
続する道路（リンク）の経路長および地名等の文字情報
等を記憶する。５は、後述する図２〜５の処理を行うＣ
ＰＵ、６はＣＰＵ５が実行する制御プログラム等を記憶
するＲＯＭ、７はＣＰＵ５による演算結果等を記憶する
ＲＡＭである。８は目的地等を入力する操作ボード、９
はＣＰＵ５によって作成された画像データを記憶するＶ
−ＲＡＭであり、このＶ−ＲＡＭ９に記憶された内容に
応じてディスプレイ１０に絵文字情報が表示される。上
述した車速センサ１、方位センサ２、ＧＰＳ受信機３、
地図記憶メモリ４、ＣＰＵ５、ＲＯＭ６、ＲＡＭ７、操
作ボード８、Ｖ−ＲＡＭ９およびディスプレイ１０はイ
ンタフェース回路１１を介して相互に信号のやり取りを
行う。
実施例のブロック図である。図１において、１は車速を
検出する車速センサであり、例えば車両のトランスミッ
ションに取り付けられ、車輪の１回転当たり所定数のパ
ルスを出力する。２は車両の進行方向を検出する方位セ
ンサであり、車両のヨー方向の角速度を出力する。この
角速度を積分することで車両進行方向が検出される。３
は不図示のＧＰＳ衛星からのＧＰＳ信号を受信するＧＰ
Ｓ受信機である。４は交差点ネットワークデータを含む
道路地図データを記憶する地図記憶メモリであり、交差
点やカーブ地点を示すノードの位置情報、ノード間を接
続する道路（リンク）の経路長および地名等の文字情報
等を記憶する。５は、後述する図２〜５の処理を行うＣ
ＰＵ、６はＣＰＵ５が実行する制御プログラム等を記憶
するＲＯＭ、７はＣＰＵ５による演算結果等を記憶する
ＲＡＭである。８は目的地等を入力する操作ボード、９
はＣＰＵ５によって作成された画像データを記憶するＶ
−ＲＡＭであり、このＶ−ＲＡＭ９に記憶された内容に
応じてディスプレイ１０に絵文字情報が表示される。上
述した車速センサ１、方位センサ２、ＧＰＳ受信機３、
地図記憶メモリ４、ＣＰＵ５、ＲＯＭ６、ＲＡＭ７、操
作ボード８、Ｖ−ＲＡＭ９およびディスプレイ１０はイ
ンタフェース回路１１を介して相互に信号のやり取りを
行う。
【００１９】図２〜５はいずれもＣＰＵ５が行う割り込
み処理であり、図２は車速パルス計測処理、図３は車両
位置更新処理、図４，５はＧＰＳ測定処理を示す。ＣＰ
Ｕ５は不図示のイグニションキーがオン位置に操作され
ると、不図示のメイン処理によって車両各部の電気機器
を制御し、所定時間ごとに図２〜５の割り込み処理を行
う。例えば、図２の車速パルス計測処理は約１ｍｓごと
に、図３の車両位置更新処理は約１００ｍｓごとに、図
４，５のＧＰＳ測定処理は約１ｓｅｃごとに行われる。
ただし、トンネル等のＧＰＳ信号を受信できない地域を
車両が走行する場合には、図４，５の処理間隔は長くな
る。
み処理であり、図２は車速パルス計測処理、図３は車両
位置更新処理、図４，５はＧＰＳ測定処理を示す。ＣＰ
Ｕ５は不図示のイグニションキーがオン位置に操作され
ると、不図示のメイン処理によって車両各部の電気機器
を制御し、所定時間ごとに図２〜５の割り込み処理を行
う。例えば、図２の車速パルス計測処理は約１ｍｓごと
に、図３の車両位置更新処理は約１００ｍｓごとに、図
４，５のＧＰＳ測定処理は約１ｓｅｃごとに行われる。
ただし、トンネル等のＧＰＳ信号を受信できない地域を
車両が走行する場合には、図４，５の処理間隔は長くな
る。
【００２０】以下、これらの図に基づいて、本実施例の
動作を説明する。図２に示す車速パルス計測処理は、車
速センサ１からパルスが出力されるごとに行われる。ス
テップＳ１では、車速センサ１から出力されるパルス数
を計測してリターンする。パルス数を計測する変数には
Ｃ１とＣ２の２種類があり、いずれも１加算する。
動作を説明する。図２に示す車速パルス計測処理は、車
速センサ１からパルスが出力されるごとに行われる。ス
テップＳ１では、車速センサ１から出力されるパルス数
を計測してリターンする。パルス数を計測する変数には
Ｃ１とＣ２の２種類があり、いずれも１加算する。
【００２１】一方、図３に示す車両位置更新処理のステ
ップＳ１１では、方位センサ２の出力である角速度ｄθ
／ｄｔを測定する。ステップＳ１２では、図２のステッ
プＳ１で車速パルス数を計測している変数Ｃ１の値を変
数Ｃ３に代入した後、変数Ｃ１の値をゼロにする。した
がって、変数Ｃ１はこの時点以降の車速パルス数を計測
する。すなわち、変数Ｃ１では車両位置更新処理を行っ
てから次に車両位置更新処理を行うまでの車速パルス数
が計測される。ステップＳ１３では、（１）式に基づい
て車両進行方向θを演算する。なお、θ１は前回演算し
た車両進行方向を示す。また、ΔＴは車両位置更新処理
を繰り返す時間間隔であり、例えば１００ｍｓである。
ップＳ１１では、方位センサ２の出力である角速度ｄθ
／ｄｔを測定する。ステップＳ１２では、図２のステッ
プＳ１で車速パルス数を計測している変数Ｃ１の値を変
数Ｃ３に代入した後、変数Ｃ１の値をゼロにする。した
がって、変数Ｃ１はこの時点以降の車速パルス数を計測
する。すなわち、変数Ｃ１では車両位置更新処理を行っ
てから次に車両位置更新処理を行うまでの車速パルス数
が計測される。ステップＳ１３では、（１）式に基づい
て車両進行方向θを演算する。なお、θ１は前回演算し
た車両進行方向を示す。また、ΔＴは車両位置更新処理
を繰り返す時間間隔であり、例えば１００ｍｓである。
【数１】 θ＝θ１＋ΔＴ×ｄθ／ｄｔ ・・・（１）
【００２２】ステップＳ１４では、（２），（３）式に
基づいて車両位置Ｓ（Ｘ，Ｙ）を演算する。なお、
（２），（３）式のΔＤは、車速パルスが発生してから
次に車速パルスが発生するまでの間に車両が走行する距
離を示し、Ｘ１，Ｙ１はそれぞれ、前回演算した車両位
置のＸ座標、Ｙ座標を示す。
基づいて車両位置Ｓ（Ｘ，Ｙ）を演算する。なお、
（２），（３）式のΔＤは、車速パルスが発生してから
次に車速パルスが発生するまでの間に車両が走行する距
離を示し、Ｘ１，Ｙ１はそれぞれ、前回演算した車両位
置のＸ座標、Ｙ座標を示す。
【数２】 Ｘ＝Ｘ１＋Ｃ３×ΔＤ×ｃｏｓθ ・・・（２） Ｙ＝Ｙ１＋Ｃ３×ΔＤ×ｓｉｎθ ・・・（３） ステップＳ１５では、変数Ｘ，Ｙの値をそれぞれ変数Ｘ
１，Ｙ１に代入してリターンする。上記（１）〜（３）
式の変数θ１，Ｘ１，Ｙ１は原則として前回の車両位置
更新処理での演算値を用いるが、前回の演算から今回の
演算までの間に、後述するＧＰＳ測定処理が行われた場
合は、ＧＰＳ測定処理の演算結果を用いる。
１，Ｙ１に代入してリターンする。上記（１）〜（３）
式の変数θ１，Ｘ１，Ｙ１は原則として前回の車両位置
更新処理での演算値を用いるが、前回の演算から今回の
演算までの間に、後述するＧＰＳ測定処理が行われた場
合は、ＧＰＳ測定処理の演算結果を用いる。
【００２３】このように、図３の車両位置更新処理で
は、一定時間ごとに、前回の演算結果またはＧＰＳ測定
結果を用いて車両の進行方向θと車両位置Ｓの座標を更
新するため、車両位置および進行方向を精度よく検出で
きる。
は、一定時間ごとに、前回の演算結果またはＧＰＳ測定
結果を用いて車両の進行方向θと車両位置Ｓの座標を更
新するため、車両位置および進行方向を精度よく検出で
きる。
【００２４】図４に示すＧＰＳ測定処理のステップＳ２
１では、変数Ｄに格納されている前回演算した車両位置
座標を変数Ａに代入する。ステップＳ２２では、図３の
ステップＳ１４で演算した現在の車両位置座標Ｓを変数
Ｂに代入する。ステップＳ２３では、ＧＰＳ信号を受信
し、その受信結果に基づいて車両位置座標を演算し、そ
の結果を変数Ｇに代入する。この場合の変数Ａ，Ｂ，Ｇ
の位置関係は、例えば図６（ａ）のようになる。ステッ
プＳ２４では、（４），（５）式に基づいて距離誤差Δ
Ｌと方位誤差Δθを求める。
１では、変数Ｄに格納されている前回演算した車両位置
座標を変数Ａに代入する。ステップＳ２２では、図３の
ステップＳ１４で演算した現在の車両位置座標Ｓを変数
Ｂに代入する。ステップＳ２３では、ＧＰＳ信号を受信
し、その受信結果に基づいて車両位置座標を演算し、そ
の結果を変数Ｇに代入する。この場合の変数Ａ，Ｂ，Ｇ
の位置関係は、例えば図６（ａ）のようになる。ステッ
プＳ２４では、（４），（５）式に基づいて距離誤差Δ
Ｌと方位誤差Δθを求める。
【数３】ΔＬ＝ＡＧ−ＡＢ ・・・（４） Δθ＝∠ＧＡＢ ・・・（５）
【００２５】ステップＳ２５では、（６）式に基づいて
位置修正係数ｋIを求める。
位置修正係数ｋIを求める。
【数４】 （６）式に示すｒGPS、ｒgはそれぞれＧＰＳ位置信頼
度、方位センサ信頼度を示し、図７（ａ），（ｂ）に示
すような特性を有する。図７（ａ）の横軸の単位である
ＤＯＰはDilution of Precisionの略であり、ＧＰＳ信
号による位置検出の精度を示す係数である。このＤＯＰ
とＧＰＳ位置信頼度ｒGPSはほぼ線形の関係にあり、Ｄ
ＯＰが小さいほどＧＰＳ位置信頼度ｒGPSは高くなる。
一方、図７（ｂ）に示す方位センサ信頼度ｒgは時間の
関数で表され、時間が経過するに従って信頼度が低下す
る。これは、方位センサ２を用いて車両進行方向を検出
する場合、方位センサ２の出力である角速度を時間積分
する必要があり、方位センサ２出力に温度ドリフト等に
よるオフセット誤差が含まれていると、時間積分する時
間が長いほど誤差量が多くなるためである。
度、方位センサ信頼度を示し、図７（ａ），（ｂ）に示
すような特性を有する。図７（ａ）の横軸の単位である
ＤＯＰはDilution of Precisionの略であり、ＧＰＳ信
号による位置検出の精度を示す係数である。このＤＯＰ
とＧＰＳ位置信頼度ｒGPSはほぼ線形の関係にあり、Ｄ
ＯＰが小さいほどＧＰＳ位置信頼度ｒGPSは高くなる。
一方、図７（ｂ）に示す方位センサ信頼度ｒgは時間の
関数で表され、時間が経過するに従って信頼度が低下す
る。これは、方位センサ２を用いて車両進行方向を検出
する場合、方位センサ２の出力である角速度を時間積分
する必要があり、方位センサ２出力に温度ドリフト等に
よるオフセット誤差が含まれていると、時間積分する時
間が長いほど誤差量が多くなるためである。
【００２６】したがって、方位センサ２は所定時間ごと
にゼロレベル調整を行う必要があり、ゼロレベル調整を
行うと、図７（ｂ）のように信頼度が向上する。なお、
ゼロレベル調整とは、車両に角速度が発生していない状
態で方位センサ２の出力がゼロになるように調整するこ
とをいい、一般には車両停止中に行われる。一方、ゼロ
レベル調整の代わりに、ＧＰＳ信号による方位検出結
果、マップマッチングによる方位検出結果、あるいはビ
ーコン等による方位検出結果等を用いて車両走行中に方
位センサ２出力の調整を行ってもよいが、図７（ｂ）に
示すように、調整後の信頼度はゼロレベル調整後の信頼
度よりも悪い。
にゼロレベル調整を行う必要があり、ゼロレベル調整を
行うと、図７（ｂ）のように信頼度が向上する。なお、
ゼロレベル調整とは、車両に角速度が発生していない状
態で方位センサ２の出力がゼロになるように調整するこ
とをいい、一般には車両停止中に行われる。一方、ゼロ
レベル調整の代わりに、ＧＰＳ信号による方位検出結
果、マップマッチングによる方位検出結果、あるいはビ
ーコン等による方位検出結果等を用いて車両走行中に方
位センサ２出力の調整を行ってもよいが、図７（ｂ）に
示すように、調整後の信頼度はゼロレベル調整後の信頼
度よりも悪い。
【００２７】（６）式の中の積分では、前回ＧＰＳ測定
処理を行った時間ｔから現在の時間ｔ＋αまでの間に、
方位センサ信頼度ｒgがどの程度低下したかが演算され
る。この積分によって求められる量は、図７（ｂ）の斜
線部で示される。すなわち、（６）式の積分値が大きい
ほど、方位センサ信頼度ｒgが低いことを示す。したが
って、例えば、トンネル等の長時間ＧＰＳ演算ができな
い地域を車両が走行すると、この積分値が大きくなり、
方位センサ信頼度ｒgは低下する。また、（６）式の関
数ｆは、ＧＰＳ位置信頼度ｒGPSが高いほど、または方
位センサ信頼度ｒgが低いほど大きくなるように予め設
定される。したがって、位置修正係数ｋIは、ＧＰＳ演
算による位置検出の信頼度ｒGPSと方位センサ出力の信
頼度ｒgとに応じて変化する。なお、０≦ｋI≦１となる
ように、関数ｆは設定される。
処理を行った時間ｔから現在の時間ｔ＋αまでの間に、
方位センサ信頼度ｒgがどの程度低下したかが演算され
る。この積分によって求められる量は、図７（ｂ）の斜
線部で示される。すなわち、（６）式の積分値が大きい
ほど、方位センサ信頼度ｒgが低いことを示す。したが
って、例えば、トンネル等の長時間ＧＰＳ演算ができな
い地域を車両が走行すると、この積分値が大きくなり、
方位センサ信頼度ｒgは低下する。また、（６）式の関
数ｆは、ＧＰＳ位置信頼度ｒGPSが高いほど、または方
位センサ信頼度ｒgが低いほど大きくなるように予め設
定される。したがって、位置修正係数ｋIは、ＧＰＳ演
算による位置検出の信頼度ｒGPSと方位センサ出力の信
頼度ｒgとに応じて変化する。なお、０≦ｋI≦１となる
ように、関数ｆは設定される。
【００２８】ステップＳ２６では、（７），（８）式に
基づいて、距離修正係数ｋLと方位修正係数ｋθを求め
る。
基づいて、距離修正係数ｋLと方位修正係数ｋθを求め
る。
【数５】ｋL ＝ｋI×ｋ１ ・・・（７） ｋθ＝ｋI×ｋ２ ・・・（８） （７），（８）式のｋL，ｋθはいずれも１以下の正の
値であり、１に近いほどＧＰＳ演算値に近い値に修正す
ることを示す。ここで、方位センサ２の精度が車速セン
サ１の精度より高い場合には、０≦ｋ２＜ｋ１とするの
が望ましく、逆に車速センサ１の精度が方位センサ２の
精度より高い場合には、０≦ｋ１＜ｋ２とするのが望ま
しい。
値であり、１に近いほどＧＰＳ演算値に近い値に修正す
ることを示す。ここで、方位センサ２の精度が車速セン
サ１の精度より高い場合には、０≦ｋ２＜ｋ１とするの
が望ましく、逆に車速センサ１の精度が方位センサ２の
精度より高い場合には、０≦ｋ１＜ｋ２とするのが望ま
しい。
【００２９】ステップＳ２７では、図３のステップＳ１
４で求めた車両位置Ｓを修正する。具体的には、
（９），（１０）式の関係を満たすように車両位置Ｓを
修正する。
４で求めた車両位置Ｓを修正する。具体的には、
（９），（１０）式の関係を満たすように車両位置Ｓを
修正する。
【数６】ＡＳ＝ＡＢ＋ｋL×ΔＬ ・・・（９） ∠ＳＡＢ＝ｋθ×Δθ ・・・（１０）
【００３０】ステップＳ２８では、車速パルス数を計測
している変数Ｃ２がゼロであるか否かを判定する。判定
が否定されると車両が走行中であると判断してステップ
Ｓ２９に進み、変数Ｃ２をゼロにする。したがって、変
数Ｃ２はこの時点以降の車速パルス数を計測する。すな
わち、変数Ｃ２ではＧＰＳ測定処理を行ってから次にＧ
ＰＳ測定処理を行うまでの車速パルス数が計測される。
ステップＳ３０では、ステップＳ２７で修正した車両位
置Ｓの座標（Ｘ，Ｙ）をＲＡＭ７に記憶してステップＳ
３１に進む。
している変数Ｃ２がゼロであるか否かを判定する。判定
が否定されると車両が走行中であると判断してステップ
Ｓ２９に進み、変数Ｃ２をゼロにする。したがって、変
数Ｃ２はこの時点以降の車速パルス数を計測する。すな
わち、変数Ｃ２ではＧＰＳ測定処理を行ってから次にＧ
ＰＳ測定処理を行うまでの車速パルス数が計測される。
ステップＳ３０では、ステップＳ２７で修正した車両位
置Ｓの座標（Ｘ，Ｙ）をＲＡＭ７に記憶してステップＳ
３１に進む。
【００３１】一方、ステップＳ２８の判定が肯定される
と車両が停止していると判断して図５のステップＳ３１
に進む。すなわち、車両が停止している場合には、車両
位置が変化しないため、ステップＳ２７の修正結果をＲ
ＡＭ７に記憶せずにステップＳ３１以降の処理を行う。
図５のステップＳ３１では、図３のステップＳ１３で演
算した現在の車両進行方向を変数θに代入する。ステッ
プＳ３２では、ＧＰＳ信号に基づいて車両進行方向を演
算し、その結果を変数θGに代入する。ステップＳ３３
では、（１１）式に基づいてＧＰＳ信号に基づく車両進
行方向と、方位センサ２に基づく車両進行方向との方向
差Δθを求める。
と車両が停止していると判断して図５のステップＳ３１
に進む。すなわち、車両が停止している場合には、車両
位置が変化しないため、ステップＳ２７の修正結果をＲ
ＡＭ７に記憶せずにステップＳ３１以降の処理を行う。
図５のステップＳ３１では、図３のステップＳ１３で演
算した現在の車両進行方向を変数θに代入する。ステッ
プＳ３２では、ＧＰＳ信号に基づいて車両進行方向を演
算し、その結果を変数θGに代入する。ステップＳ３３
では、（１１）式に基づいてＧＰＳ信号に基づく車両進
行方向と、方位センサ２に基づく車両進行方向との方向
差Δθを求める。
【数７】Δθ＝θG−θ ・・・（１１）
【００３２】ステップＳ３４では、（１２）式に基づい
て方位修正係数ｋHを求める。
て方位修正係数ｋHを求める。
【数８】 （１２）式に示すｒdはＧＰＳ方位信頼度を示し、図７
（ｃ）に示すような特性を有する。図示のように、ＧＰ
Ｓ方位信頼度ｒdは車速に応じて変化し、車速が大きい
ほど信頼度が高くなる。また、（１２）式の関数ｆは
（６）式の関数ｆと同じであり、ＧＰＳ方位信頼度ｒd
が高いほど、または方位信頼度ｒgが低いほど、関数ｆ
の値は大きくなる。したがって、方位修正係数ｋHの値
は、ＧＰＳ測定による方位検出の信頼度ｒdと、方位セ
ンサ２による車両進行方向の信頼度ｒgとに応じて変化
する。
（ｃ）に示すような特性を有する。図示のように、ＧＰ
Ｓ方位信頼度ｒdは車速に応じて変化し、車速が大きい
ほど信頼度が高くなる。また、（１２）式の関数ｆは
（６）式の関数ｆと同じであり、ＧＰＳ方位信頼度ｒd
が高いほど、または方位信頼度ｒgが低いほど、関数ｆ
の値は大きくなる。したがって、方位修正係数ｋHの値
は、ＧＰＳ測定による方位検出の信頼度ｒdと、方位セ
ンサ２による車両進行方向の信頼度ｒgとに応じて変化
する。
【００３３】ステップＳ３５では、（１３）式に基づい
て車両進行方向θを更新した後、リターンする。
て車両進行方向θを更新した後、リターンする。
【数９】θ＝θ＋ｋH×Δθ ・・・（１３）
【００３４】以上に説明した図３〜５の処理を図６を用
いてまとめると、まず図３の車両位置更新処理では、車
速センサ１と方位センサ２を利用して、一定時間ごとに
車両位置を更新する。例えば図６（ａ）は、地点Ａから
車両位置検出を開始して、ａ１〜ａ４およびＢの各地点
で図３の処理を行った例を示す。図３の処理によって車
両が地点Ｂに達したと検出されたときに、ＣＰＵ５が図
４のＧＰＳ測定処理を行ったとする。この場合、ステッ
プＳ２２の変数Ｂには図６（ａ）の地点Ｂの座標が代入
される。また、ステップＳ２３で演算されたＧＰＳ測定
による車両位置が図６（ａ）の地点Ｇであったとする。
この場合、ステップＳ２４で演算される距離誤差ΔＬ
と、方位誤差Δθは、図示のようになる。これらの各誤
差とステップＳ２５で求めた信頼度に応じた位置修正係
数ｋIとによって、ステップＳ２７で車両位置を更新す
る。図６（ａ）では更新した車両位置をＳで示してい
る。
いてまとめると、まず図３の車両位置更新処理では、車
速センサ１と方位センサ２を利用して、一定時間ごとに
車両位置を更新する。例えば図６（ａ）は、地点Ａから
車両位置検出を開始して、ａ１〜ａ４およびＢの各地点
で図３の処理を行った例を示す。図３の処理によって車
両が地点Ｂに達したと検出されたときに、ＣＰＵ５が図
４のＧＰＳ測定処理を行ったとする。この場合、ステッ
プＳ２２の変数Ｂには図６（ａ）の地点Ｂの座標が代入
される。また、ステップＳ２３で演算されたＧＰＳ測定
による車両位置が図６（ａ）の地点Ｇであったとする。
この場合、ステップＳ２４で演算される距離誤差ΔＬ
と、方位誤差Δθは、図示のようになる。これらの各誤
差とステップＳ２５で求めた信頼度に応じた位置修正係
数ｋIとによって、ステップＳ２７で車両位置を更新す
る。図６（ａ）では更新した車両位置をＳで示してい
る。
【００３５】また、例えば車両が停止中の場合は、図６
（ａ）の地点Ａは変化せず、前回のＧＰＳ測定処理によ
って求めた車両位置Ｓを地点Ｂとして新たな車両位置Ｓ
を求めるため、求められる車両位置は次第にＧＰＳ演算
地点Ｇに近づいていく。逆に、例えば車両が時速１００
ｋｍで走行しており、かつＧＰＳ信号の受信状態が良好
の場合、ＧＰＳ測定処理の間隔を１ｓｅｃとすると、車
両はＧＰＳ測定処理を行う間に約３０ｍ走行する。すな
わち、車両が３０ｍ走行するごとにＧＰＳ測定処理を行
うとともに、ＧＰＳ測定処理の合間には図３の処理によ
って車速センサ１と方位センサ２を用いて車両位置検出
を行う。この結果、図３〜５の処理によって演算される
車両位置は徐々にＧＰＳ演算値に近づいていく。したが
って、従来のように、ディスプレイ１０上の車両位置が
急に変化することはない。
（ａ）の地点Ａは変化せず、前回のＧＰＳ測定処理によ
って求めた車両位置Ｓを地点Ｂとして新たな車両位置Ｓ
を求めるため、求められる車両位置は次第にＧＰＳ演算
地点Ｇに近づいていく。逆に、例えば車両が時速１００
ｋｍで走行しており、かつＧＰＳ信号の受信状態が良好
の場合、ＧＰＳ測定処理の間隔を１ｓｅｃとすると、車
両はＧＰＳ測定処理を行う間に約３０ｍ走行する。すな
わち、車両が３０ｍ走行するごとにＧＰＳ測定処理を行
うとともに、ＧＰＳ測定処理の合間には図３の処理によ
って車速センサ１と方位センサ２を用いて車両位置検出
を行う。この結果、図３〜５の処理によって演算される
車両位置は徐々にＧＰＳ演算値に近づいていく。したが
って、従来のように、ディスプレイ１０上の車両位置が
急に変化することはない。
【００３６】一方、図３のステップＳ１３で検出された
方位センサ２による車両進行方向を図６（ｂ）の矢印Ｙ
１とし、図５のステップＳ３２で検出されたＧＰＳ測定
による車両進行方向を矢印Ｙ２とすると、ステップＳ３
３で求められる方位誤差Δθは例えば図６（ｂ）のよう
になる。ステップＳ３４では方位修正係数ｋHを演算
し、ステップＳ３５では方位誤差Δθと方位修正係数ｋ
Hとによって車両進行方向を図６（ｂ）の矢印Ｙ３の方
向に修正する。
方位センサ２による車両進行方向を図６（ｂ）の矢印Ｙ
１とし、図５のステップＳ３２で検出されたＧＰＳ測定
による車両進行方向を矢印Ｙ２とすると、ステップＳ３
３で求められる方位誤差Δθは例えば図６（ｂ）のよう
になる。ステップＳ３４では方位修正係数ｋHを演算
し、ステップＳ３５では方位誤差Δθと方位修正係数ｋ
Hとによって車両進行方向を図６（ｂ）の矢印Ｙ３の方
向に修正する。
【００３７】図８（ａ）は図９（ａ）と同様のＹ字経路
を車両が走行する場合の本実施例による車両位置検出を
示す図である。図示の白丸で示した地点がＧＰＳ測定に
よる車両位置を示す。図示のＹ字交差点において、車両
が右側の経路を走行していると方位センサ２が誤って判
断しても、ＧＰＳ演算値は左側の経路に沿って検出され
るため、図４のＧＰＳ測定処理によって、図８（ａ）の
点線のように迅速に左側の経路に修正される。一方、図
９（ｂ）と同様に地図記憶メモリ４に含まれていない経
路を走行する場合でも、図８（ｂ）の点線のように、実
際の車両の進行方向に沿って位置検出がされる。
を車両が走行する場合の本実施例による車両位置検出を
示す図である。図示の白丸で示した地点がＧＰＳ測定に
よる車両位置を示す。図示のＹ字交差点において、車両
が右側の経路を走行していると方位センサ２が誤って判
断しても、ＧＰＳ演算値は左側の経路に沿って検出され
るため、図４のＧＰＳ測定処理によって、図８（ａ）の
点線のように迅速に左側の経路に修正される。一方、図
９（ｂ）と同様に地図記憶メモリ４に含まれていない経
路を走行する場合でも、図８（ｂ）の点線のように、実
際の車両の進行方向に沿って位置検出がされる。
【００３８】このように、本実施例によれば、ＧＰＳ信
号に基づいて演算した車両位置の信頼度と、方位センサ
２を用いて演算した車両位置の信頼度とを求め、各信頼
度に応じて車両位置を推定するようにしたため、車両位
置を精度よく推定することができる。また、ＧＰＳ信号
に基づいて演算した車両進行方向の信頼度と、方位セン
サを用いて演算した車両進行方向の信頼度とを求め、各
信頼度に応じて車両進行方向を推定するようにしたた
め、車両進行方向を精度よく推定することができる。
号に基づいて演算した車両位置の信頼度と、方位センサ
２を用いて演算した車両位置の信頼度とを求め、各信頼
度に応じて車両位置を推定するようにしたため、車両位
置を精度よく推定することができる。また、ＧＰＳ信号
に基づいて演算した車両進行方向の信頼度と、方位セン
サを用いて演算した車両進行方向の信頼度とを求め、各
信頼度に応じて車両進行方向を推定するようにしたた
め、車両進行方向を精度よく推定することができる。
【００３９】図７のＧＰＳ位置信頼度、方位センサ信頼
度およびＧＰＳ方位信頼度を示す各波形は、いずれも主
に実験値によって求められるものであり、実験の条件を
種々に変化させると、波形の形状が変化する場合がある
が、信頼度を示す波形の形状が変わっても本発明は同様
に適用できる。図３の車速パルス計測処理では、所定時
間ごとにＣＰＵ５に割り込みをかけて、車速センサ１か
ら出力されたパルス数を計測しているが、車速センサ１
からパルスが出力されると自動的にカウントアップする
カウンタ等によってパルス数を計測してもよい。
度およびＧＰＳ方位信頼度を示す各波形は、いずれも主
に実験値によって求められるものであり、実験の条件を
種々に変化させると、波形の形状が変化する場合がある
が、信頼度を示す波形の形状が変わっても本発明は同様
に適用できる。図３の車速パルス計測処理では、所定時
間ごとにＣＰＵ５に割り込みをかけて、車速センサ１か
ら出力されたパルス数を計測しているが、車速センサ１
からパルスが出力されると自動的にカウントアップする
カウンタ等によってパルス数を計測してもよい。
【００４０】このように構成した実施例にあっては、方
位センサ２が角速度検出手段に、車速センサ１が車速検
出手段に、地図記憶メモリ４が地図記憶手段に、図３の
処理が車両位置演算手段に、ＧＰＳ受信機３が受信手段
に、図４のステップＳ２３の処理がＧＰＳ位置演算手段
に、図４のステップＳ２５の処理がＧＰＳ位置信頼度推
定手段と角速度信頼度推定手段に、図４のステップＳ２
７の処理が車両位置修正手段に、ＲＡＭ７が車両位置記
憶手段に、図４のステップＳ２４の処理が第１距離差方
向差演算手段と第２距離差方向差演算手段に、図４のス
テップＳ２５，Ｓ２６と図５のステップＳ３４の処理が
修正係数演算手段に、図３の処理が車両進行方向演算手
段に、図５のステップＳ３２の処理がＧＰＳ方位演算手
段に、図５のステップＳ３４の処理がＧＰＳ方位信頼度
推定手段に、図５のステップＳ３５の処理が車両進行方
向修正手段に、図５のステップＳ３３の処理が方向差演
算手段に、それぞれ対応する。
位センサ２が角速度検出手段に、車速センサ１が車速検
出手段に、地図記憶メモリ４が地図記憶手段に、図３の
処理が車両位置演算手段に、ＧＰＳ受信機３が受信手段
に、図４のステップＳ２３の処理がＧＰＳ位置演算手段
に、図４のステップＳ２５の処理がＧＰＳ位置信頼度推
定手段と角速度信頼度推定手段に、図４のステップＳ２
７の処理が車両位置修正手段に、ＲＡＭ７が車両位置記
憶手段に、図４のステップＳ２４の処理が第１距離差方
向差演算手段と第２距離差方向差演算手段に、図４のス
テップＳ２５，Ｓ２６と図５のステップＳ３４の処理が
修正係数演算手段に、図３の処理が車両進行方向演算手
段に、図５のステップＳ３２の処理がＧＰＳ方位演算手
段に、図５のステップＳ３４の処理がＧＰＳ方位信頼度
推定手段に、図５のステップＳ３５の処理が車両進行方
向修正手段に、図５のステップＳ３３の処理が方向差演
算手段に、それぞれ対応する。
【００４１】
【発明の効果】以上詳細に説明したように、本発明によ
れば、ＧＰＳ信号に基づいて演算した車両位置の信頼度
と角速度検出手段によって検出された角速度の信頼度と
に基づいて、車両位置を定めるようにしたため、車両位
置を精度よく推定できる。請求項３，４に記載の発明に
よれば、ＧＰＳ信号に基づいて演算した車両位置の信頼
度が高いほど、また角速度検出手段によって検出された
角速度の信頼度が低いほど、ＧＰＳ信号に基づいて演算
した車両位置に近い位置に車両位置を定めるようにした
ため、信頼度の高い車両位置の推定が可能となる。請求
項５に記載の発明によれば、ＧＰＳ信号に基づいて演算
した車両進行方向の信頼度と角速度検出手段によって検
出された角速度の信頼度とに基づいて、車両進行方向を
定めるようにしたため、車両進行方向を精度よく推定で
きる。請求項７，８に記載の発明によれば、ＧＰＳ信号
に基づいて演算した車両進行方向の信頼度が高いほど、
また角速度検出手段によって検出された角速度の信頼度
が低いほど、ＧＰＳ信号に基づいて演算した車両進行方
向に近い位置に車両進行方向を定めるようにしたため、
信頼度の高い車両進行方向の推定が可能となる。
れば、ＧＰＳ信号に基づいて演算した車両位置の信頼度
と角速度検出手段によって検出された角速度の信頼度と
に基づいて、車両位置を定めるようにしたため、車両位
置を精度よく推定できる。請求項３，４に記載の発明に
よれば、ＧＰＳ信号に基づいて演算した車両位置の信頼
度が高いほど、また角速度検出手段によって検出された
角速度の信頼度が低いほど、ＧＰＳ信号に基づいて演算
した車両位置に近い位置に車両位置を定めるようにした
ため、信頼度の高い車両位置の推定が可能となる。請求
項５に記載の発明によれば、ＧＰＳ信号に基づいて演算
した車両進行方向の信頼度と角速度検出手段によって検
出された角速度の信頼度とに基づいて、車両進行方向を
定めるようにしたため、車両進行方向を精度よく推定で
きる。請求項７，８に記載の発明によれば、ＧＰＳ信号
に基づいて演算した車両進行方向の信頼度が高いほど、
また角速度検出手段によって検出された角速度の信頼度
が低いほど、ＧＰＳ信号に基づいて演算した車両進行方
向に近い位置に車両進行方向を定めるようにしたため、
信頼度の高い車両進行方向の推定が可能となる。
【図１】本発明による車両用位置検出装置の一実施例の
ブロック図である。
ブロック図である。
【図２】ＣＰＵが行う車速パルス計測処理を示すフロー
チャートである。
チャートである。
【図３】ＣＰＵが行う車両位置更新処理を示すフローチ
ャートである。
ャートである。
【図４】ＣＰＵが行うＧＰＳ測定処理を示すフローチャ
ートである。
ートである。
【図５】図４に続くフローチャートである。
【図６】車両位置検出と車両進行方向検出の例を示す図
である。
である。
【図７】ＧＰＳ位置信頼度、方位センサ信頼度およびＧ
ＰＳ方位信頼度の特性を示す図である。
ＰＳ方位信頼度の特性を示す図である。
【図８】本実施例の車両位置検出装置を用いて車両位置
検出を行った例を示す図である。
検出を行った例を示す図である。
【図９】従来の車両位置検出装置によって車両位置検出
を行った例を示す図である。
を行った例を示す図である。
【図１０】各センサ等の長所・短所をまとめた図であ
る。
る。
１ 車速センサ ２ 方位センサ ３ ＧＰＳ受信機 ４ 地図記憶メモリ ５ ＣＰＵ ６ ＲＯＭ ７ ＲＡＭ ８ 操作ボード ９ Ｖ−ＲＡＭ １０ ディスプレイ １１ インタフェース回路
Claims (8)
- 【請求項１】 車両に発生した角速度を検出する角速度
検出手段と、 車両の走行速度を検出する車速検出手段と、 道路地図データを記憶する地図記憶手段と、 前記角速度、前記走行速度および前記道路地図データに
基づいて車両位置を演算する車両位置演算手段とを備え
る車両用位置検出装置において、 ＧＰＳ信号を受信する受信手段と、 前記ＧＰＳ信号に基づいて車両位置を演算するＧＰＳ位
置演算手段と、 前記ＧＰＳ位置演算手段によって演算された車両位置の
信頼度を推定するＧＰＳ位置信頼度推定手段と、 前記角速度検出手段によって検出された角速度の信頼度
を推定する角速度信頼度推定手段と、 前記ＧＰＳ位置信頼度推定手段によって推定された信頼
度と、前記角速度信頼度推定手段によって推定された信
頼度と、前記ＧＰＳ位置演算手段によって演算された車
両位置とに基づいて、前記車両位置演算手段によって演
算された車両位置を修正する車両位置修正手段とを備え
ることを特徴とする車両用位置検出装置。 - 【請求項２】 請求項１に記載された車両用位置検出装
置において、 前記角速度信頼度推定手段は、前記角速度のゼロレベル
調整を行ってからの経過時間に基づいて信頼度を推定す
ることを特徴とする車両用位置検出装置。 - 【請求項３】 請求項１または２に記載された車両用位
置検出装置において、 前記車両位置修正手段は、前記ＧＰＳ位置信頼度推定手
段によって推定された信頼度が高いほど、また前記角速
度信頼度推定手段によって推定された信頼度が低いほ
ど、前記車両位置演算手段によって演算された車両位置
を前記ＧＰＳ位置演算手段によって演算された車両位置
に近づけるように修正することを特徴とする車両用位置
検出装置。 - 【請求項４】 請求項１〜３のいずれかに記載された車
両用位置検出装置において、 前記車両位置修正手段による車両位置の修正は繰り返し
行われ、 前記車両位置修正手段によって修正された車両位置を記
憶する車両位置記憶手段と、 前記車両位置演算手段によって演算された車両位置と、
前記車両位置記憶手段に記憶された車両位置との距離差
および方向差を演算する第１距離差方向差演算手段と、 前記ＧＰＳ位置演算手段によって演算された車両位置と
前記車両位置記憶手段に記憶された車両位置との距離差
および方向差を演算する第２距離差方向差演算手段と、 前記ＧＰＳ位置信頼度推定手段によって推定された信頼
度と前記角速度信頼度推定手段によって推定された信頼
度とに応じて変化する修正係数を演算する修正係数演算
手段とを備え、 前記車両位置修正手段は、前記第１距離差方向差演算手
段によって演算された距離差および方向差と、前記第２
距離差方向差演算手段によって演算された距離差および
方向差と、前記修正係数演算手段によって演算された修
正係数とに基づいて、前記車両位置演算手段によって演
算された車両位置を修正することを特徴とする車両用位
置検出装置。 - 【請求項５】 車両に発生した角速度を検出する角速度
検出手段と、 前記角速度に基づいて車両進行方向を演算する車両進行
方向演算手段とを備える車両用位置検出装置において、 ＧＰＳ信号を受信する受信手段と、 前記ＧＰＳ信号に基づいて車両の進行方向を演算するＧ
ＰＳ方位演算手段と、このＧＰＳ方位演算手段によって
演算された車両進行方向の信頼度を推定するＧＰＳ方位
信頼度推定手段と、 このＧＰＳ方位信頼度推定手段によって信頼度と、前記
ＧＰＳ方位演算手段によって演算された車両進行方向と
に基づいて、前記車両進行方向演算手段によって演算さ
れた車両進行方向を修正する車両進行方向修正手段とを
備えることを特徴とする車両用位置検出装置。 - 【請求項６】 請求項５に記載された車両用位置検出装
置において、 前記ＧＰＳ方位信頼度推定手段は、車両の走行速度に基
づいて信頼度を推定することを特徴とする車両用位置検
出装置。 - 【請求項７】 請求項５または６に記載された車両用位
置検出装置において、 前記車両進行方向修正手段は、前記ＧＰＳ方位信頼度推
定手段によって推定された信頼度が高いほど、あるいは
前記角速度信頼度推定手段によって推定された信頼度が
低いほど、前記車両進行方位演算手段によって演算され
た車両進行方向を前記ＧＰＳ方位演算手段によって演算
された車両進行方向に近づけるように修正することを特
徴とする車両用位置検出装置。 - 【請求項８】 請求項５〜７のいずれかに記載された車
両用位置検出装置において、 前記車両進行方向演算手段によって演算された車両進行
方向と前記ＧＰＳ方位演算手段によって演算された車両
進行方向との方向差を演算する方向差演算手段と、 前記ＧＰＳ方位信頼度推定手段によって推定された信頼
度と前記角速度信頼度推定手段によって推定された信頼
度とに応じて変化する修正係数を演算する修正係数演算
手段とを備え、 前記車両位置修正手段は、前記方向差演算手段によって
演算された方向差と前記修正係数演算手段によって演算
された修正係数とに基づいて、前記車両進行方向演算手
段によって演算された車両進行方向を修正することを特
徴とする車両用位置検出装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP6586594A JP3552267B2 (ja) | 1994-04-04 | 1994-04-04 | 車両用位置検出装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP6586594A JP3552267B2 (ja) | 1994-04-04 | 1994-04-04 | 車両用位置検出装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH07280575A true JPH07280575A (ja) | 1995-10-27 |
| JP3552267B2 JP3552267B2 (ja) | 2004-08-11 |
Family
ID=13299327
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP6586594A Expired - Fee Related JP3552267B2 (ja) | 1994-04-04 | 1994-04-04 | 車両用位置検出装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3552267B2 (ja) |
Cited By (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2000292170A (ja) * | 1999-04-13 | 2000-10-20 | Nec Corp | 移動体姿勢角検出装置 |
| US6658353B2 (en) | 2000-11-08 | 2003-12-02 | Denso Corporation | Vehicle navigation apparatus providing rapid correction for excessive error in dead reckoning estimates of vehicle travel direction by direct application of position and direction information derived from gps position measurement data |
| JP2007033434A (ja) * | 2005-06-20 | 2007-02-08 | Denso Corp | 車両用現在位置検出装置、及び車両制御装置 |
| JP2008204304A (ja) * | 2007-02-22 | 2008-09-04 | Hitachi Ltd | 車両挙動再現方法およびシステム |
| JP2008232687A (ja) * | 2007-03-19 | 2008-10-02 | Furukawa Toshihiko | 位置検出装置 |
| JP2010122034A (ja) * | 2008-11-19 | 2010-06-03 | Fujitsu Ltd | 絶対移動経路算出装置及び方法、並びにプログラム |
| JP2012007939A (ja) * | 2010-06-23 | 2012-01-12 | Aisin Aw Co Ltd | 軌跡情報生成装置、方法およびプログラム |
| JP2012007938A (ja) * | 2010-06-23 | 2012-01-12 | Aisin Aw Co Ltd | 軌跡情報生成装置、方法およびプログラム |
| JP2013504749A (ja) * | 2009-09-10 | 2013-02-07 | コンパニー ゼネラール デ エタブリッスマン ミシュラン | 少なくとも１本のタイヤのドリフト値を求めるデータ処理方法 |
| US8793090B2 (en) | 2010-06-23 | 2014-07-29 | Aisin Aw Co., Ltd. | Track information generating device, track information generating method, and computer-readable storage medium |
| US11181377B2 (en) | 2016-03-30 | 2021-11-23 | Mitsubishi Electric Corporation | Travel direction estimation device |
-
1994
- 1994-04-04 JP JP6586594A patent/JP3552267B2/ja not_active Expired - Fee Related
Cited By (15)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2000292170A (ja) * | 1999-04-13 | 2000-10-20 | Nec Corp | 移動体姿勢角検出装置 |
| US6658353B2 (en) | 2000-11-08 | 2003-12-02 | Denso Corporation | Vehicle navigation apparatus providing rapid correction for excessive error in dead reckoning estimates of vehicle travel direction by direct application of position and direction information derived from gps position measurement data |
| JP2007033434A (ja) * | 2005-06-20 | 2007-02-08 | Denso Corp | 車両用現在位置検出装置、及び車両制御装置 |
| JP2008204304A (ja) * | 2007-02-22 | 2008-09-04 | Hitachi Ltd | 車両挙動再現方法およびシステム |
| JP2008232687A (ja) * | 2007-03-19 | 2008-10-02 | Furukawa Toshihiko | 位置検出装置 |
| US8560235B2 (en) | 2008-11-19 | 2013-10-15 | Fujitsu Limited | Apparatus and method for calculating absolute movement path and recording medium |
| JP2010122034A (ja) * | 2008-11-19 | 2010-06-03 | Fujitsu Ltd | 絶対移動経路算出装置及び方法、並びにプログラム |
| EP2189758A3 (en) * | 2008-11-19 | 2013-11-27 | Fujitsu Limited | Apparatus, method and program for calculating absolute movement path |
| JP2013504749A (ja) * | 2009-09-10 | 2013-02-07 | コンパニー ゼネラール デ エタブリッスマン ミシュラン | 少なくとも１本のタイヤのドリフト値を求めるデータ処理方法 |
| JP2012007939A (ja) * | 2010-06-23 | 2012-01-12 | Aisin Aw Co Ltd | 軌跡情報生成装置、方法およびプログラム |
| JP2012007938A (ja) * | 2010-06-23 | 2012-01-12 | Aisin Aw Co Ltd | 軌跡情報生成装置、方法およびプログラム |
| US8793090B2 (en) | 2010-06-23 | 2014-07-29 | Aisin Aw Co., Ltd. | Track information generating device, track information generating method, and computer-readable storage medium |
| US8843340B2 (en) | 2010-06-23 | 2014-09-23 | Aisin Aw Co., Ltd. | Track information generating device, track information generating method, and computer-readable storage medium |
| US9273968B2 (en) | 2010-06-23 | 2016-03-01 | Aisin Aw Co., Ltd. | Track information generating device, track information generating method, and computer-readable storage medium |
| US11181377B2 (en) | 2016-03-30 | 2021-11-23 | Mitsubishi Electric Corporation | Travel direction estimation device |
Also Published As
| Publication number | Publication date |
|---|---|
| JP3552267B2 (ja) | 2004-08-11 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US7400969B2 (en) | Navigation system | |
| US6931322B2 (en) | Method for correcting position error in navigation system | |
| EP1457946B1 (en) | Apparatus for detecting location of mobile body in navigation system and method thereof | |
| EP1012537B1 (en) | Navigation system using gps data | |
| EP0544403B1 (en) | Vehicle navigation system | |
| EP0523860B1 (en) | Vehicle position and azimuth computing system | |
| US6002981A (en) | Correction method and intelligent vehicle guidance system for a composite-navigation of a motor vehicle | |
| US7117087B2 (en) | Method for estimating location of moving object in navigation system | |
| US7756639B2 (en) | System and method for augmenting a satellite-based navigation solution | |
| US20060047423A1 (en) | Navigation system and method for detecting deviation of mobile objects from route using same | |
| WO2019009103A1 (ja) | 測位装置 | |
| JP2001503519A (ja) | 衛星受信器を有する自動車用の位置検出装置 | |
| KR100526571B1 (ko) | 오프-보드 네비게이션 시스템 및 그의 오차 보정 방법 | |
| US8401787B2 (en) | Method of determining drive lane using steering wheel model | |
| JP3552267B2 (ja) | 車両用位置検出装置 | |
| KR20090001176A (ko) | 의사 추측 항법을 이용한 차량 위치 결정 방법 및 이를이용한 자동차 항법 장치 | |
| JP2008256620A (ja) | 地図データ修正装置、地図データ修正方法、及び地図データ修正プログラム | |
| JPH0735558A (ja) | 車両の現在位置検出装置 | |
| JPH08178681A (ja) | ハイブリッドナビゲーションシステム | |
| JPH06111196A (ja) | 移動体の現在位置表示装置 | |
| TWI635302B (zh) | 載具即時精準定位系統 | |
| KR100216535B1 (ko) | 위치 정합도를 이용한 차량 항법용 주행 차량의 위치 측정 방법 | |
| JP3731686B2 (ja) | 位置算出装置 | |
| KR100541485B1 (ko) | 차량 항법 유도 시스템 및 이를 이용한 차량 항법 유도방법 | |
| JPH05209756A (ja) | 速度センサ係数算出装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20040413 |
|
| A61 | First payment of annual fees (during grant procedure) |
Effective date: 20040426 Free format text: JAPANESE INTERMEDIATE CODE: A61 |
|
| R150 | Certificate of patent (=grant) or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| LAPS | Cancellation because of no payment of annual fees |