JP3656144B2

JP3656144B2 - Ｇｐｓ衛星を利用する測位装置

Info

Publication number: JP3656144B2
Application number: JP03357396A
Authority: JP
Inventors: 訪喜久諏; 川誠司石; 本知弘山; 藤毅伊; 田富夫保
Original assignee: Aisin Seiki Co Ltd; Aisin Corp
Current assignee: Aisin Corp
Priority date: 1996-02-21
Filing date: 1996-02-21
Publication date: 2005-06-08
Anticipated expiration: 2016-02-21
Also published as: FR2745092B1; US5931890A; FR2745092A1; DE19705740B4; DE19705740A1; JPH09230024A

Description

【０００１】
【産業上の利用分野】
本発明は、ＧＰＳ衛星を利用する測位装置に関し、特に、車両上の測位演算に利用する複数の衛星の選択に関する。
【０００２】
【従来の技術】
例えば、最近の自動車用ナビゲ−ションシステムにおいては、該システムを搭載した自動車の位置を、ＧＰＳ（Grobal Positioning System）の衛星からの情報を利用して測定することが行なわれている。この種の測位技術は、例えば、特開昭６１−１３７００９号公報に開示されている。
【０００３】
衛星からはそれの予定軌道を示す情報や、衛星が情報を送出する正確な時刻の情報などが送られている。これらの情報に基づいて、衛星の位置を知ることができ、また電波の伝播遅延時間から、衛星と受信点との距離を知ることができるので、例えば同時に４個の衛星の情報を利用できる時には、各々の衛星の情報から導き出される方程式を連立方程式として解くことにより、受信点の三次元位置（緯度，経度，高度）および受信装置側の時計の誤差を正確に検出することができる。また例えば、高度が既知である場合には、３個の衛星の情報に基づいて、緯度，経度，及び時計の誤差を検出しうる。更に、例えば加速度センサなどを補助的に用いることによって、利用しうる衛星数が２以下の場合でも、測位は可能である。
【０００４】
ところが、ＧＰＳ受信機を市街地等電波環境の悪い地域で使用すると、異常解（位置，速度，方位）が発生することがある。この理由の１つとしてマルチパス等の異常電波（例えば高層ビルの反射波）を用いて測位計算を行なったということが考えられる。特開昭６１−１３７００９号公報および特開昭６１−１６７８８６号公報には、車両上の測位装置において、車両上にジャイロ，速度計および高度計あるいは方位計を備えて、受信できる衛星数が少いとき、それらの測定器の測定デ−タを用いて足らない情報を補完する測位装置が提案されているが、マルチパス等の異常電波を受信した場合の測位エラ−を補償することはできない。
【０００５】
本出願人は、特開平７−４３４４６号公報に、ＧＰＳ受信機が受信した情報の正誤を検証する測位装置を提示した。これにおいては、受信可能なＧＰＳ衛星の集合の中の、３以上のＧＰＳ衛星（グル−プ）のそれぞれと受信機との距離を、ＧＰＳ衛星の位置情報と受信機の位置情報から算出しこれを第１距離とし、ＧＰＳ衛星から受信機までのＧＰＳ電波の伝播時間を算出しこれに伝播速度（光速）を乗じた値を算出してこれを第２距離とし、第１距離と第２距離の差が大きいと該グル−プ内に発信情報がエラ−のＧＰＳ衛星があるとして、グル−プ内の１つのＧＰＳ衛星を、ＧＰＳ衛星の集合の中の他の１つに置き換えてまた同様な計算とエラ−チェックをして、発信情報がエラ−のＧＰＳ衛星を特定し、発信情報が正しいと判定したＧＰＳ衛星を、使用可能なＧＰＳ衛星として登録し、発信情報がエラ−と判定したＧＰＳ衛星は使用不可と登録して、使用可能なＧＰＳ衛星のみを利用して測位計算を行なう。これによれば、軌道ずれなど、実位置と発信情報との間にずれを生じたＧＰＳ衛星は、測位計算の指標から外されるので、測位計算の誤りが低減する。
【０００６】
【発明が解決しようとする課題】
しかし、ＧＰＳ衛星の発信情報の正誤検証であるので、市街地等電波環境の悪い地域での、マルチパス等の異常電波（例えば高層ビルの反射波）を受信した場合などの異常解を回避するには不十分と思われる。というのは、ＧＰＳ衛星からの受信デ−タの中の何れの情報が、電波受信環境（特に地上での局所的なもの）によってエラ−となっているかが分からないからである。また、第１距離および第２距離の演算を、グル−プ内のＧＰＳ衛星を１つづつグル−プ外のものと入れ替えて行なうので、比較的に多くの時間がかかる。
【０００７】
本発明は、市街地等電波環境の悪い地域での、マルチパス等の異常電波（例えば高層ビルの反射波）による測位エラ−を低減することを第１の目的とし、異常電波受信であるか否かのチェック時間を短くすることを第２の目的とする。
【０００８】
【課題を解決するための手段】
（１）それの軌道情報と時刻の情報を送出する複数のＧＰＳ衛星からの情報を受信する受信手段(11,12)；
前記ＧＰＳ衛星が発射する信号の周波数(fo)と前記受信手段が受信した信号の周波数(fR)の差Δｆ(＝fR−fo)を算出する偏差計算手段(16)；該差Δｆの変化速度ΔΔｆを求める変化量計算手段(16)；および、
前記変化速度ΔΔｆが第１しきい値以下(ΔΔｆ≦30H z/s)の複数のＧＰＳ衛星の、前記受信手段が受信した情報に基づいて、前記受信手段の位置を求め、変化速度ΔΔｆが、第１しきい値より小さい第２しきい値以下 ( ΔΔｆ≦ 15H z/s) の複数のＧＰＳ衛星の、前記受信手段が受信した情報に基づいて、前記受信手段の進行方向方位を求める測位演算手段(16)；
を備えるＧＰＳ衛星を利用する測位装置。
【０００９】
なお、理解を容易にするためにカッコ内には、図面に示し後述する実施例の対応要素又は対応事項の符号を、参考までに付記した。
【００１０】
ＧＰＳ衛星が発射する信号の周波数(fo)と受信手段(11,12)が受信した信号の周波数(fR)の差Δｆ(＝fR−fo)は、いわゆるドップラーシフトと言われるものであり、ＧＰＳ衛星に対する受信手段(11,12)の相対移動速度（速度ベクトル）に対応した値となる。
【００１１】
受信手段(11,12)がＧＰＳ衛星からの直進電波を受信しているときには、このドップラーシフトΔｆは、ＧＰＳ衛星に対する受信手段(11,12)の相対移動速度（速度ベクトル）を表わす。ここでこのドップラーシフトを正常ドップラーシフトと称す。ところが、例えば受信手段(11,12)が高層ビルの反射波を受信しているときには、ドップラーシフトΔｆは、ＧＰＳ衛星に対する高層ビルの相対移動速度（速度ベクトル）および高層ビルに対する受信手段(11,12)の相対移動速度（速度ベクトル）に対応したものとなる。ここでこのドップラーシフトを異常ドップラーシフトと称す。
【００１２】
受信手段(11,12)が市街地又はその近辺を走行している車両に搭載されており、受信手段(11,12)がＧＰＳ衛星からの直進電波を受信しているときには、ドップラーシフトΔｆの変化速度ΔΔｆすなわち正常ドップラーシフトの変化速度は、ＧＰＳ衛星に対する受信手段(11,12)の相対加速度（加速度ベクトル）であり、略車両の、通常の運転状態で生ずる加速度の範囲内である。ところが、受信手段 (11,12)がＧＰＳ衛星からの直進電波受信から高層ビルの反射波受信に切換わるときには、正常ドップラーシフトから異常ドップラーシフトへの切換わりになるので、ドップラーシフトΔｆの変化速度ΔΔｆ（の絶対値）がここで急激に高い値となる。
【００１３】
本発明の測位装置では、偏差計算手段(16)が、ＧＰＳ衛星が発射する信号の周波数(fo)と前記受信手段が受信した信号の周波数(fR)の差すなわちドップラーシフトΔｆ(＝fR−fo)を算出し、変化量計算手段(16)が、ドップラーシフトΔｆの変化速度ΔΔｆを求め、測位演算手段(16)が、前記変化速度ΔΔｆが第１しきい値以下(ΔΔｆ≦30H z/s)の複数のＧＰＳ衛星の、前記受信手段が受信した情報に基づいて、前記受信手段の位置を求め、変化速度ΔΔｆが、第１しきい値より小さい第２しきい値以下 ( ΔΔｆ≦ 15H z/s) の複数のＧＰＳ衛星の、前記受信手段が受信した情報に基づいて、前記受信手段の進行方向方位を求めるので、受信手段(11,12)の受信がＧＰＳ衛星からの直進電波受信から高層ビルの反射波受信に切換わったなどにより変化速度ΔΔｆが第１しきい値を超える(ΔΔｆ＞30H z/s)ＧＰＳ衛星は位置計算の指標から外され、したがって、市街地等電波環境の悪い地域での、マルチパス等の異常電波（例えば高層ビルの反射波）による測位エラ−の可能性が低減する。
【００１４】
ＧＰＳ衛星が発射する電波の受信周波数(fR)は、該電波を受信するときの自動同調処理の過程で得られる。発信周波数(fo)は、公称周波数として知られており、ドップラーシフトΔｆ(＝fR−fo)の算出は容易であって時間がかからない。また、変化速度ΔΔｆは、Δｆを所定周期（ＧＰＳ受信機の測位解算出周期Ｔs）で算出して、今回の算出値Δｆから前回（Ｔs前）の算出値Δｆ´を減算することにより得られ、これも容易であって時間がかからない。
【００１５】
第２しきい値 ( １５ Hz/s) は、衛星からの直進電波受信から、マルチパス等の異常電波（例えば高層ビルの反射波）受信への変化のときほどには大きくないが、代表的には車両の加，減速あるいは進行方向変化により衛星から受信した情報に基づいた車両（受信機）の速度ベクトル（進行方向方位，速度を示す）の演算値に比較的に大きなエラ−を生ずる可能性がある場合など、進行方向方位および速度演算の信頼性が低いか否かを識別するためのものである。第２しきい値以下 ( ΔΔｆ≦ 15H z/s) の複数のＧＰＳ衛星からの情報に基づいて、受信手段の進行方向方位を求めるので、車両（受信機）の加，減速度が大きいとか、車両の進行方向が急速に変化しているときの進行方向方位演算のエラ−が低減する。このように、衛星が発射する電波の受信環境の良否判定は、ドップラーシフトの変化速度ΔΔｆに基づいて行なうが、ドップラーシフトΔｆの算出およびその変化速度ΔΔｆの算出にはほとんど時間がかからず、測位演算手段が各衛星からの電波受信の良否判定に費す時間は僅少である。
【００１６】
【発明の実施の形態】
（２）前記測位演算手段は、第２しきい値以下の複数のＧＰＳ衛星の、前記受信手段が受信した情報に基づいて、前記受信手段の速度を求める上記（１）に記載のＧＰＳ衛星を利用する測位装置。
【００１７】
第２しきい値以下 ( ΔΔｆ≦ 15H z/s) の複数のＧＰＳ衛星からの情報に基づいて、受信手段の速度を求めるので、車両（受信機）の加，減速度が大きいとか、車両の進行方向が急速に変化しているときの速度演算のエラ−が低減する。このように、衛星が発射する電波の受信環境の良否判定は、ドップラーシフトの変化速度ΔΔｆに基づいて行なうが、ドップラーシフトΔｆの算出およびその変化速度ΔΔｆの算出にはほとんど時間がかからず、測位演算手段が各衛星からの電波受信の良否判定に費す時間は僅少である。
【００１８】
（３）前記測位演算手段は、複数のＧＰＳ衛星のアルマナックデ−タと前記受信手段の位置に基づいて、複数のＧＰＳ衛星を選択して登録テ−ブルに書込み、該登録テ−ブルの複数のＧＰＳ衛星を選択して前記受信手段を用いてトラッキングし、トラッキングに失敗したＧＰＳ衛星、ならびに、前記変化速度ΔΔｆが第１しきい値を越えるＧＰＳ衛星を前記選択したＧＰＳ衛星群から消去し、これにより該ＧＰＳ衛星群のＧＰＳ衛星が設定数未満になると該消去したＧＰＳ衛星を除く前記登録テ−ブルのＧＰＳ衛星を前記ＧＰＳ衛星群に加え；前記受信手段は、前記ＧＰＳ衛星群のＧＰＳ衛星からの情報を受信する；上記（１）又は（２）に記載のＧＰＳ衛星を利用する測位装置。
【００１９】
（４）前記受信手段の高度を検出する高度センサ；を更に備え、前記測位演算手段は、前記変化速度ΔΔｆが、第１しきい値以下の複数のＧＰＳ衛星の個数が４以上のときは、これらのＧＰＳ衛星から前記受信手段が受信した情報に基づいて受信手段の位置を求め、前記変化速度ΔΔｆが第１しきい値以下のＧＰＳ衛星の個数が３のときは、これらのＧＰＳ衛星から前記受信手段が受信した情報ならびに前記高度センサの検出高度に基づいて前記受信手段の位置を求める；上記（１）〜（３）の何れか１つに記載のＧＰＳ衛星を利用する測位装置。
【００２０】
【実施例】
図１に本発明の一実施例の構成を示す。この装置は、地上を走行する自動車に搭載されており、受信アンテナ１０，ＧＰＳ受信機１１，ＧＰＳ復調器１２，表示装置１３，圧電振動ジャイロ１４，高度センサ１５，ＧＰＳ情報処理ユニット１６及び操作ボ−ド１７を備えている。ＧＰＳの各衛星から送られる1.57542GHzの電波が、受信アンテナ１０を介してＧＰＳ受信機１１で受信され、電波に乗った情報、即ち衛星の軌道を示す関数，時刻等の情報がＧＰＳ復調器１２で復調され、ＧＰＳ情報処理ユニット１６に入力される。ＧＰＳ情報処理ユニット１６は、基本的には、ＧＰＳ衛星から送られる情報に基づいて、自車の位置を示す情報（緯度，経度，高度）を生成し、その情報から、走行地の、予め定められている指標（交叉点，よく知られた建物等々）に対する相対位置情報を生成し、自車の位置を示す情報（緯度，経度，高度）および生成した相対位置情報を表示装置１３に出力する。受信アンテナ１０，ＧＰＳ受信機１１，ＧＰＳ復調器１２及び表示装置１３の基本的な構成、ならびにＧＰＳ情報処理ユニット１６の基本的な動作は、既に市販されている公知の装置の各構成要素と同様である。
【００２１】
同時に４個のＧＰＳ衛星からの電波を受信できる場合には、その電波に乗った情報のみを計算することによって、自車位置を正確に求めることができる。圧電振動ジャイロ１４及び高度センサ１５が出力する情報を参照することによって、使用できるＧＰＳ衛星の数が３以下の時にも、自車位置を計算することができる。圧電振動ジャイロ１４は、車上に固定配置されており、自動車の垂直軸を中心とする回転角速度ωに比例したレベルの信号を出力する。
【００２２】
ＧＰＳ情報処理ユニット１６は、コンピュ−タシステムであり、ＣＰＵ（マイクロプロセッサ）１６ａ，ＲＡＭ１６ｂ，ＲＯＭ１６ｃ，Ｉ／Ｏポ−ト１６ｄ，Ａ／Ｄ変換器１６ｅ，タイマ１６ｆ，割込制御回路１６ｇ及び時計１６ｈを備えている。圧電振動ジャイロ１４及び高度センサ１５が出力するアナログ信号は、それぞれＡ／Ｄ変換器１６ｅを介してＣＰＵ１６ａに入力される。ＧＰＳ復調器１２から出力される情報及びＧＰＳ復調器１２を制御する情報は、Ｉ／Ｏポ−ト１６ｄを介して入力又は出力される。
【００２３】
ＧＰＳ情報処理ユニット１６のＣＰＵ１６ａの動作の概略を図２および図３に示す。まず図２を参照すると、電源がオンすると、ＣＰＵ１６ａはステップ１に進み、状態レジスタＦlag-ｄiを初期化(０の書込みに同義)する。
【００２４】
状態レジスタＦlag-ｄiは、ドップラーシフト算出済か否かを示すデ−タを書込むものであり、この実施例では、利用可能な衛星として８個まで登録可としており、ｉ＝１〜８であり、後述のステップ３で登録される８個の衛星（Ｎｏ．１〜Ｎｏ．８）のそれぞれに状態レジスタＦlag-ｄ１〜Ｆlag-ｄ８のそれぞれを対応付けている。以下の説明において、ｉは、１〜８の全体又は１つを意味し、状態レジスタＦlag-ｄiのデ−タ「０」は、後述のステップ３で登録された衛星Ｎｏ．ｉ（ここでｉは登録順の番号）からの電波のドップラーシフトを算出していないことを意味し、状態レジスタＦlag-ｄiのデ−タ「１」は、登録された衛星Ｎｏ．ｉからの電波のドップラーシフト算出済を意味する。
【００２５】
後に言及する状態レジスタＦlag-ｐiは、位置演算可否デ−タを書込むものであり、状態レジスタＦlag-ｐiのデ−タ「０」は、登録された衛星Ｎｏ．ｉが、それに対する自車位置ベクトルの演算に利用しえないことを意味し、状態レジスタＦlag-ｐiのデ−タ「１」は、登録された衛星Ｎｏ．ｉを該演算に利用しうることを意味する。
【００２６】
後に言及する状態レジスタＦlag-ｖiは、速度演算可否デ−タを書込むものであり、状態レジスタＦlag-ｖiのデ−タ「０」は、登録された衛星Ｎｏ．ｉがそれに対する自車速度ベクトルの演算に利用しえないことを意味し、状態レジスタＦlag-ｖiのデ−タ「１」は、登録された衛星Ｎｏ．ｉを該演算に利用しうることを意味する。
【００２７】
状態レジスタＦlag-ｄiを初期化するとＣＰＵ１６ａは、表示装置１３に、入力を催告する入力画面を表示し、オペレ−タの入力を読込む（ステップ２，３）。なお、以下においてカッコ内には、ステップという語を省略してステップＮｏ．数字のみを記す。オペレ−タはここで、現在位置の緯度，経度を入力し、現在時刻を入力する。これらの入力を読込むとＣＰＵ１６ａは、緯度，経度及び時刻を初期化する。すなわち緯度，経度レジスタに入力があった値を書込み、時計１６ｈを入力があった時刻に合わせる。オペレ−タからの数値入力がない時には、装置の電源が遮断される直前に、ＲＡＭ１６ｂのブロック内の不揮発メモリ（電池バックアップメモリ）にセ−ブした緯度及び経度を、緯度，経度レジスタに書込む（２）。
【００２８】
ＣＰＵ１６ａは次に、多数のＧＰＳ衛星の中からその時に利用可能なＧＰＳ衛星を抽出する。この処理は、内部メモリ１６ｃ上に予め用意されたアルマナックデ−タを参照しながら実行する。このアルマナックデ−タには、各々のＧＰＳ衛星に関する時刻毎の位置が保持されているので、現在時刻における各ＧＰＳ衛星の位置を求め、それらの位置と自車位置から、自車から各ＧＰＳ衛星をみた仰角を算出し、仰角が大きいものから８個のＧＰＳ衛星の番号（アルマナックデ−タ上の衛星番号）を抽出し、これらに抽出順に１〜８の番号ｉを割り当てる（３）。具体的には、登録テ−ブル（メモリの一領域）の第１〜８アドレスに、抽出したＧＰＳ衛星の番号（アルマナックデ−タ上の衛星番号）を、抽出順に書込む。
【００２９】
次のステップ４では、使用するＧＰＳ衛星を選択する（後述のステップ７〜２３の処理対象に設定する）。電源オン後初回のステップ４の実行では、ステップ３で抽出した８個のＧＰＳ衛星を選択するが、第２回以後のステップ４の実行では、状態レジスタＦlag-ｄi，Ｆlag-ｐi又はＦlag-ｖiのデ−タが「１」のＧＰＳ衛星を選択し、状態レジスタＦlag-ｄi，Ｆlag-ｐiおよびＦlag-ｖiのデ−タがすべて「０」のＧＰＳ衛星は除外する。この除外により、選択したＧＰＳ衛星の数が４以下になるときには、前記８個のＧＰＳ衛星の中の、今回除外したＧＰＳ衛星を除くものを選択する。
【００３０】
そして選択したＧＰＳ衛星のそれぞれにつき、ステップ５〜２２の処理、すなわちＧＰＳ衛星のトラッキング（５〜８，１０），ドップラーシフトΔｆの算出（９），ドップラーシフトΔｆの変化速度ΔΔｆ（Ｔｓ間の変化量）の算出（１１〜１３），変化速度ΔΔｆの異常判定（１４，１７），ＧＰＳ衛星情報のセ−ブ（１５，１６），距離計算（１８，１９）、および、変化速度ΔΔｆによる受信電波の信頼性判定（２０〜２２）、を実行する。
【００３１】
１つのＧＰＳ衛星（着目衛星）ｉに関するこの処理（５〜２２）の内容を説明すると、まず、着目衛星ｉの衛星番号（アルマナックデ−タ上の衛星番号）を、ＧＰＳ復調器１２のコ−ド発生器にセットする（５）。ＧＰＳ衛星が送信する電波は、その衛星に割り当てられたＰＮコ−ド（１０２３ビットで一順するゴ−ルド符号）によってスペクトラム拡散されているので、ＧＰＳ衛星が送信する情報を復調するためには、受信した信号を送信側と同一のＰＮコ−ドによってスペクトラム逆拡散する必要がある。各ＧＰＳ衛星のＰＮコ−ドは予め分かっており、アルマナックデ−タに登録されているので、デ−タを受信しようとする着目衛星ｉのＰＮコ−ドを、アルマナックデ−タの中から取り出して、コ−ド発生器にセットする。また、着目衛星の発信周波数（公称周波数）ｆｏをアルマナックデ−タの中から取り出してレジスタにセ−ブする。
【００３２】
次のステップ６では、状態レジスタＦlag-ｄi，Ｆlag-ｐiおよびＦlag-ｖiを、着目衛星ｉの番号ｉに対応するものに特定する（ｉ＝１〜８の中の、ステップ３で着目衛星が割り当てられたｉ値で現わされる状態レジスタのみを、以下のステップ１０〜２２の処理対象レジスタＦlag-ｄi，Ｆlag-ｐiおよびＦlag-ｖiに定める）。例えば、着目衛星が、ステップ３で第３番目に摘出され、ｉ＝３に対応付けられているものであると、ステップ１０〜２２のＦlag-ｄi，Ｆlag-ｐiおよびＦlag-ｖiは、Ｆlag-ｄ３，Ｆlag-ｐ３およびＦlag-ｖ３と定める。
【００３３】
ステップ７では、送信側と受信側のＰＮコ−ドのトラッキングを実施する。即ち、送信側と受信側のＰＮコ−ドが同一であっても、それらの位相が一致しなければスペクトラム逆拡散されないので、ＰＮコ−ド間の位相合せを実施する。実際には、送信側のビットレ−ト（1.023Ｍbps）より少し早いビットレ−ト（1.02 4Ｍbps）で受信側のＰＮコ−ドを生成することにより、ＰＮコ−ドが一順する間に送信側と受信側のＰＮコ−ドの位相が１ビットづつずれ、時間の経過とともに位相差が変化する。
【００３４】
そこで、送信側と受信側のＰＮコ−ドの位相差がなくなった時に、受信側のビットレ−トが送信側と同一になるようにコ−ド発生器のビットレ−トを調整し、ＰＮコ−ドの位相を同期させる。位相の同期がとれると、復調器の出力に信号が現われる。このときの同調周波数（受信周波数）ｆRをレジスタにセ−ブし、ドップラーシフトΔｆ＝ｆR−ｆｏを算出してレジスタにセ−ブする（９）。結局同期がとれなかったとき（トラッキング不成功のとき）には、ステップ１０で、着目衛星に対応する状態レジスタＦlag-ｄi，Ｆlag-ｐiおよびＦlag-ｖiをクリアして、図３のステップ２３の、選択した全衛星のトラッキング以下の処理（５〜２２）を完了したかをチェックして（２３）、まだ残りがあると、次の衛星のトラッキング（５〜７）に進む。
【００３５】
トラッキングに成功し、ドップラーシフトΔｆ＝ｆR−ｆｏを算出したときには、Ｆlag-ｄiのデ−タをチェックして（１１）、それが「０」（着目衛星に関して前回のドップラーシフト算出値が無い＝変化速度ΔΔｆの算出不可）であると、次回は算出可となるので、Ｆlag-ｄiに「１」を書込み、Ｆlag-ｐiおよびＦ lag-ｖiはクリアして、前回算出値レジスタΔｆ‘に、今回算出値Δｆを書込む（１３）。そして、選択した全衛星のトラッキング以下の処理（５〜２２）を完了したかをチェックして（２３）、まだ残りがあると、次の衛星のトラッキング（５〜７）に進む。ステップ１１で、Ｆlag-ｄiのデ−タが「１」（着目衛星に関して前回のドップラーシフト算出値がある＝変化速度ΔΔｆの算出可）であったときには、変化速度ΔΔｆ＝Δｆ−Δｆ‘を算出してレジスタにセ−ブし、前回算出値レジスタΔｆ‘に、今回算出値Δｆを書込む（１２）。
【００３６】
そして変化速度ΔΔｆが第１しきい値３０Hz/sを越えているかをチェックする。すなわちΔΔｆが異常値であるかをチェックする（１４）。この実施例は、異常値か否かの判定の第１しきい値を３０Hz/sに設定している。ΔΔｆ＞３０Hz/sは、ＧＰＳ衛星からの直進電波を車両上で受信している場合には、実質上あり得ないと見込まれるドップラーシフト変化速度である。ΔΔｆ＞３０Hz/sの場合はしたがって、マルチパス等の異常電波（例えば高層ビルの反射波）受信であるとして、着目衛星を、トラッキング不成功の場合と同様に利用不可と決定する。具体的には、Ｆlag-ｄi，Ｆlag-ｐiおよびＦlag-ｖiをクリアして（１７）、選択した全衛星のトラッキング以下の処理（５〜２２）を完了したかをチェックして（２３）、まだ残りがあると、次の衛星のトラッキング（５〜７）に進む。ステップ１４のチェックで、ΔΔｆ≦３０Hz/sであったときには、ステップ１５を介してステップ１６に進み、復調デ−タの入力を開始する。ＧＰＳ衛星が送信する信号は、５０ｂｐｓのビットレ−トの二値信号であり、図４に示されるように、３００ビットで構成されるサブフレ−ムの繰り返しである。各サブフレ−ムは、それぞれ３０ビットで構成されるワ−ド１〜ワ−ド１０からなっている。これらのデ−タの中には、フレ−ム同期のためのプリアンブル，送信時刻を示すＺカウント，衛星の軌道を示すエフェメリス（Ephemeris），アルマナック等が存在する。まず最初にプリアンブルを検出してフレ−ム同期をとった後、それに続く様々なデ−タをサブフレ−ム内の各々のビット位置に応じたメモリアドレスに記憶する。
【００３７】
図３を参照する。次のステップ１８では、衛星が信号を送出してからその信号が受信点に到達するまでの、電波の伝播に要する所要時間、即ち伝播遅延時間を測定する。この処理の具体的な内容を、図５に示す。図５の処理を説明する。ステップ４１では、まず、Ｚカウントと呼ばれる時刻デ−タを検出する。Ｚカウントは、図４に示すように、伝送デ−タの各サブフレ−ムのワ−ド２に含まれているので、それを検出し内容をメモリＴＺにストアする（４２）。また、ビット位置の計数を開始する（４３）。Ｚカウントの内容は、次のサブフレ−ムの先頭が送信される予定の時刻であり、非常に正確である。従って、次のサブフレ−ムの先頭が受信側で検出された時刻とＺカウントの時刻との差が、送受信地点間の電波の伝播遅延時間に相当する。但し、次のサブフレ−ムの先頭のタイミングで、遅れを生じることなく、その時刻を正確に検出しなければならない。従って、Ｚカウントを検出した後、その位置からのビット数を計数してビット位置を常に把握する。そしてステップ４４では、次のサブフレ−ムの先頭ビットの立ち上がりが現われるのを待つ。Ｚカウントを検出した次のサブフレ−ムの先頭ビットの立ち上がりが現われると、ステップ４４からステップ４５に進み、この時の内部時計１６ｈの時刻情報をメモリＴｒにストアする。次のステップ４６では、メモリＴｒの内容からメモリＴＺの内容を減算した結果を、メモリＴｄにストアする。即ち、Ｚカウントの時刻と実際の受信時刻との時間差がメモリＴｄに保持される。内部時計１６ｈの時刻が正確であるとは限らないが、仮に誤差が充分に小さいものとすれば、メモリＴｄの内容は送受信地点間の電波の伝播遅延時間と一致する。なお、図５に示す処理は、この実施例ではコンピュ−タのソフトウェア処理により実施しているが、この処理の一部分あるいは全部を、専用のハ−ドウェアにより実行するように構成してもよい。再び図３を参照して説明を続ける。ステップ１９では、デ−タを受信中のＧＰＳ衛星と受信点との間の距離ｒ１を計算により求める。ここでは、前のステップ１８で測定された伝播遅延時間、即ちメモリＴｄの内容に基づいて距離ｒ１を求める。電波の伝播速度は光速と同一で一定であるので、伝播遅延時間に光速を掛けることにより、距離ｒ１が得られる。
【００３８】
次のステップ２０では、変化速度ΔΔｆが第２しきい値１５Hz/s以下か否かをチェックする。第２しきい値１５Hz/sは、衛星からの直進電波受信から、マルチパス等の異常電波（例えば高層ビルの反射波）受信への変化のときほどには大きくないが、代表的には車両の加，減速あるいは進行方向変化により衛星から受信した情報に基づいた車両（受信機）速度ベクトルの演算値に比較的に大きなエラ−を生ずる可能性がある場合など、速度ベクトル演算の信頼性が低いか否かを識別するためのものである。変化速度ΔΔｆが第２しきい値１５Hz/sを越えるときには、この着目衛星からの情報に基づいた速度ベクトル演算の信頼性は低いと見込まれるので、レジスタＦlag-ｐiには「１」（位置演算には利用可）を書込むが、速度ベクトル演算にこの着目衛星からの情報は参照しないようにするため、レジスタＦlag-ｖiはクリアする（２２）。変化速度ΔΔｆが第２しきい値１５H z/s以下のときにはレジスタＦlag-ｐiおよびＦlag-ｖiに「１」を書込む（２１）。
【００３９】
次に、ステップ４で選択した衛星のすべてに関して上述のステップ５〜２２の処理を実行したかをチェックして（２３）、未処理衛星があると、該衛星を着目衛星として上述の処理を行なう。
【００４０】
ステップ４で選択した衛星のすべてにつき、上述の処理を完了すると、デ−タが「１」（位置演算に利用可能）のレジスタＦlag-ｐiを摘出して、それが４個以上であると「位置ベクトル計算（３Ｄ測位）」２６を、３個のときには「位置ベクトル計算（２Ｄ測位）」２７を実行する。２個以下のときには位置ベクトル計算は実行しない（２４〜２７）。
【００４１】
ステップ２６の「位置ベクトル計算（３Ｄ測位）」及びステップ２７の「位置ベクトル計算（２Ｄ測位）」の基本的な処理は、良く知られた技術であるので、これらの詳細説明は省略するが、簡単に言えば、「位置ベクトル計算（３Ｄ測位）」２６では、予め定めた４元連立方程式に、デ−タ「１」を格納したレジスタＦ lag-ｐi（４個）に対応する４個の衛星から受信した４組のデ−タをそれぞれパラメ−タとして代入し、この連立方程式を解くことにより、未知数である受信点の緯度，経度，高度，及び受信側の時計の誤差を求める。「位置ベクトル計算（２Ｄ測位）」２７では、予め定めた３元連立方程式に、３個の衛星から受信した３組のデ−タをそれぞれパラメ−タとして代入し、この連立方程式を解くことにより、未知数である受信点の緯度，経度，及び受信側の時計の誤差を求める。受信点の高度は、この例では高度センサ１５が出力する信号から計算により求め、既知デ−タとして上記方程式に代入する。また、これらのいずれかの測位演算を実行することにより、受信側の時計の誤差が得られるので、この誤差情報に基づいて内部時計１６ｈの時刻を校正する。
【００４２】
次にステップ２８で、デ−タが「１」（速度演算に利用可能）のレジスタＦla g-ｖiを摘出して、それが３個以上であると「速度ベクトル計算」２９を実行するが、２個以下であるとこれは実行しない。「速度ベクトル計算」２９では、３個の衛星からの受信デ−タならびに上述の処理により算出したデ−タに基づいて、車両（受信機）の対地速度および進行方向方位を算出する。
【００４３】
次に、ここまでの処理により得られた受信点の緯度，経度，対地速度および進行方向方位（新たに得られなかったデ−タは、それまでに保持しているデ−タとする）、に基づいて、出力デ−タを演算および編集し（３０）、表示装置１３に出力する（３１）。すなわち、受信点の緯度，経度に基づいて、該受信点を含む地域を表わす地域Ｎｏ．をＲＯＭ１６ｃから検索して、得た地域Ｎｏ．が、表示装置１３に表示中の地図の地域Ｎｏ．と同一かをチエックして、異っていると検索して得た地域Ｎｏ．の地図情報をＤＭＡ転送でＲＯＭ１６ｃから表示装置１３に転送する。そして表示装置１３が表示している地図上に、受信点を表わすマ−クを表示する（受信点表示マ−クを今回得た受信点にシフトする）。そして地図上の、受信点から見た、地図上に書込まれている地上指標までの距離および方位を算出して、受信点の緯度，経度，対地速度，進行方向方位，地上指標までの距離および方位を、表示装置１３に追加表示する（すでに表示されているそれらのデ−タを、今回得たものに更新する）。
【００４４】
次にステップ４に戻る。ここで、前回のステップ４の実行により選択した衛星の中の、対応するレジスタＦlag-ｄi，Ｆlag-ｐiおよびＦlag-ｖiのデ−タがいずれも「０」の衛星を摘出して、それらを選択メモリから除外する。そして選択メモリに残った衛星を計数し、計数値が４以下であると、ステップ３で抽出した８個の衛星の中の、今回選択メモリから除外したもの、および選択メモリに残っているもの、を除く衛星を選択メモリに加える。そしてステップ５に進む。
【００４５】
なお、ＧＰＳ受信機がＴｓ＝１秒周期で測位解を算出する場合（毎秒測位の場合）、ＣＰＵ１６ａは、衛星のそれぞれにつきステップ４〜３１の処理をＴｓ＝１秒周期で実行する。従って変化速度ΔΔｆを算出する周期もＴｓ＝１秒周期であり、ΔΔｆはＴｓ＝１秒の間のドップラーシフトΔｆの変化量である。
【００４６】
以上に説明した実施例によれば、衛星からの電波のドップラーシフトΔｆの変化速度ΔΔｆが第１しきい値３０Hz/sを越えるときには、トラッキング失敗のときと同様に、該衛星に対応するレジスタＦlag-ｄi，Ｆlag-ｐiおよびＦlag-ｖiに「０」を書込んで（１７）、該衛星を位置演算（２６，２７）および速度演算（２９）には参照しないようにしているので、衛星からの直進電波受信から、マルチパス等の異常電波（例えば高層ビルの反射波）受信に変化したなど、受信異常が想定される場合の、位置演算および速度演算のエラ−が低減する。また、変化速度ΔΔｆが第２しきい値１５Hz/sを越えるときには、Ｆlag-ｐiには「１」を書込むがＦlag-ｖiには「０」を書込んで（２２）、該衛星を位置演算（２６，２７）には参照するが、速度演算（２９）には参照しないようにしているので、車両（受信機）の加，減速度が大きいとか、車両の進行方向が急速に変化しているときの速度演算のエラ−が低減する。このように、衛星が発射する電波の受信環境の良否判定は、ドップラーシフトの変化速度ΔΔｆに基づいて行なうが、ドップラーシフトΔｆの算出（９）およびその変化速度ΔΔｆの算出にはほとんど時間がかからず、ＣＰＵ１６ａが該良否判定に費す時間は僅少である。
【図面の簡単な説明】
【図１】本発明の一実施例の構成を示すブロック図である。
【図２】図１のＣＰＵ１６ａの動作の一部を示すフロ−チャ−トである。
【図３】図１のＣＰＵ１６ａの動作の残部を示すフロ−チャ−トである。
【図４】衛星の送信デ−タの構成を示すタイムチャ−トである。
【図５】図３のステップ１８の内容を示すフロ−チャ−トである。
【符号の説明】
１０：受信アンテナ１１：ＧＰＳ受信機
１２：ＧＰＳ復調器１３：表示装置
１４：圧電振動ジャイロ１５：高度センサ
１６：ＧＰＳ情報処理ユニット
１７：操作ボ−ド１６ａ：ＣＰＵ
１６ｂ：ＲＡＭ１６ｃ：ＲＯＭ
１６ｄ：Ｉ／Ｏポ−ト１６ｅ：Ａ／Ｄ変換器
１６ｆ：タイマ１６ｇ：割込制御回路
１６ｈ：時計

Claims

それの軌道情報と時刻の情報を送出する複数のＧＰＳ衛星からの情報を受信する受信手段；
前記ＧＰＳ衛星が発射する信号の周波数と前記受信手段が受信した信号の周波数の差Δｆを算出する偏差計算手段；
該差Δｆの変化速度ΔΔｆを求める変化量計算手段；および、
前記変化速度ΔΔｆが第１しきい値以下の複数のＧＰＳ衛星の、前記受信手段が受信した情報に基づいて、前記受信手段の位置を求め、変化速度ΔΔｆが、第１しきい値より小さい第２しきい値以下の複数のＧＰＳ衛星の、前記受信手段が受信した情報に基づいて、前記受信手段の進行方向方位を求める測位演算手段；
を備えるＧＰＳ衛星を利用する測位装置。
前記測位演算手段は、第２しきい値以下の複数のＧＰＳ衛星の、前記受信手段が受信した情報に基づいて、前記受信手段の速度を求める請求項１に記載のＧＰＳ衛星を利用する測位装置。
前記測位演算手段は、複数のＧＰＳ衛星のアルマナックデ−タと前記受信手段の位置に基づいて、複数のＧＰＳ衛星を選択して登録テ−ブルに書込み、該登録テ−ブルの複数のＧＰＳ衛星を選択して前記受信手段を用いてトラッキングし、トラッキングに失敗したＧＰＳ衛星、ならびに、前記変化速度ΔΔｆが第１しきい値を越えるＧＰＳ衛星を前記選択したＧＰＳ衛星群から消去し、これにより該ＧＰＳ衛星群のＧＰＳ衛星が設定数未満になると該消去したＧＰＳ衛星を除く前記登録テ−ブルのＧＰＳ衛星を前記ＧＰＳ衛星群に加え；前記受信手段は、前記ＧＰＳ衛星群のＧＰＳ衛星からの情報を受信する；請求項１又は２に記載のＧＰＳ衛星を利用する測位装置。
前記受信手段の高度を検出する高度センサ；を更に備え、前記測位演算手段は、前記変化速度ΔΔｆが、第１しきい値以下の複数のＧＰＳ衛星の個数が４以上のときは、これらのＧＰＳ衛星から前記受信手段が受信した情報に基づいて受信手段の位置を求め、前記変化速度ΔΔｆが第１しきい値以下のＧＰＳ衛星の個数が３のときは、これらのＧＰＳ衛星から前記受信手段が受信した情報ならびに前記高度センサの検出高度に基づいて前記受信手段の位置を求める；請求項１乃至３の何れか１つに記載のＧＰＳ衛星を利用する測位装置。