説明

測位装置、測位装置の制御方法、測位装置の制御プログラム

【課題】前回の測位位置が現在位置と大きく異なる場合であっても、マルチパスを確実に排除することができる測位装置等を提供すること。
【解決手段】高信頼度衛星HSVを含む基準衛星群BSを生成する基準衛星群情報生成手段と、基準衛星群BSを使用して基準位置BPを示す基準位置情報を生成する基準位置情報生成手段と、第1擬似距離と第1近似距離との差分である第1差分を算出する第1差分算出手段と、第1差分が、直接波に対応する範囲として予め規定した第1測位使用可能範囲内か否かを判断する第1測位使用可能性判断手段と、第1測位使用可能範囲内の第1差分に対応する通常衛星と高信頼度衛星を構成要素とする第1測位使用衛星群を生成する第1測位使用衛星群生成手段と、第1測位使用衛星群を使用して測位を行い、出力用の測位位置を示す測位位置情報を生成する第1測位位置情報生成手段等を有する。

【発明の詳細な説明】
【技術分野】
【0001】
本発明は、測位衛星からの電波を利用する測位装置、測位装置の制御方法、測位装置の制御プログラムに関するものである。
【背景技術】
【0002】
従来、衛星航法システムである例えば、GPS(Global Positioning System)を利用してGPS受信機の現在位置を測位する測位システムが実用化されている。
このGPS受信機は、GPS衛星の軌道等を示す航法メッセージ(概略衛星軌道情報:アルマナック、精密衛星軌道情報:エフェメリス等を含む)に基づいて、GPS衛星からの電波(以後、衛星電波と呼ぶ)に乗せられている擬似雑音符号(以後、PN(Psuedo random noise code)符号と呼ぶ)の一つであるC/A(Clear and AcquisitionまたはCoarse and Access)コードを受信する。C/Aコードは、測位の基礎となる測位基礎符号である。
GPS受信機は、そのC/AコードがどのGPS衛星から発信されたものであるかを特定したうえで、そのC/Aコードの発信時刻と受信時刻に基づいて、GPS衛星とGPS受信機の距離(擬似距離)を算出する。そして、GPS受信機は、3個以上のGPS衛星についての擬似距離と、各GPS衛星の衛星軌道上の位置に基づいて、GPS受信機の位置を測位するようになっている(特開平10−339772号公報等参照)。
ここで、衛星電波はGPS受信機に直接波として到達する場合のほかに、建物等に反射して間接波(以下「マルチパス」と呼ぶ)として到達する場合がある。
マルチパスにおいては、C/Aコードの受信時刻が直接波に比べて遅れるため、擬似距離に誤差を生じる。この結果、測位精度が劣化するという問題がある。
これに対して、各GPS衛星について、擬似距離と、前回の測位位置とGPS衛星の衛星軌道上の現在位置との距離(近似距離)とを算出し、擬似距離と近似距離との差が予め定めた誤差許容範囲を越えた場合にマルチパスであると判断し、マルチパスを測位計算に使用しない技術が提案されている(例えば、特許文献1)。
【特許文献1】特開2003−57327号公報
【発明の開示】
【発明が解決しようとする課題】
【0003】
しかし、上述の技術においては、前回の測位位置を現在位置と擬制しているため、高速で移動している場合や衛星電波を長時間受信できない場合等、前回の測位位置が現在位置と大きく異なる場合には有効ではない。上述の技術は、例えば、衛星電波を長時間受信できない場合に上述の誤差許容範囲を大きくして対応しているが、誤差許容範囲を大きくするとマルチパスを排除できない場合があるという問題がある。
すなわち、前回の測位位置が現在位置と大きく異なる可能性がある場合に、誤差許容範囲を調整すると、その調整の仕方が不適切であれば、マルチパスを排除できない場合がある。
また、マルチパスと直接波を区別するために、GPS受信機の速度等に応じて誤差許容範囲を調整することは困難であり、上述の特許文献1にも誤差許容範囲の調整方法は具体的に開示されていない。
【0004】
そこで、本発明は、前回の測位位置が現在位置と大きく異なる場合であっても、マルチパスを確実に排除することができる測位装置、測位装置の制御方法、測位装置の制御プログラムを提供することを目的とする。
【課題を解決するための手段】
【0005】
前記目的は、第1の発明によれば、複数の測位衛星からの衛星電波に乗せられている測位基礎符号を使用して、現在位置を測位する測位装置であって、前記衛星電波を受信する衛星電波受信手段と、前記衛星電波の受信強度及び前記測位衛星の仰角に基づいて前記衛星電波が直接波である信頼度が高いか否かを判断し、前記信頼度が高い前記衛星電波に対応する前記測位衛星である高信頼度衛星を示す高信頼度衛星情報を生成する高信頼度衛星情報生成手段と、前記高信頼度衛星を構成要素とする基準衛星群を生成する基準衛星群生成手段と、前記基準衛星群を使用して現在位置を予備測位して、出力用の測位に使用する前記測位衛星を選択するための基準位置を示す基準位置情報を生成する基準位置情報生成手段と、前記高信頼度衛星以外の前記測位衛星である通常衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である第1擬似距離を算出する第1擬似距離算出手段と、前記基準位置と、前記通常衛星の衛星軌道上の現在座標との距離である第1近似距離を算出する第1近似距離算出手段と、前記第1擬似距離と前記第1近似距離との差分である第1差分を算出する第1差分算出手段と、前記第1差分が、直接波に対応する範囲として予め規定した第1測位使用可能範囲内か否かを判断する第1測位使用可能性判断手段と、前記高信頼度衛星と前記第1測位使用可能範囲内の前記第1差分に対応する前記通常衛星とを構成要素とする第1測位使用衛星群を生成する第1測位使用衛星群生成手段と、前記第1測位使用衛星群を使用して測位を行い、出力用の測位位置を示す測位位置情報を生成する第1測位位置情報生成手段と、を有することを特徴とする測位装置により達成される。
【0006】
第1の発明の構成によれば、前記測位装置は、前記基準衛星群情報生成手段を有するから、前記基準衛星群情報を生成することができる。前記基準衛星群は、前記高信頼度衛星を構成要素としている。すなわち、前記基準衛星群は直接波に対応する前記測位衛星のみを含み、マルチパスに対応する前記測位衛星を確実に排除して形成されている。
そして、前記測位装置は、前記基準位置情報生成手段を有するから、前記基準位置情報を生成することができる。前記基準位置は、前回の測位位置に基づいて予測した位置ではなくて、実際に現在位置を測位することによって算出された位置である。すなわち、前記基準位置は、現在位置そのものである。
しかも、前記基準位置は前記基準衛星群を使用して生成されているから、マルチパスを排除して算出されており、マルチパスの影響による測位精度の劣化はない。
そして、前記測位装置は、前記第1擬似距離算出手段によって前記第1擬似距離を算出することができ、前記第1近似距離算出手段によって前記第1近似距離を算出することができる。本明細書において「近似距離」は、基準となる地上の位置と測位衛星の現在時刻における衛星軌道上の座標(以後「現在座標」と呼ぶ)との距離を意味する。
ここで、前記第1近似距離は、前回の測位位置に基づいて予測した位置を基礎とするのではなくて、前記基準位置を基礎としているから精度が高い。
さらに、前記測位装置は、前記第1測位使用可能性判断手段によって、前記第1擬似距離と前記第1近似距離との差分である前記第1差分が、直接波に対応する範囲として予め規定した前記第1測位使用可能範囲内か否かを判断することができる。
そして、前記測位装置は、前記第1測位使用衛星群生成手段を有するから前記第1測位使用衛星群を生成することができる。
上述のように、前記基準位置は現在位置そのものであるから、前記測位装置の移動速度や前記衛星電波を受信することができなかった時間によって、前記第1測位使用可能範囲を変更する必要はない。言い換えると、前記第1測位使用可能範囲を直接波に対応する範囲として予め規定すれば、前記測位装置の移動速度や前記衛星電波を受信することができなかった時間にかかわらず、その前記第1測位使用可能範囲を使用することができる。
このため、前記測位装置は、マルチパスに対応する前記通常衛星だけを確実に排除し、直接波に対応する前記測位衛星だけで前記第1測位使用衛星群を形成することができる。
そして、前記測位装置は、前記第1測位位置情報生成手段によって、前記第1測位使用衛星群を使用して前記測位位置情報を生成するから、マルチパスを排除して前記測位位置情報を生成することができる。
以上のように、前記測位装置は、前回の測位位置が現在位置と大きく異なる場合であっても、マルチパスを確実に排除することができる。
また、上述のように、前記測位装置は、前記基準衛星群情報を出力用の測位には使用せずに、前記基準位置情報を生成するために使用する。そして、前記測位装置は、前記第1測位使用衛星群を使用して、出力する前記測位位置情報を生成する。
前記基準衛星群は、マルチパスを送信する前記測位衛星を含まないが、仰角が高い前記測位衛星で構成されるため、天空における配置(PDOP等)が必ずしも良好ではない。
このため、前記測位装置は、前記第1測位使用衛星群を使用して、出力するための前記測位位置情報を生成する。前記第1測位使用可能範囲内の前記通常衛星は、前記高信頼度衛星以外の前記測位衛星であって、直接波に対応する衛星である。従って、前記第1測位使用衛星群を構成する衛星数は、前記基準衛星群を構成する衛星数以上である。これは、前記第1測位使用衛星群のPDOP等は、前記基準衛星群のPDOP等よりも良好である可能性が大きいことを意味する。
このため、前記測位装置は、前記第1測位使用衛星群を使用することによって、高精度の前記測位位置情報を生成することができる。
【0007】
第2の発明は、第1の発明の構成において、前記高信頼度衛星が4個未満である場合には、前記高信頼度衛星と前記通常衛星の合計数が4個である予備衛星群を示す予備衛星群情報を生成する予備衛星群情報生成手段と、各前記予備衛星群を使用して測位計算を行って測位結果を算出し、前記測位結果のPosition Sigmaを算出するPosition Sigma算出手段を有し、前記基準衛星群情報生成手段は、前記Position Sigmaが最小の前記予備衛星群を前記基準衛星群とする構成となっていることを特徴とする測位装置である。
【0008】
第2の発明の構成によれば、前記測位装置は、前記高信頼度衛星が4個未満である場合には、前記Position Sigmaが最小の前記予備衛星群を前記基準衛星群とすることができる。ここで、Position Sigmaとは、測位結果の標準偏差を意味する。従って、Position Sigmaが小さいほど、測位結果のばらつきは小さく、測位結果は安定している。このため、Position Sigmaが小さい前記予備衛星群を使用した測位結果ほど、信頼性が高い。
このため、前記測位装置は、前記高信頼度衛星が4個未満であっても、信頼性が高い前記基準位置情報を生成することができる。
【0009】
前記目的は、第3の発明によれば、複数の測位衛星からの衛星電波に乗せられている測位基礎符号を使用して、現在位置を測位する測位装置であって、前記衛星電波を受信する衛星電波受信手段と、前記衛星電波の受信強度及び前記測位衛星の仰角に基づいて前記衛星電波が直接波である信頼度が高いか否かを判断し、前記信頼度が高い前記衛星電波に対応する前記測位衛星である高信頼度衛星を示す高信頼度衛星情報を生成する高信頼度衛星情報生成手段と、前記高信頼度衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である高信頼度衛星擬似距離を算出する高信頼度衛星擬似距離算出手段と、前回の前記測位位置と、前回の前記測位装置の速度ベクトル及び前回測位時から現在までの経過時間に基づいて、現在の予測位置を算出する予測位置算出段と、前記予測位置と、前記高信頼度衛星の衛星軌道上の現在座標との距離である高信頼度衛星近似距離を算出する高信頼度衛星近似距離算出手段と、前記高信頼度衛星擬似距離と前記高信頼度衛星近似距離との差分である高信頼度衛星差分を算出する高信頼度衛星差分算出手段と、すべての前記高信頼度衛星差分の平均値である平均差分を算出する平均差分算出手段と、前記高信頼度衛星以外の前記測位衛星である通常衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である第2擬似距離を算出する第2擬似距離算出手段と、前記予測位置と、前記通常衛星の衛星軌道上の現在座標との距離である第2近似距離を算出する第2近似距離算出手段と、前記第2擬似距離と前記第2近似距離との差分である第2差分を算出する第2差分算出手段と、前記平均差分と前記第2差分との差分である測位使用可能性判定値を算出する測位使用可能性判定値算出手段と、前記測位使用可能性判定値が、直接波に対応する範囲として予め規定した第2測位使用可能範囲内か否かを判断する第2測位使用可能性判断手段と、前記高信頼度衛星と前記第2測位使用可能範囲内の前記測位使用可能性判定値に対応する前記通常衛星とを構成要素とする第2測位使用衛星群を生成する第2測位使用衛星群生成手段と、前記第2測位使用衛星群を使用して測位を行い、出力用の測位位置を示す測位位置情報を生成する第2測位位置情報生成手段と、を有することを特徴とする測位装置によって達成される。
【0010】
第3の発明の構成によれば、前記測位装置は、前記予測位置算出手段を有するから、前記予測位置を算出することができる。
前記予測位置は、前回の前記測位位置と、前回の前記測位装置の速度ベクトル及び前回測位時から現在までの経過時間に基づいて生成されているから、現在位置と擬制することができる。すなわち、前記予測位置は、前記測位装置の移動速度や、前記衛星電波を受信することができなかった時間にかかわらず、現在位置と擬制することができる。これは、前記測位装置は、前回の前記測位位置を現在位置であると擬制するのではないことを意味する。
そして、前記測位装置は、前記平均差分算出手段によって、前記平均差分を算出することができる。前記平均差分は、前記高信頼度衛星差分の平均値であるから、直接波の擬似距離と近似距離の差分を正確に示している。このため、前記平均差分は、前記通常衛星からの前記衛星電波がマルチパスであるか否かを正確に判断するための基礎となる情報である。
そして、前記測位装置は、前記第2擬似距離算出手段によって、前記第2擬似距離を算出することができ、前記第2近似距離算出手段によって、前記第2近似距離を算出することができる。前記第2近似距離は、前回の前記測位位置を基準にして生成したのではなくて、前記予測位置を基準に生成されているから精度が高い。
そして、前記測位装置は、前記第2差分算出手段によって、前記第2差分を算出することができ、前記測位使用可能性判定値算出手段によって、前記測位使用可能性判定値を算出することができる。
そして、前記測位装置は、第2測位使用可能性判断手段を有するから、前記測位使用可能性判定値が、直接波に対応する範囲として予め規定した第2測位使用可能範囲内か否かを判断することができる。
すなわち、前記第2差分だけを基準にして直接波とマルチパスを区別するのではなくて、現時点において実際に算出した前記平均差分との差分である前記測位使用可能性判定値を使用して直接波とマルチパスを区別するから、前記衛星電波の受信状況に応じて、より確実に、直接波とマルチパスを区別することができる。
また、前記平均差分及び前記第2差分の基礎となる前記予測位置は、現在位置と擬制することができるから、前記測位装置の移動速度や前記衛星電波を受信することができなかった時間にかかわらず、同一の前記第2測位使用可能範囲を使用することができる。このため、確実に前記マルチパスを排除することができる。
そして、前記測位装置は、前記第2測位使用衛星群生成手段によって、前記第2測位使用衛星群を生成することができ、前記第2測位位置情報生成手段によって、出力用の前記測位位置情報を生成することができる。
上述のように、前記測位装置は、前記第2測位使用衛星群を使用して、出力するための前記測位位置情報を生成する。前記第2測位使用衛星群を構成する衛星数は、前記高信頼度衛星衛星数以上である。したがって、前記第2測位使用衛星群のPDOP等は、前記高信頼度衛星だけのPDOP等よりも良好である可能性が大きい。
このため、前記測位装置は、前記第2測位使用衛星群を使用することによって、高精度の前記測位位置情報を生成することができる。
【0011】
前記目的は、第4の発明によれば、複数の測位衛星からの衛星電波に乗せられている測位基礎符号を使用して、現在位置を測位する測位装置であって、前記衛星電波を受信する衛星電波受信手段と、前記衛星電波の受信強度及び前記測位衛星の仰角に基づいて前記衛星電波が直接波である信頼度が高いか否かを判断し、前記信頼度が高い前記衛星電波に対応する前記測位衛星である高信頼度衛星を示す高信頼度衛星情報を生成する高信頼度衛星情報生成手段と、前記高信頼度衛星を構成要素とする基準衛星群を生成する基準衛星群生成手段と、前記基準衛星群を使用して現在位置を予備測位して、出力用の測位に使用する前記測位衛星を選択するための基準位置を示す基準位置情報を生成する基準位置情報生成手段と、前記高信頼度衛星以外の前記測位衛星である通常衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である第1擬似距離を算出する第1擬似距離算出手段と、前記基準位置と、前記通常衛星の衛星軌道上の現在座標との距離である第1近似距離を算出する第1近似距離算出手段と、前記第1擬似距離と前記第1近似距離との差分である第1差分を算出する第1差分算出手段と、前記第1差分が、直接波に対応する範囲として予め規定した第1測位使用可能範囲内か否かを判断する第1測位使用可能性判断手段と、前記高信頼度衛星と前記第1測位使用可能範囲内の前記第1差分に対応する前記通常衛星とを構成要素とする第1測位使用衛星群を生成する第1測位使用衛星群生成手段と、前記第1測位使用衛星群を使用して測位を行い、出力用の測位位置を示す測位位置情報を生成する第1測位位置情報生成手段と、連続して出力される2つの前記測位位置の距離が、予め規定した安定距離範囲内であるか否かを判断する距離評価手段と、連続して出力される2つの前記測位位置の距離が前記安定距離範囲内であるという判断が、前記測位位置の安定性を判断するために予め規定した回数又は時間において継続したか否かを判断する測位位置安定性判断手段と、前記高信頼度衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である高信頼度衛星擬似距離を算出する高信頼度衛星擬似距離算出手段と、前回の前記測位位置と、前回の前記測位装置の速度ベクトル及び前回測位時から現在までの経過時間に基づいて、現在の予測位置を算出する予測位置算出段と、前記予測位置と、前記高信頼度衛星の衛星軌道上の現在座標との距離である高信頼度衛星近似距離を算出する高信頼度衛星近似距離算出手段と、前記高信頼度衛星擬似距離と前記高信頼度衛星近似距離との差分である高信頼度衛星差分を算出する高信頼度衛星差分算出手段と、すべての前記高信頼度衛星差分の平均値である平均差分を算出する平均差分算出手段と、前記高信頼度衛星以外の前記測位衛星である通常衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である第2擬似距離を算出する第2擬似距離算出手段と、前記予測位置と、前記通常衛星の衛星軌道上の現在座標との距離である第2近似距離を算出する第2近似距離算出手段と、前記第2擬似距離と前記第2近似距離との差分である第2差分を算出する第2差分算出手段と、前記平均差分と前記第2差分との差分である測位使用可能性判定値を算出する測位使用可能性判定値算出手段と、前記測位使用可能性判定値が、直接波に対応する範囲として予め規定した第2測位使用可能範囲内か否かを判断する第2測位使用可能性判断手段と、前記高信頼度衛星と前記第2測位使用可能範囲内の前記測位使用可能性判定値に対応する前記通常衛星とを構成要素とする第2測位使用衛星群を生成する第2測位使用衛星群生成手段と、前記第2測位使用衛星群を使用して測位を行い、出力用の測位位置を示す測位位置情報を生成する第2測位位置情報生成手段と、を有することを特徴とする測位装置によって達成される。
【0012】
第4の発明の構成によれば、前記測位装置は、前記測位位置安定性判断手段を有するから、連続して出力される2つの前記測位位置の距離が前記安定距離範囲内であるという判断が、前記測位位置の安定性を判断するために予め規定した回数又は時間において継続したか否かを判断することができる。
すなわち、前記測位装置は、前記測位位置の安定性を判断することができる。
このため、前記測位装置は、例えば、前記測位位置が安定していない場合には、前記第1測位位置情報生成手段によって前記測位位置情報を生成し、前記測位位置が安定している場合には、前記第2測位位置情報生成手段によって前記測位位置情報を生成することができる。
前記第1測位位置情報生成手段による測位は、前記基準位置を予備測位を前提としているから、前記測位位置が安定していなくても、精度良く前記測位位置を算出することができる。
前記第2測位位置情報生成手段による測位において使用する前記予測位置情報は、前記測位装置の移動速度等にかかわらず、現在位置と擬制することができるのであるが、前記測位位置が安定している場合には、一層精度良く現在位置と擬制することができる。
このため、前記測位位置が安定していない場合には、前記第1測位位置情報生成手段によって測位を行い、前記測位位置が安定している場合には、前記第2測位位置情報生成手段によって測位を行うことによって、常に高精度の前記測位位置情報を生成することができる。
【0013】
第5の発明は、第1の発明乃至第4の発明のいずれかの構成において、前記測位衛星は、準天頂衛星を含むことを特徴とする測位装置である。
【0014】
第5の発明の構成によれば、前記測位衛星は前記準天頂衛星を含むから、少なくとも1つの前記高信頼度衛星からの前記衛星電波を確実に受信することができる。
【0015】
第6の発明は、第1の発明乃至第5の発明のいずれかの構成において、前記測位位置情報生成手段は、現在位置の緯度、経度、高度及び前記測位装置の時刻誤差を未知数とする方程式について、前記高信頼度衛星についての前記方程式の平均を使用することによって、未知数としての前記時刻誤差を消去することを特徴とする測位装置である。
【0016】
第6の発明の構成によれば、前記測位装置は、未知数としての前記時刻誤差を消去することができるから、測位計算の負荷が減少し、測位演算の速度を速くすることができる。
さらに、前記測位装置は、前記基準衛星群についての前記方程式の平均を使用することによって、測位精度を向上することができる。
【0017】
前記目的は、第7の発明によれば、複数の測位衛星からの衛星電波に乗せられている測位基礎符号を使用して、現在位置を測位する測位装置が、前記衛星電波を受信する衛星電波受信ステップと、前記測位装置が、前記衛星電波の受信強度及び前記測位衛星の仰角に基づいて前記衛星電波が直接波である信頼度が高いか否かを判断し、前記信頼度が高い前記衛星電波に対応する前記測位衛星である高信頼度衛星を示す高信頼度衛星情報を生成する高信頼度衛星情報生成ステップと、前記測位装置が、前記高信頼度衛星を含む基準衛星群を示す基準衛星群情報を生成する基準衛星群情報生成ステップと、前記測位装置が、前記基準衛星群を使用して現在位置を予備測位して、出力用の測位に使用する前記測位衛星を選択するための基準位置を示す基準位置情報を生成する基準位置情報生成ステップと、前記測位装置が、前記基準衛星群に含まれない前記測位衛星である通常衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である第1擬似距離を算出する第1擬似距離算出ステップと、前記測位装置が、前記基準位置と、前記基準衛星群に含まれない前記通常衛星の衛星軌道上の現在座標との距離である第1近似距離を示す第1近似距離情報を算出する第1近似距離算出ステップと、前記測位装置が、前記第1擬似距離と前記第1近似距離との差分である第1差分を算出する第1差分算出ステップと、前記測位装置が、前記第1差分が、直接波に対応する範囲として予め規定した第1測位使用可能範囲内か否かを判断する第1測位使用可能性判断ステップと、前記測位装置が、前記高信頼度衛星と前記第1測位使用可能範囲内の前記第1差分に対応する前記通常衛星とを構成要素とする第1測位使用衛星群を生成する第1測位使用衛星群生成ステップと、前記測位装置が、前記第1測位使用衛星群を使用して測位を行い、出力用の測位位置を示す測位位置情報を生成する第1測位位置情報生成ステップと、前記測位装置が、連続して出力される2つの前記測位位置の距離が、予め規定した安定距離範囲内であるか否かを判断する距離評価ステップと、前記測位装置が、連続して出力される2つの前記測位位置の距離が前記安定距離範囲内であるという判断が、前記測位位置の安定性を判断するために予め規定した回数又は時間において継続したか否かを判断する測位位置安定性判断ステップと、前記測位装置が、前記高信頼度衛星についての前記擬似距離である高信頼度衛星擬似距離を算出する高信頼度衛星擬似距離算出ステップと、前記測位装置が、前回の前記測位位置と、前回の前記測位装置の速度ベクトル及び前回測位時から現在までの経過時間に基づいて、現在の予測位置を算出する予測位置算出ステップと、前記測位装置が、前記予測位置と、前記高信頼度衛星の衛星軌道上の現在座標との距離である高信頼度衛星近似距離を算出する高信頼度衛星近似距離算出ステップと、前記測位装置が、前記高信頼度衛星擬似距離と前記高信頼度衛星近似距離との差分である高信頼度衛星差分を算出する高信頼度衛星差分算出ステップと、前記測位装置が、すべての前記高信頼度衛星差分の平均値である平均差分算出する平均差分算出ステップと、前記測位装置が、前記通常衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である第2擬似距離を算出する第2擬似距離算出ステップと、前記測位装置が、前記予測位置と、前記通常衛星の衛星軌道上の現在座標との距離である第2近似距離を算出する第2近似距離算出ステップと、前記測位装置が、前記第2擬似距離と前記第2近似距離との差分である第2差分を算出する第2差分算出ステップと、前記測位装置が、前記平均差分と前記第2差分との差分である測位使用可能性判定値を算出する測位使用判定値算出ステップと、前記測位装置が、前記測位使用可能性判定値が、直接波に対応する範囲として予め規定した第2測位使用可能範囲内か否かを判断する第2測位使用可能性判断ステップと、前記測位装置が、前記高信頼度衛星と前記第2測位使用可能範囲内の前記第2差分に対応する前記通常衛星とを構成要素とする第2測位使用衛星群を生成する第2測位使用衛星群生成ステップと、前記測位装置が、前記第2測位使用衛星群を使用して測位を行い、出力用の測位位置を示す測位位置情報を生成する第2測位位置情報生成ステップと、を有することを特徴とする測位装置の制御方法によって達成される。
【0018】
前記目的は、第8の発明によれば、コンピュータに、複数の測位衛星からの衛星電波に乗せられている測位基礎符号を使用して、現在位置を測位する測位装置が、前記衛星電波を受信する衛星電波受信ステップと、前記測位装置が、前記衛星電波の受信強度及び前記測位衛星の仰角に基づいて前記衛星電波が直接波である信頼度が高いか否かを判断し、前記信頼度が高い前記衛星電波に対応する前記測位衛星である高信頼度衛星を示す高信頼度衛星情報を生成する高信頼度衛星情報生成ステップと、前記測位装置が、前記高信頼度衛星を含む基準衛星群を示す基準衛星群情報を生成する基準衛星群情報生成ステップと、前記測位装置が、前記基準衛星群を使用して現在位置を予備測位して、出力用の測位に使用する前記測位衛星を選択するための基準位置を示す基準位置情報を生成する基準位置情報生成ステップと、前記測位装置が、前記基準衛星群に含まれない前記測位衛星である通常衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である第1擬似距離を算出する第1擬似距離算出ステップと、前記測位装置が、前記基準位置と、前記基準衛星群に含まれない前記通常衛星の衛星軌道上の現在座標との距離である第1近似距離を示す第1近似距離情報を算出する第1近似距離算出ステップと、前記測位装置が、前記第1擬似距離と前記第1近似距離との差分である第1差分を算出する第1差分算出ステップと、前記測位装置が、前記第1差分が、直接波に対応する範囲として予め規定した第1測位使用可能範囲内か否かを判断する第1測位使用可能性判断ステップと、前記測位装置が、前記高信頼度衛星と前記第1測位使用可能範囲内の前記第1差分に対応する前記通常衛星とを構成要素とする第1測位使用衛星群を生成する第1測位使用衛星群生成ステップと、前記測位装置が、前記第1測位使用衛星群を使用して測位を行い、出力用の測位位置を示す測位位置情報を生成する第1測位位置情報生成ステップと、前記測位装置が、連続して出力される2つの前記測位位置の距離が、予め規定した安定距離範囲内であるか否かを判断する距離評価ステップと、前記測位装置が、連続して出力される2つの前記測位位置の距離が前記安定距離範囲内であるという判断が、前記測位位置の安定性を判断するために予め規定した回数又は時間において継続したか否かを判断する測位位置安定性判断ステップと、前記測位装置が、前記高信頼度衛星についての前記擬似距離である高信頼度衛星擬似距離を算出する高信頼度衛星擬似距離算出ステップと、前記測位装置が、前回の前記測位位置と、前回の前記測位装置の速度ベクトル及び前回測位時から現在までの経過時間に基づいて、現在の予測位置を算出する予測位置算出ステップと、前記測位装置が、前記予測位置と、前記高信頼度衛星の衛星軌道上の現在座標との距離である高信頼度衛星近似距離を算出する高信頼度衛星近似距離算出ステップと、前記測位装置が、前記高信頼度衛星擬似距離と前記高信頼度衛星近似距離との差分である高信頼度衛星差分を算出する高信頼度衛星差分算出ステップと、前記測位装置が、すべての前記高信頼度衛星差分の平均値である平均差分算出する平均差分算出ステップと、前記測位装置が、前記通常衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である第2擬似距離を算出する第2擬似距離算出ステップと、前記測位装置が、前記予測位置と、前記通常衛星の衛星軌道上の現在座標との距離である第2近似距離を算出する第2近似距離算出ステップと、前記測位装置が、前記第2擬似距離と前記第2近似距離との差分である第2差分を算出する第2差分算出ステップと、前記測位装置が、前記平均差分と前記第2差分との差分である測位使用可能性判定値を算出する測位使用判定値算出ステップと、前記測位装置が、前記測位使用可能性判定値が、直接波に対応する範囲として予め規定した第2測位使用可能範囲内か否かを判断する第2測位使用可能性判断ステップと、前記測位装置が、前記高信頼度衛星と前記第2測位使用可能範囲内の前記第2差分に対応する前記通常衛星とを構成要素とする第2測位使用衛星群を生成する第2測位使用衛星群生成ステップと、前記測位装置が、前記第2測位使用衛星群を使用して測位を行い、出力用の測位位置を示す測位位置情報を生成する第2測位位置情報生成ステップと、を実行させることを特徴とする測位装置の制御プログラムによって達成される。
【発明を実施するための最良の形態】
【0019】
以下、この発明の好適な実施の形態を添付図面等を参照しながら、詳細に説明する。
尚、以下に述べる実施の形態は、本発明の好適な具体例であるから、技術的に好ましい種々の限定が付されているが、本発明の範囲は、以下の説明において特に本発明を限定する旨の記載がない限り、これらの態様に限られるものではない。
【0020】
図1は、本発明の実施の形態の測位システム10を示す概略図である。
図1に示すように、測位システム10は、端末20等を有する。
端末20は、準天頂衛星11から電波S1を受信することができる。また、端末20は、GPS衛星12a,12b,12c,12d,12e,12f,12g,12h及び12iから、電波G1,G2,G3,G4,G5,G6,G7,G8及びG9を受信することができる。端末20は測位装置の一例である。準天頂衛星11及びGPS衛星12a等は複数の測位衛星の一例である。電波S1及び電波G1等は衛星電波の一例である。
電波S1及び電波G1等には各種のコード(符号)が乗せられている。そのうちの一つがC/Aコードである。このC/Aコードは、1,023チップ(chip)から構成されている。そして、このC/Aコードは、1.023Mbpsのビット率、1,023bit(=1msec)のビット長の信号である。このC/Aコードは、測位基礎符号の一例である。
以後、準天頂衛星11とGPS衛星12a等を総称して「衛星」と呼ぶ。
【0021】
ここで、準天頂衛星とは、地球の自転(23時間56分)と同期して3機の衛星が異なる軌道面を周回し、日本の天頂付近に、3機のうち少なくとも1機が必ず存在するように配置する衛星システムにおいて使用される衛星である。準天頂衛星は、日本周辺から常に70度以上の仰角で見通すことが可能である。
【0022】
端末20は、例えば、3個以上の異なる衛星からのC/Aコードを受信して、現在位置を測位することができるようになっている。
端末20は、まず、受信したC/Aコードがどの衛星に対応するものかを特定する。次に、端末20は、相関処理によって、受信したC/Aコードの位相(以下「コードフェーズ」と呼ぶ)を算出する。続いて、端末20は、そのコードフェーズを使用して、C/Aコードの送信時刻と受信時刻を算出し、さらに、各衛星と端末20との距離(以後、擬似距離と呼ぶ)を算出する。続いて、現在時刻における各衛星の衛星軌道上の位置と、上述の擬似距離に基づいて、現在位置の測位演算を行うことができるように構成されている。
【0023】
ここで、端末20が受信する電波S1等は、直接波の場合とマルチパスの場合がある。
図1に示すように、端末20の現在位置Pにおいて仰角が高い衛星である準天頂衛星11、GPS衛星12d及び12eからの電波S1、G4及びG5は、それぞれ矢印A1,A2及びA3に示すように直接波として端末20に到達する。
ところが、仰角が低いGPS衛星12iからの電波G9は建物13Bに遮断されて直接波としては端末20に到達せず、矢印A4に示すように、建物13Aに反射してマルチパスとして端末20に到達する。
マルチパスは測位精度を劣化させるから、測位から排除する必要がある。
また、PDOP等の指標に示される天空における衛星の配置は測位精度に影響を与えるから、できるだけ多くの直接波を使用する必要がある。
すなわち、端末20が精度よく現在位置を測位するためには、直接波とマルチパスを確実に区別して、マルチパスを排除して、直接波だけを使用する必要がある。
この点、端末20は、以下に説明するように、その移動速度や電波S1等を受信することができなかった時間にかかわらず、直接波とマルチパスを確実に区別することができるように構成されている。
【0024】
端末20は例えば、携帯電話機、PHS(Personal Handy−phone System)、PDA(Personal Digital Assistance等であるが、これらに限らない。
また、準天頂衛星11及びGPS衛星12a等は10個に限らず、9個以下でもよいし、11個以上でもよい。
【0025】
(端末20の主なハードウエア構成について)
図2は、端末20の主なハードウエア構成を示す概略図である。
図2に示すように、端末20は、コンピュータを有し、コンピュータは、バス22を有する。バス22には、CPU(Central Processing Unit)24、記憶装置26等が接続されている。記憶装置26は、例えば、RAM(Random Access Memory)、ROM(Read Only Memory)等である。
また、バス22には、入力装置28、GPS受信装置30、準天頂衛星受信装置32が接続されている。GPS受信装置30は、GPS衛星12a等(図1参照)からの電波G1等を受信するための受信装置である。準天頂衛星受信装置32は、準天頂衛星11(図1参照)からの電波S1を受信するための受信装置である。
【0026】
GPS受信装置30は、GPS衛星12a等からの電波G1等を受信して、電波G1等の増幅、所望の周波数の抽出、ダウンコンバート(周波数変換)及びデジタル化を行う。 そして、GPS受信装置30は、電波G1等に乗っているC/AコードとGPS受信装置34が発生したレプリカC/Aコードとの相関処理を行って、C/Aコードの位相を判断するように構成されている。また、GPS受信装置34は、電波G1等に乗っている後述のエフェメリスやアルマナック等を取得する。
準天頂衛星受信装置32は、準天頂衛星11からの電波S1を受信するが、その構成は
上述のGPS受信装置30と同様である。
【0027】
また、バス22には、各種情報等を表示するための表示装置34、及び、時計36が接続されている。
【0028】
端末20は、GPS受信装置30及び準天頂衛星受信装置32によって取得した相関結果及びエフェメリス等のデータを使用して測位演算を行うようになっている。
【0029】
(端末20の主なソフトウエア構成について)
図3は、端末20の主なソフトウエア構成を示す概略図である。
図3に示すように、端末20は、各部を制御する制御部100、図2のGPS装置30に対応するGPS受信部102、準天頂衛星受信装置32に対応する準天頂衛星受信部104、時計36に対応する計時部106、各種プログラムを格納する第1記憶部110、各種情報を格納する第2記憶部150を有する。
【0030】
図3に示すように、端末20は、第2記憶部150に、衛星軌道情報152を格納している。衛星軌道情報152は、アルマナック152a及びエフェメリス152bを含む。アルマナック152aは、準天頂衛星11及びすべてのGPS衛星12a等の概略の軌道を示す情報である。エフェメリス152bは、準天頂衛星11及び各GPS衛星12a等の精密な軌道を示す情報である。
端末20は、アルマナック152a及びエフェメリス152bを、測位のために使用する。
【0031】
図3に示すように、端末20は、第2記憶部150に、概略位置情報154を格納している。概略位置情報154は、端末20の現在の概略位置Pを示す情報である。概略位置Pは、例えば、前回測位時の測位位置(前回測位位置Pn−1)である。
【0032】
図3に示すように、端末20は、第1記憶部110に、観測可能衛星算出プログラム112を格納している。観測可能衛星算出プログラム112は、制御部100が、アルマナック152aを参照して、計時部106によって計測した現在時刻において概略位置Pから観測可能な衛星を示す観測可能衛星情報156を生成するためのプログラムである。
制御部100は、生成した観測可能衛星情報156を第2記憶部150に格納する。
観測可能衛星情報156には、例えば、準天頂衛星11、GPS衛星12a乃至12iが示されている。
【0033】
図3に示すように、端末20は、第1記憶部110に、衛星電波受信プログラム114を格納している。衛星電波受信プログラム114は、制御部100がGPS受信部102及び準天頂衛星受信部104によって、準天頂衛星11からの電波S1やGPS衛星12a等からの電波G1等を受信するためのプログラムである。衛星電波受信プログラム114と制御部100、GPS受信部102及び準天頂衛生受信部104は、衛星電波受信手段の一例である。
制御部100は、例えば、概略位置Pとアルマナック152aに基づいて、ドップラー偏移を算出し、受信する電波S1等の周波数を予測する。そして、制御部100は、電波S1等の予測周波数を含む一定範囲の周波数をサーチすることによって、電波S1等を受信する。
【0034】
図3に示すように、端末20は、第1記憶部110に、高信頼度衛星判断プログラム116を格納している。高信頼度衛星判断プログラム116は、制御部100が、電波S1等の受信強度及び衛星の仰角に基づいて、電波S1等が直接波である信頼度が高いか否かを判断し、直接波である信頼度が高い電波S1等に対応する衛星であるHSVを示す高信頼度衛星情報158を生成するためのプログラムである。HSVは、高信頼度衛星の一例である。NSVは通常衛星の一例である。そして、高信頼度衛星判断プログラム116と制御部100は、高信頼度衛星情報生成手段の一例である。
観測可能衛星情報156に示される衛星であって、HSV以外の衛星をNSVと呼ぶ。
【0035】
図4は、高信頼度衛星判断プログラム116の説明図である。
図4(a)に示すように、制御部100は、各衛星について、受信したC/Aコードと、端末20が発生するレプリカC/Aコードの相関処理を行って、相関結果を得る。相関結果から、Noise Floorの部分に対応する相関値P1と、相関ピーク値P2を読み取ることができる。
そして、制御部100は、相関ピーク値P2と相関値P1との差分が相関値P1の2倍以上であることを示す図4(b)の式1と、仰角が50度以上であることを示す式2の双方を満たす場合に、その衛星がHSVであると判断する。式2の50度は、仰角閾値である。相関ピーク値P2と相関値P1との差分は、衛星電波の受信強度の一例である。
端末20は、準天頂衛星11からの電波S1を受信することができるから、少なくとも1個のHSVからの電波を受信することができる。
なお、本実施の形態とは異なり、受信強度としては、SNR(Signao to Noise Ratio)を使用してもよい。
また、本実施の形態とは異なり、式2の仰角閾値は、50度以上70度以下のいずれかの角度として規定してもよい。
【0036】
仰角が50度以上であれば、その衛星からの電波は直接波である可能性が大きい。
しかし、ノイズが大きい場合には、仰角が高くてもマルチパスである可能性が大きい。
さらに、仰角が大きくても、ノイズが大きい場合には、その衛星からの電波を使用すると測位精度が劣化するから、後述の基準位置BPを算出するために使用するには不適当である。
このため、端末20は、受信強度と仰角の双方に基づいて、HSVを判断するようになっている。
【0037】
図3に示すように、端末20は、第1記憶部110に、ベースセット生成プログラム118を格納している。ベースセット生成プログラム118は、制御部100が、HSVを構成要素とするベースセットBSを示すベースセット情報160を生成するためのプログラムである。ベースセットBSは基準衛星群の一例であり、ベースセット情報160は基準衛星群情報の一例である。そして、ベースセット生成プログラム118と制御部100は、基準衛星群情報生成手段の一例である。
【0038】
図5は、ベースセット設定プログラム118の説明図である。
図5に示すように、制御部100は、HSVが4個以上であることを示す式3の条件を満たす場合には、HSVだけでベースセットBSを形成する。
そして、制御部100は、ベースセットBSを示すベースセット情報160を第2記憶部150に格納する。
これに対して、制御部100は、式3の条件を満たさない場合には、後述の予備セット生成プログラム120及びPosition Sigma算出プログラム122を起動する。
【0039】
図3に示すように、ベースセット生成プログラム118は、予備セット生成プログラム120を含む。予備セット生成プログラム120は、制御部100が、HSVが4個未満である場合に、NSVとHSVの合計数が4個である予備セットRS1等を示す予備セット情報162を生成するためのプログラムである。予備セットRS1等は予備衛星群の一例であり、予備セット情報162は予備衛星群情報の一例である。そして、予備セット生成プログラム120と制御部100は、予備衛星群情報生成手段の一例である。
【0040】
制御部100は、例えば、HSVが図1の準天頂衛星11、GPS衛星12d及び12eの3個であれば、さらにGPS衛星12aを加えた予備セットRS1を生成する。また、HSVにGPS衛星12bを加えた予備セットRS2を生成するというように、NSVとHSVとの合計が4個になるすべての組み合わせを生成する。
制御部100は、生成した予備セット情報162を第2記憶部150に格納する。
【0041】
図3に示すように、ベースセット生成プログラム118は、Position Sigma算出プログラム122を含む。Position Sigma算出プログラム122は、制御部100が、各予備セットRS1等のPosition Sigmaを示すPosition Sigma情報164を生成するためのプログラムである。このPosition Sigma算出プログラム122と制御部100は、Position Sigma算出手段の一例である。
制御部100は、各予備セットRS1等を使用して、それぞれ複数回の測位を行い、その測位結果のPosition Sigmaを算出する。上述のように、Position Sigmaは、測位結果の標準偏差である。制御部100は、例えば、予備セットRS1に対応するPosition Sigmaがa1であり、予備セットRS2に対応するPosition Sigmaがa2であるというように、すべての予備セットRS1等についてPosition Sigmaを算出する。
制御部100は、生成したPosition Sigma情報164を第2記憶部150に格納する。
なお、本実施の形態とは異なり、制御部100は、各予備セットRS1等の各GPS衛星12a等の擬似距離又はコードフェーズの分散に基づいて、Position Sigmaを推定するようにしてもよい。
【0042】
制御部100は、ベースセット生成プログラム118によって、HSVが4個未満の場合には、予備セットRS1等のうち、Position Sigmaが最小のものをベースセットBSとするようになっている。
Position Sigmaは、測位結果の標準偏差であるから、Position Sigmaが小さいほど、測位結果のばらつきは小さく、測位結果は安定している。このため、Position Sigmaが小さい予備セットを使用した測位結果ほど、測位結果の信頼性が高い。
このため、端末20は、HSVが4個未満の場合であっても、信頼性が高い測位結果を算出可能なベースセットBSを生成することができる。
なお、本実施の形態とは異なり、端末20は、擬似距離と近似距離の差分の分散値の小さな予備セットRS1等をベースセットBSとするようにしてもよい。この場合、近似距離の基礎となる位置は、概略位置Pとする。
【0043】
図3に示すように、端末20は、第1記憶部110に、基準位置情報生成プログラム124を格納している。基準位置情報生成プログラム124は、制御部100が、ベースセットBSを使用して現在位置を予備測位して、出力用の測位に使用する衛星を選択するための基準位置BPを示す基準位置情報166を生成するためのプログラムである。基準位置BPは基準位置の一例であり、基準位置情報166は基準位置情報の一例である。そして、基準位置情報生成プログラム124と制御部100は、基準位置情報生成手段の一例である。
制御部100は、ベースセットBSを構成する衛星から電波S1等を受信し、電波S1等に乗せられているC/Aコードの送信時刻と受信時刻に基づいて擬似距離を算出する。そして、エフェメリス152bによって現在時刻における各衛星の衛星軌道上の座標を算出する。
制御部100は、各衛星についての擬似距離と衛星軌道上の座標を使用して、基準位置BPを算出する。
制御部100は、生成した基準位置情報166を第2記憶部150に格納する。
制御部100は、基準位置BPを表示装置34(図2参照)に表示する等によって、外部に出力することはしない。基準位置BPは、後述の第1拡張セットSet1を生成するためにのみ使用する。
なお、本実施の形態とは異なり、後述の測位位置情報170を生成するまでの間は、基準位置BPを表示装置34に表示することにしてもよい。
【0044】
図3に示すように、端末20は、第1記憶部110に、第1拡張セット生成プログラム126を格納している。第1拡張セット生成プログラム126は、制御部100が、第1拡張セットSet1を示す第1拡張セット情報168を生成するためのプログラムである。
【0045】
図6は、第1拡張セット生成プログラム126の説明図である。
図6(a)に示すように、制御部100は、各NSVについて、C/Aコードの送信時刻t1と受信時刻t2との間の時間dtに光速cを乗じる式4によって、擬似距離d1を算出する。擬似距離d1は擬似距離の一例である。そして、第1拡張セット生成プログラム126と制御部100は、第1擬似距離算出プログラムの一例である。
【0046】
また、制御部100は、図6(b)に示すように、各NSVについて、近似距離d2を算出する。近似距離d2は、基準位置BPと、NSVの衛星軌道上の現在座標との距離である。この近似距離d2は第1近似距離の一例である。そして、第1拡張セット生成プログラム126と制御部100は第1近似距離算出手段の一例でもある。
制御部100は、基準位置BP(x0,y0,z0)と通常衛星の衛星軌道上の位置である衛星位置Psv(X,Y,Z)の間の距離を求める式5によって、近似距離d2を算出する。
【0047】
続いて、制御部100は、各NSVについて、図6(c)に示すように、擬似距離d1と近似距離d2の差分d3を算出する。差分d3は第1差分の一例である。そして、第1拡張セット生成プログラム126と制御部100は第1差分算出手段の一例でもある。
なお、本実施の形態においては、差分d3等、複数の差分を算出するが、これらは、その絶対値を意味する。このため、2つの値を使用して、いずれからいずれを減じても、計算結果は同じである。
【0048】
続いて、制御部100は、差分d3が予め規定した閾値α1以下であることを示す式6を満たすか否かを判断する。閾値α1以下の範囲は、直接波に対応する範囲として予め規定された範囲である。閾値α1は、例えば、50メートル(m)である。閾値α1以下の範囲は、第1測位使用可能範囲内の一例である。そして、第1拡張セット生成プログラム126と制御部100は第1測位使用可能性判断手段の一例でもある。
制御部は、差分d3が予め規定した閾値α1以下であることを示す式6を満たすか否かを判断することによって、直接波とマルチパスを区別している。
【0049】
続いて、制御部100は、HSVと、式6を満たす差分d3に対応するNSVとを構成要素とする第1拡張セットSet1を示す第1拡張セット情報168を生成する。第1拡張セットSet1は第1測位使用衛星群の一例である。そして、第1拡張セット生成プログラム126と制御部100は第1測位使用衛星群生成手段の一例でもある。
制御部100は、生成した第1拡張セット情報168を第2記憶部150に格納する。
【0050】
図3に示すように、端末20は、第1記憶部110に、第1測位プログラム128を格納している。第1測位プログラム128は、制御部100が、第1拡張セットSet1を使用して測位を行い、出力用の測位位置情報170を生成するためのプログラムである。測位位置情報170は測位位置情報の一例である。そして、第1測位プログラム128と制御部100は、第1測位位置情報生成手段の一例である。
【0051】
図7は、測位プログラム128の説明図である。
図7(a)は測位原理を示す図である。
図7(a)の式7は、図6(a)の式4及び図6(b)の式5を使用して、テーラー展開したものである。ここで、d1及びd2は既知である。(h1,h2,h3)は、端末20から各衛星への方向ベクトル(視線ベクトル)であり、周知の方法で計算することができる。したがって、未知数はdx,dy,dz,dtの4個であるから、4個の衛星について式7を生成することによって、解を求めることができる。式7においては、基準位置BPを仮の現在位置(以下「仮現在位置preP」と呼ぶ)としている。
第1回で得られたdx,dy,dzを仮現在位置prePに加えて新たな仮現在位置prePとし、これをもとに再度計算して、解が収斂するまで繰り返し、端末20の現在位置Pn(x,y,z)を計算する。解が収斂したときの仮現在位置prePが、端末20の現在位置Pである。
【0052】
図7(b)は、上述の測位原理の改良を示す説明図である。
図7(b)は、式7を簡略化して表現したものである。さらに、かっこ内の式は、ベクトルを使用して、さらに簡単に表現した式である。かっこ内の式については、図7(c)乃至図7(f)においても同様である。
図7(b)の式において、yiは各衛星の擬似距離d1と近似距離d2の差分である。Hiは方向ベクトル(h1,h2,h3)を示す行列である。Xは、求めたい現在位置Pnの誤差(dx,dy,dz)を示す行列である。bは、端末の時刻誤差dtと光速cとの積cdt(以下「誤差b」と呼ぶ)である。
【0053】
図7(b)の式9は、すべての衛星についての式8の平均をとったものである。
図7(d)の式10は、式8から式9を減じて得た式である。式10において、式8と式9に共通に含まれる誤差bが消去される。これは、時刻誤差dtが消去されることを意味する。
これにより、計算量を削減することができる。
【0054】
端末20は、上述の式10をさらに改良して使用する。
図7(e)の式11は、HSVについての式8の平均をとったものである。
そして、図7(f)の式12は、式8から式11を減じて得た式である。
HSVは、受信強度が大きく、かつ、仰角が大きい衛星であるから、その方向ベクトル(h1,h2,h3)も精度よく算出することができる。
このため、端末20は、測位計算においては、図7(g)の式13に示すように、各衛星ごとの式12を行列として計算するのであるが、式12によって、行列の次元数を減らすことができることに加えて、測位精度も確保することができる。
なお、本実施の形態とは異なり、図7(f)の式12において、式8から式11を減じるのではなくて、準天頂衛星11についての式8を減じるようにしてもよい。
【0055】
端末20は、式13によって、現在位置Pnを算出すると、図7(h)の式14によって誤差bを算出する。誤差bを算出すれば、誤差bは光速cと時刻誤差dtとの積であるから、時刻誤差dtも算出することができる。
端末20は、時刻誤差dtを、次回測位時に使用する。これにより、測位精度を向上させることができる。
【0056】
制御部100は、生成した測位位置情報170及び時刻誤差情報172を第2記憶部150に格納する。制御部100は、1秒(s)ごとに測位位置情報170及び時刻誤差情報172を生成するようになっている。
制御部100は、測位位置情報170を、表示装置34(図2)に表示することによって出力する。
また、制御部100は、測位位置情報170を新たな概略位置情報154として第2記憶部150に格納する。
また、制御部100は、測位位置情報170の生成時に、速度ベクトルvを示す速度ベクトル情報171を生成し、第2記憶部150に格納する。4個以上の衛星から電波S1等を受信して測位位置Pが求まれば、電波S1等のドップラー偏移によって各衛星との相対速度がわかる。また、各衛星の速度ベクトルはエフェメリス152bから算出できるから、端末20の速度ベクトルも算出することができる。
【0057】
図3に示すように、端末20は、第1記憶部110に、距離評価プログラム130を格納している。距離評価プログラム130は、制御部100が、連続して出力される2つの測位位置Pn−1及びPとの距離d4が、閾値α2以下か否かを判断するためのプログラムである。閾値α2は予め規定されており、閾値α2以下の距離は安定距離範囲内の距離の一例である。そして、距離評価プログラム130と制御部100は、距離評価手段の一例である。
【0058】
図8は、距離評価プログラム130の説明図である。
図8に示すように、制御部100は、距離d4が閾値α2以下であることを示す式15を満たすか否かを判断する。
上述のように距離d4は、前回位置Pn−1と現在位置Pとの距離差分である。閾値α2は、例えば、10メートル(m)である。
【0059】
図3に示すように、端末20は、第1記憶部110に、測位位置安定性判断プログラム132を格納している。測位位置安定性判断プログラム132は、制御部100が、上述の距離評価プログラム130による式15を満たすという判断が、5回連続したか否かを判断するためのプログラムである。この5回という回数は、測位位置Pnの安定性を判断するために予め規定した回数の一例である。そして、測位位置安定性判断プログラム132と制御部100は、測位位置安定性判断手段の一例である。
制御部100は、式15を満たすという判断が、5回連続した場合には、測位位置Pnが安定していると判断する。ここで、式15を満たすという判断が5回連続したということは、前回測位位置Pn−1と現在位置Pが大きく乖離しない状態が、継続していることを意味する。
なお、本実施の形態とは異なり、測位位置安定性判断プログラム132は、制御部100が、上述の距離評価プログラム130による式15を満たすという判断が、5秒(s)以上連続した場合に、測位位置Pが安定していると判断することにしてもよい。5秒
以上という時間は、予め規定した時間の一例である。
【0060】
図3に示すように、端末20は、第1記憶部110に、第2拡張セット生成プログラム134を格納している。第2拡張セット生成プログラム134は、制御部100が、第2拡張セットSet2を示す第2拡張セット情報174を生成するためのプログラムである。
第2拡張セット生成プログラム134は、上述の測位位置安定性判断プログラム132
によって制御部100が、測位位置Pが安定していると判断した場合に、起動する。
【0061】
図9は、第2拡張セット生成プログラム134の説明図である。
制御部100は、図9(a)に示す各HSVについての擬似距離d5を算出する。擬似距離d5は高信頼度衛星擬似距離の一例である。そして、第2拡張セット生成プログラム134と制御部100は、高信頼度衛星擬似距離算出手段の一例である。
【0062】
また、制御部100は、図9(b)に示す端末20の予測位置Pfを算出する。制御部100は、図9(b)に示すように、前回の測位位置P(xt−1,yt−1,zt−1)と、前回の端末20の速度ベクトル(vxt−1,vyt−1,vzt−1)及び前回測位位置から現在までの経過時間dtに基づいて、現在の予測位置Pfを算出する。前回の測位位置Pは、概略位置情報154に示されている。前回の速度ベクトルは、前回測位時に生成した速度ベクトル情報171に示される速度ベクトル使用する。
予測位置Pfは予測位置の一例である。そして、第2拡張セット生成プログラム134と制御部100は、予測位置算出手段の一例でもある。
【0063】
続いて、制御部100は、図9(c)に示す近似距離d6を算出する。近似距離d6は、予測位置Pfと各HSVの衛星軌道上の現在座標との距離である。
この近似距離d6は高信頼度衛星近似距離の一例である。そして、第2拡張セット生成プログラム134と制御部100は、高信頼度衛星近似距離算出手段の一例でもある。
【0064】
続いて、制御部100は、図9(d)に示すように、擬似距離d5と近似距離d6との差分d7を算出する。差分d7は高信頼度衛星差分の一例である。そして、第2拡張セット生成プログラム134と制御部100は、高信頼度衛星差分算出手段の一例でもある。
【0065】
続いて、制御部100は、図9(e)に示すように、差分d7の平均値である平均差分d7avを算出する。平均差分d7avは平均差分の一例である。そして、第2拡張セット生成プログラム134と制御部100は、平均差分算出手段の一例でもある。
【0066】
続いて、制御部100は、図9(f)に示すように、NSVの擬似距離d8を算出する。擬似距離d8は、第2擬似距離の一例である。そして、第2拡張セット生成プログラム134と制御部100は、第2擬似距離算出手段の一例でもある。
【0067】
続いて、制御部100は、図9(g)に示すように、予測位置Pfと、NSVの衛星軌道上の現在座標との距離である近似距離d9を算出する。近似距離d9は第2近似距離の一例である。そして、第2拡張セット生成プログラム134と制御部100は、第2近似距離算出手段の一例でもある。
【0068】
続いて、制御部100は、図9(h)に示すように、擬似距離d8と近似距離d9との差分d10を算出する。差分d10は第2差分の一例である。そして、第2拡張セット生成プログラム134と制御部100は、第2差分算出手段の一例でもある。
【0069】
続いて、制御部100は、図9(i)に示すように、平均差分d7avと差分d10との差分である判定値d11を算出する。判定値11は測位使用可能性判定値の一例である。
続いて、制御部100は、判定値d11が誤差閾値w以下であることを示す図9(j)の式16を満たすか否かを判断する。誤差閾値wは、直接波に対応する範囲として予め規定されている。誤差閾値wは、例えば、50メートル(m)である。誤差閾値w以下の範囲は第2測位使用可能範囲内の一例である。そして、第2拡張セット生成プログラム134と制御部100は、第2測位使用可能性判断手段の一例でもある。
【0070】
そして、制御部100は、HSVと式16を満たすNSVを構成要素とする第2拡張セットSet2を形成する。第2拡張セットSet2は第2測位使用衛星群の一例である。そして、第2拡張セット生成プログラム134と制御部100は、第2測位使用衛星群生成手段の一例でもある。
【0071】
図3に示すように、端末20は、第1記憶部110に、第2測位プログラム136を格納している。第2測位プログラム136は、制御部100が、第2拡張セットSet2を使用して測位を行い、測位位置情報170を生成するためのプログラムである。この第2測位プログラム136と制御部100は、第2測位位置情報生成手段の一例である。
第2測位プログラム136に基づく測位方法(以下「第2測位方法」と呼ぶ)は、図7で説明した第1測位プログラム128に基づく測位方法(以下「第1測位方法」と呼ぶ)と同様であるが、第2拡張セットSet2を使用する点が異なる。
また、第1測位方法は、基準位置BPの測位を経てから測位位置Pを測位する必要があり、測位位置Pを算出するまでに2回測位演算を行う必要があるのに対して、第2測位方法においては、測位演算は測位位置Pを算出するときの一度で足りる。
制御部100は、測位位置情報170の生成時に、速度ベクトルvを示す速度ベクトル情報171を生成し、第2記憶部150に格納する。
【0072】
端末20は上述のように構成されている。
上述のように、端末20は、ベースセット情報160(図3参照)を生成することができる。ベースセットBSは、HSVを構成要素としている。すなわち、ベースセットBSは直接波に対応する衛星のみを含み、マルチパスに対応する衛星を確実に排除して形成されている。
そして、端末20は、基準位置情報166(図3参照)を生成することができる。基準位置BPは、前回の測位位置に基づいて予測した位置ではなくて、実際に現在位置を測位することによって算出された位置である。すなわち、基準位置BPは、現在位置そのものである。
しかも、基準位置BPはベースセットBSを使用して生成されているから、マルチパスを排除して算出されており、マルチパスによる精度劣化はない。
さらに、端末20は、ベースセット生成プログラム118によって、HSVが4個未満の場合には、予備セットRS1等のうち、Position Sigmaが最小のものをベースセットBSとするようになっている。このため、端末20は、HSVが4個未満の場合であっても、信頼性が高い基準位置BPを算出することができる。
【0073】
そして、端末20は、擬似距離d1及び近似距離d2(図6参照)を算出することができる。
ここで、近似距離d2は、前回の測位位置に基づいて予測した位置を基礎とするのではなくて、基準位置BPを基礎としているから精度が高い。
さらに、端末20は、擬似距離d1と近似距離d2との差分d3(図6参照)が、直接波に対応する範囲として予め規定した閾値α1以下か否かを判断することができる。
そして、端末20は、第1拡張セット情報168を生成することができる。
上述のように、基準位置BPは現在位置そのものであるから、端末20の移動速度や衛星電波を受信することができなかった時間によって、閾値α1を変更する必要はない。言い換えると、閾値α1以下の範囲を直接波に対応する範囲として予め規定すれば、端末20の移動速度や衛星電波を受信することができなかった時間にかかわらず、その閾値α1によって規定される範囲を使用することができる。
このため、端末20は、マルチパスに対応する衛星だけを確実に排除し、直接波に対応する衛星だけで第1拡張セットSet1(図3参照)を形成することができる。
そして、端末20は、第1拡張セットSet1を使用して測位位置情報170(図3参照)を生成するから、マルチパスを排除して測位位置情報170を生成することができる。
【0074】
以上のように、端末20は、前回の測位位置が現在位置と大きく異なる場合であっても、マルチパスを確実に排除することができる。
また、上述のように、端末20は、ベースセットBSを出力用の測位には使用せずに、基準位置BPを測位するために使用する。そして、端末20は、第1拡張セットSet1を使用して、出力する測位位置情報170を生成する。
ベースセットBSは、マルチパスを送信する衛星を含まないが、仰角が高い衛星で構成されるため、天空における配置(PDOP等)が必ずしも良好ではない。
このため、端末20は、ベースセットBSを基準位置BPの測位にのみ使用し、出力するための測位位置情報170を生成するためには使用しない。
端末20は、第1拡張セットSet1を使用して、出力するための測位位置情報170を生成する。第1拡張セットSet1内の衛星は、HSV以外の衛星であって、直接波に対応する衛星である。このため、第1拡張セットSet1を構成する衛星数は、ベースセットBSを構成する衛星数以上である。
したがって、第1拡張セットSet1のPDOP等は、ベースセットBSのPDOP等よりも良好である可能性が大きい。
このため、端末20は、第1拡張セットSet1を使用することによって、高精度の測位位置情報170を生成することができる。
【0075】
さらに、端末20は、測位位置安定性判断プログラム132(図3参照)によって、測位位置Pnの安定性を判断することができる。
【0076】
そして、端末20は、予測位置Pf(図9参照)を算出することができる。すなわち、端末20は、前回の測位位置Pを現在位置であると擬制するのではない。
予測位置Pfは、前回の測位位置Pと、前回の端末20の速度ベクトル及び前回測位時から現在までの経過時間dtに基づいて生成されているから、現在位置と擬制することができる。すなわち、予測位置Pfは、端末20の移動速度や、衛星電波を受信することができなかった時間にかかわらず、現在位置と擬制することができる。
そして、端末20は、平均差分d7av(図9参照)を算出することができる。平均差分d7avは、HSVについての擬似距離d5と近似距離d6の差分d7(図9参照)の平均値であるから、直接波の擬似距離と近似距離の差分を正確に示している。このため、平均差分d7avは、衛星電波がマルチパスであるか否かを正確に判断するための基礎となる情報である。
【0077】
そして、端末20は、 NSVについての近似距離d9(図9参照)を算出することができる。近似距離d9は、前回の測位位置Pを基準にして生成したのではなくて、予測位置Pfを基準に生成されているから精度が高い。
そして、端末20は、NSVの擬似距離d8と近似距離d9の差分d10(図9参照)を算出することができる。
そして、端末20は、平均差分d7avと差分d10との差分である判定値d11(図9参照)が、直接波に対応する範囲として予め規定した誤差閾値w以下か否かを判断することができる。すなわち、NSVについての差分d10だけを基準にして直接波とマルチパスを区別するのではなくて、現時点において実際に算出した平均差分d7avとの差分である判定値d11を使用して直接波とマルチパスを区別するから、衛星電波の受信状況に応じて、より確実に、直接波とマルチパスを区別することができる。
【0078】
また、平均差分d7av及び差分d10の基礎となる予測位置Pfは、現在位置と擬制することができるから、端末20の移動速度や衛星電波を受信することができなかった時間にかかわらず、同一の閾値wを使用することができる。このため、確実にマルチパスを排除することができる。
そして、端末20は、第2拡張セットSet2を生成することができ、その第2拡張セットを使用して測位位置情報170(図3参照)を生成することができる。
上述のように、端末20は、HSVのみを出力用の測位には使用するのではなくて、第2拡張セットSet2を使用して、測位位置情報170を生成する。
第2拡張セットSet2を構成する衛星数は、HSVの数以上である。したがって、第2拡張セットSet2のPDOP等は、HSVだけで構成される衛星群のPDOP等よりも良好である可能性が大きい。
このように、第2拡張セットSet2を使用することによって、高精度の測位位置情報170を生成することができる。
【0079】
しかも、端末20は、測位位置Pの安定性を判断することができ、測位位置Pの変化が大きい場合には、第1測位方法によって測位位置情報170を生成し、測位位置Pの変化が小さい場合には、第2測位方法によって測位位置情報170を生成することができる。
予測位置Pfは、端末20の移動速度等にかかわらず、現在位置と擬制することができるのであるが、端末20の位置の変化が小さい場合には、前回位置Pn−1と真の現在位置との乖離が小さいから、一層精度良く現在位置と擬制することができる。この結果、第2測位法におけるマルチパスと直接波の区別が一層確実になる。
【0080】
以上が本実施の形態に係る端末20の構成であるが、以下、その動作例を主に図10、図11、図12、図13、図14及び図15を使用して説明する。
図10乃至図15は、端末20の動作例を示す概略フローチャートである。
【0081】
図10は、端末20の全体の動作例を示している。
まず、端末20は、第1測位法で測位する(図10のステップST1)。
続いて、端末20は、測位位置Pnの安定性を判断する(ステップST2)。
端末20は、ステップST2における判断結果を評価し(ステップST3)、測位位置Pnが安定していないと判断した場合には、ステップST1に戻る。
これに対して、端末20が、ステップST2における判断結果を評価し(ステップST3)、測位位置Pnが安定していると判断した場合には、第2測位法で測位する(ステップST4)。
続いて、端末20は、測位終了か否かを判断し(ステップST5)、測位終了ではない場合には、ステップST2に戻る。
ステップST5において、端末20が、測位終了であると判断した場合には、測位を終了する。
【0082】
次に、主に図11を使用して、ステップST1(図10参照)の第1測位法を実施するときの詳細な動作例を説明する。
まず、端末20は、概略位置情報154に示される概略位置P(図3参照)から観測可能な衛星を選択する(図11のステップST11)。
続いて、端末20は、観測可能な衛星から電波S1等(図1参照)を受信する(ステップST12)。このステップST12は、衛星電波受信ステップの一例である。
【0083】
続いて、端末20は、電波S1等の受信強度及び仰角に基づいて、HSVを判断する(ステップST13)。このステップST13は、高信頼度衛星情報生成ステップの一例である。
なお、ステップST12及びステップST13は、端末20が測位を行っている間、継続する。すなわち、ステップST12及びステップST13は、第1測位法による測位時だけではなくて、第2測位法による測位時にも継続している。
【0084】
続いて、端末20は、HSVが4個以上か否かを判断する(ステップST14)。
ステップST14において、端末20が、HSVが4個以上であると判断した場合には、HSVだけでベースセットBS(図3参照)を生成する(ステップST15)。ステップST14及びステップST15は、基準衛星群情報生成ステップの一例である。
【0085】
ステップST14において、端末20が、HSVが4個以上ではないと判断した場合には、HSVとNSVとで4個の衛星から構成される予備セットRS1等(図3参照)を生成する(ステップST15A)。
続いて、端末20は、各予備セットRS1等について、測位計算を行い、Position Sigmaを算出する(ステップST15B)。
続いて、端末20は、すべての予備セットRS1等のうち、Position Sigmaが最小のものをベースセットBSとする(ステップST15C)。
上述の、ステップST14,ステップST15A,ステップST15B及びステップST15Cもまた、基準衛星群情報生成ステップの一例である。
【0086】
ステップST15又はステップST15Cに続いて、端末20は、ベースセットBSを使用して、基準位置BPを算出する(ステップST16)。このステップST16は、基準位置情報生成ステップの一例である。
【0087】
続いて、端末20は、NSVについて、擬似距離d1(図6参照)を算出する(ステップST17)。このステップST17は、第1擬似距離算出ステップの一例である。
続いて、端末20は、各NSVについて、基準位置BPと現在時刻における衛星軌道上の現在座標から近似距離d2(図6参照)を算出する(図12のステップST18)。このステップST18は、第1近似距離算出ステップの一例である。
【0088】
続いて、端末20は、各NSVについて、擬似距離d1と近似距離d2との差分d3(図6参照)を算出する(ステップST19)。このステップST19は、第1差分算出ステップの一例である。
続いて、端末20は、差分d3が閾値α1(図6参照)以下の衛星をベースセットBSに追加し、第1拡張セットSet1(図3参照)を生成する(ステップST20)。このステップST19は、第1測位使用可能性判断ステップの一例であり、第1測位使用衛星群情報生成ステップの一例でもある。
【0089】
続いて、端末20は、第1拡張セットSet1を使用して測位を行い、現在位置Pを算出する(ステップST21)。このステップST21は、第1測位位置情報生成ステップの一例である。
【0090】
続いて、端末20は、現在位置Pnを示す測位位置情報170(図3参照)を表示装置34(図2参照)に表示する(ステップST22)。
以上が、第1測位法を実施するときの、端末20の動作例である。
【0091】
続いて、端末20が、図10のステップST2において、測位位置Pnの安定性を判断するときの動作例を主に図13を使用して説明する。
まず、端末20は、前回測位した前回位置Pn−1と現在位置Pとの距離差分d4(図8参照)を算出する(図13のステップST31)。
続いて、端末20は、距離差分d4が閾値α2(10メートル(m))以下か否かを判断する(ステップST32)。このステップST32は、距離評価ステップの一例である。
【0092】
端末20は、ステップST32において、距離差分d4が閾値α2以下であるという判断が、5回連続したか否かを判断する(ステップST33)。
端末20は、ステップST33において、距離差分d4が閾値α2以下であるという判断が、5回連続したか否かを判断した場合には、測位位置Pnは安定していると判断する(ステップST34)。
上述のステップST32,ステップST33及びステップST34は、測位位置安定性判断ステップの一例である。
【0093】
端末20は、上述のステップST32において、距離差分d4が閾値α2以下ではないと判断した場合には、測位位置Pが安定していないと判断する(ステップST34A)。
また、端末20は、上述のステップST33において、距離差分d4が閾値α2以下であるという判断が、5回連続していないと判断した場合には、測位位置Pが安定していないと判断する(ステップST34A)。
以上が、測位位置Pの安定性を判断するときの端末20の動作例である。
【0094】
次に、図10のステップST4における第2測位法を実施するときの端末20の動作例を主に図14及び図15を使用して説明する。
まず、端末20は、HSVについて、擬似距離d5(図9参照)を算出する(図14のステップST41)。このステップST41は、高信頼度衛星擬似距離算出ステップの一例である。
【0095】
続いて、端末20は、前回位置Pn−1と前回の速度ベクトルに基づいて、予測位置Pf(図9参照)を算出する(ステップST42)。このステップST42は、予測位置算出ステップの一例である。
【0096】
続いて、端末20は、各HSVについて、予測位置Pfと現在時刻における衛星軌道上の座標(現在座標)に基づいて、近似距離d6(図9参照)を算出する(ステップST43)。このステップST43は、高信頼度衛星近似距離算出ステップの一例である。
【0097】
続いて、端末20は、各HSVについて、擬似距離d5と近似距離d6との差分d7を算出する(ステップST44)。このステップST44は、高信頼度衛星差分算出ステップの一例である。
【0098】
続いて、端末20は、差分d7を平均し、平均差分d7av(図9参照)を算出する(ステップST45)。このステップST45は、平均差分算出ステップの一例である。
【0099】
続いて、端末20は、各NSVについて、擬似距離d8を算出する(ステップST46)。ステップST46は、第2擬似距離算出ステップの一例である。
続いて、端末20は、各NSVについて、予測位置Pfと衛星軌道上の現在座標に基づいて、近似距離d9(図9参照)を算出する(ステップST47)。このステップST47は、第2近似距離算出ステップの一例である。
【0100】
続いて、端末20は、各NSVについて、擬似距離d8と近似距離d9との差分d10(図9参照)を算出する(図15のステップST48)。このステップST48は、第2差分算出ステップの一例である。
【0101】
続いて、端末20は、平均差分d7avと差分d10の差分である判定値d11(図9参照)を算出する(ステップST49)。このステップST49は、測位使用可能性判定値算出ステップの一例である。
続いて、端末20は、HSVと判定値d11が誤差閾値w以下のNSVとで第2拡張セットSet2(図3参照)を生成する(ステップST50)。このステップST50は、第2測位使用可能性判断ステップの一例であり、第2測位使用衛星群生成ステップの一例でもある。
【0102】
続いて、端末20は、第2拡張セットSet2を使用して測位を行い、現在位置Pを算出する(ステップST51)。このステップST51は、第2測位位置情報生成ステップの一例である。
続いて、端末20は、現在位置Pnを示す現在位置情報170(図3参照)を表示装置34(図2参照)に表示する(ステップST52)。
以上が、第2測位法を実施するときの端末20の動作例である。
【0103】
以上で説明したように、端末20は、測位位置Pnの安定性を判断することができ、測位位置Pの変化が大きい場合には、第1測位方法によって測位位置情報170を生成し、測位位置Pの変化が小さい場合には、第2測位方法によって測位位置情報170を生成することができる。
第2測位法における予測位置Pfは、端末20の移動速度等にかかわらず、現在位置と擬制することができるのであるが、端末20の位置の変化が小さい場合には、前回位置Pn−1と真の現在位置との乖離が小さいから、一層精度良く現在位置と擬制することができる。
【0104】
本発明は、上述の各実施の形態に限定されない。さらに、上述の各実施の形態は、相互に組み合わせて構成するようにしてもよい。
【図面の簡単な説明】
【0105】
【図1】本発明の実施の形態の測位システムを示す概略図である。
【図2】端末の主なハードウエア構成を示す概略図である。
【図3】端末の主なソフトウエア構成を示す概略図である。
【図4】高信頼度衛星判断プログラムの説明図である。
【図5】ベースセット生成プログムの説明図である。
【図6】第1拡張セット生成プログラムの説明図である。
【図7】第1測位プログラムの説明図である。
【図8】距離評価プログラムの説明図である。
【図9】第2拡張セット生成プログラムの説明図である。
【図10】端末の動作例を示す概略フローチャートである。
【図11】端末の動作例を示す概略フローチャートである。
【図12】端末の動作例を示す概略フローチャートである。
【図13】端末の動作例を示す概略フローチャートである。
【図14】端末の動作例を示す概略フローチャートである。
【図15】端末の動作例を示す概略フローチャートである。
【符号の説明】
【0106】
11・・・準天頂衛星、12a,12b,12c,12d,12e,12f,12g,12h,12i・・・GPS衛星、20・・・端末、30・・・GPS受信装置、32・・・準天頂衛星受信装置、112・・・観測可能衛星算出プログラム、114・・・衛星電波受信プログラム、116・・・高信頼度衛星判断プログラム、118・・・ベースセット生成プログラム、120・・・予備セット生成プログラム、122・・・Position Sigama算出プログラム、124・・・基準位置情報生成プログラム、126・・・第1拡張セット生成プログラム、128・・・第1測位プログラム、130・・・距離評価プログラム、132・・・測位位置安定性判断プログラム、134・・・第2拡張セット生成プログラム、136・・・第2測位プログラム

【特許請求の範囲】
【請求項1】
複数の測位衛星からの衛星電波に乗せられている測位基礎符号を使用して、現在位置を測位する測位装置であって、
前記衛星電波を受信する衛星電波受信手段と、
前記衛星電波の受信強度及び前記測位衛星の仰角に基づいて前記衛星電波が直接波である信頼度が高いか否かを判断し、前記信頼度が高い前記衛星電波に対応する前記測位衛星
である高信頼度衛星を示す高信頼度衛星情報を生成する高信頼度衛星情報生成手段と、
前記高信頼度衛星を構成要素とする基準衛星群を生成する基準衛星群生成手段と、
前記基準衛星群を使用して現在位置を予備測位して、出力用の測位に使用する前記測位衛星を選択するための基準位置を示す基準位置情報を生成する基準位置情報生成手段と、
前記高信頼度衛星以外の前記測位衛星である通常衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である第1擬似距離を算出する第1擬似距離算出手段と、
前記基準位置と、前記通常衛星の衛星軌道上の現在座標との距離である第1近似距離を算出する第1近似距離算出手段と、
前記第1擬似距離と前記第1近似距離との差分である第1差分を算出する第1差分算出手段と、
前記第1差分が、直接波に対応する範囲として予め規定した第1測位使用可能範囲内か否かを判断する第1測位使用可能性判断手段と、
前記高信頼度衛星と前記第1測位使用可能範囲内の前記第1差分に対応する前記通常衛星とを構成要素とする第1測位使用衛星群を生成する第1測位使用衛星群生成手段と、
前記第1測位使用衛星群を使用して測位を行い、出力用の測位位置を示す測位位置情報を生成する第1測位位置情報生成手段と、
を有することを特徴とする測位装置。
【請求項2】
前記高信頼度衛星が4個未満である場合には、前記高信頼度衛星と前記通常衛星の合計数が4個である予備衛星群を示す予備衛星群情報を生成する予備衛星群情報生成手段と、
各前記予備衛星群を使用して測位計算を行って測位結果を算出し、前記測位結果のPosition Sigmaを算出するPosition Sigma算出手段を有し、
前記基準衛星群情報生成手段は、前記Position Sigmaが最小の前記予備衛星群を前記基準衛星群とする構成となっていることを特徴とする請求項1に記載の測位装置。
【請求項3】
複数の測位衛星からの衛星電波に乗せられている測位基礎符号を使用して、現在位置を測位する測位装置であって、
前記衛星電波を受信する衛星電波受信手段と、
前記衛星電波の受信強度及び前記測位衛星の仰角に基づいて前記衛星電波が直接波である信頼度が高いか否かを判断し、前記信頼度が高い前記衛星電波に対応する前記測位衛星である高信頼度衛星を示す高信頼度衛星情報を生成する高信頼度衛星情報生成手段と、
前記高信頼度衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である高信頼度衛星擬似距離を算出する高信頼度衛星擬似距離算出手段と、
前回の前記測位位置と、前回の前記測位装置の速度ベクトル及び前回測位時から現在までの経過時間に基づいて、現在の予測位置を算出する予測位置算出段と、
前記予測位置と、前記高信頼度衛星の衛星軌道上の現在座標との距離である高信頼度衛星近似距離を算出する高信頼度衛星近似距離算出手段と、
前記高信頼度衛星擬似距離と前記高信頼度衛星近似距離との差分である高信頼度衛星差分を算出する高信頼度衛星差分算出手段と、
すべての前記高信頼度衛星差分の平均値である平均差分を算出する平均差分算出手段と、
前記高信頼度衛星以外の前記測位衛星である通常衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である第2擬似距離を算出する第2擬似距離算出手段と、
前記予測位置と、前記通常衛星の衛星軌道上の現在座標との距離である第2近似距離を算出する第2近似距離算出手段と、
前記第2擬似距離と前記第2近似距離との差分である第2差分を算出する第2差分算出手段と、
前記平均差分と前記第2差分との差分である測位使用可能性判定値を算出する測位使用可能性判定値算出手段と、
前記測位使用可能性判定値が、直接波に対応する範囲として予め規定した第2測位使用可能範囲内か否かを判断する第2測位使用可能性判断手段と、
前記高信頼度衛星と前記第2測位使用可能範囲内の前記測位使用可能性判定値に対応する前記通常衛星とを構成要素とする第2測位使用衛星群を生成する第2測位使用衛星群生成手段と、
前記第2測位使用衛星群を使用して測位を行い、出力用の測位位置を示す測位位置情報を生成する第2測位位置情報生成手段と、
を有することを特徴とする測位装置。
【請求項4】
複数の測位衛星からの衛星電波に乗せられている測位基礎符号を使用して、現在位置を測位する測位装置であって、
前記衛星電波を受信する衛星電波受信手段と、
前記衛星電波の受信強度及び前記測位衛星の仰角に基づいて前記衛星電波が直接波である信頼度が高いか否かを判断し、前記信頼度が高い前記衛星電波に対応する前記測位衛星
である高信頼度衛星を示す高信頼度衛星情報を生成する高信頼度衛星情報生成手段と、
前記高信頼度衛星を構成要素とする基準衛星群を生成する基準衛星群生成手段と、
前記基準衛星群を使用して現在位置を予備測位して、出力用の測位に使用する前記測位衛星を選択するための基準位置を示す基準位置情報を生成する基準位置情報生成手段と、
前記高信頼度衛星以外の前記測位衛星である通常衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である第1擬似距離を算出する第1擬似距離算出手段と、
前記基準位置と、前記通常衛星の衛星軌道上の現在座標との距離である第1近似距離を算出する第1近似距離算出手段と、
前記第1擬似距離と前記第1近似距離との差分である第1差分を算出する第1差分算出手段と、
前記第1差分が、直接波に対応する範囲として予め規定した第1測位使用可能範囲内か否かを判断する第1測位使用可能性判断手段と、
前記高信頼度衛星と前記第1測位使用可能範囲内の前記第1差分に対応する前記通常衛星とを構成要素とする第1測位使用衛星群を生成する第1測位使用衛星群生成手段と、
前記第1測位使用衛星群を使用して測位を行い、出力用の測位位置を示す測位位置情報を生成する第1測位位置情報生成手段と、
連続して出力される2つの前記測位位置の距離が、予め規定した安定距離範囲内であるか否かを判断する距離評価手段と、
連続して出力される2つの前記測位位置の距離が前記安定距離範囲内であるという判断が、前記測位位置の安定性を判断するために予め規定した回数又は時間において継続したか否かを判断する測位位置安定性判断手段と、
前記高信頼度衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である高信頼度衛星擬似距離を算出する高信頼度衛星擬似距離算出手段と、
前回の前記測位位置と、前回の前記測位装置の速度ベクトル及び前回測位時から現在までの経過時間に基づいて、現在の予測位置を算出する予測位置算出段と、
前記予測位置と、前記高信頼度衛星の衛星軌道上の現在座標との距離である高信頼度衛星近似距離を算出する高信頼度衛星近似距離算出手段と、
前記高信頼度衛星擬似距離と前記高信頼度衛星近似距離との差分である高信頼度衛星差分を算出する高信頼度衛星差分算出手段と、
すべての前記高信頼度衛星差分の平均値である平均差分を算出する平均差分算出手段と、
前記高信頼度衛星以外の前記測位衛星である通常衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である第2擬似距離を算出する第2擬似距離算出手段と、
前記予測位置と、前記通常衛星の衛星軌道上の現在座標との距離である第2近似距離を算出する第2近似距離算出手段と、
前記第2擬似距離と前記第2近似距離との差分である第2差分を算出する第2差分算出手段と、
前記平均差分と前記第2差分との差分である測位使用可能性判定値を算出する測位使用可能性判定値算出手段と、
前記測位使用可能性判定値が、直接波に対応する範囲として予め規定した第2測位使用可能範囲内か否かを判断する第2測位使用可能性判断手段と、
前記高信頼度衛星と前記第2測位使用可能範囲内の前記測位使用可能性判定値に対応する前記通常衛星とを構成要素とする第2測位使用衛星群を生成する第2測位使用衛星群生成手段と、
前記第2測位使用衛星群を使用して測位を行い、出力用の測位位置を示す測位位置情報を生成する第2測位位置情報生成手段と、
を有することを特徴とする測位装置。
【請求項5】
前記測位衛星は、準天頂衛星を含むことを特徴とする請求項1乃至請求項4のいずれかに記載の測位装置。
【請求項6】
前記測位位置情報生成手段は、現在位置の緯度、経度、高度及び前記測位装置の時刻誤差を未知数とする方程式について、前記高信頼度衛星についての前記方程式の平均を使用することによって、未知数としての前記時刻誤差を消去することを特徴とする請求項1乃至請求項5のいずれかに記載の測位装置。
【請求項7】
複数の測位衛星からの衛星電波に乗せられている測位基礎符号を使用して、現在位置を測位する測位装置が、前記衛星電波を受信する衛星電波受信ステップと、
前記測位装置が、前記衛星電波の受信強度及び前記測位衛星の仰角に基づいて前記衛星電波が直接波である信頼度が高いか否かを判断し、前記信頼度が高い前記衛星電波に対応する前記測位衛星である高信頼度衛星を示す高信頼度衛星情報を生成する高信頼度衛星情報生成ステップと、
前記測位装置が、前記高信頼度衛星を含む基準衛星群を示す基準衛星群情報を生成する基準衛星群情報生成ステップと、
前記測位装置が、前記基準衛星群を使用して現在位置を予備測位して、出力用の測位に使用する前記測位衛星を選択するための基準位置を示す基準位置情報を生成する基準位置情報生成ステップと、
前記測位装置が、前記基準衛星群に含まれない前記測位衛星である通常衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である第1擬似距離を算出する第1擬似距離算出ステップと、
前記測位装置が、前記基準位置と、前記基準衛星群に含まれない前記通常衛星の衛星軌道上の現在座標との距離である第1近似距離を示す第1近似距離情報を算出する第1近似距離算出ステップと、
前記測位装置が、前記第1擬似距離と前記第1近似距離との差分である第1差分を算出する第1差分算出ステップと、
前記測位装置が、前記第1差分が、直接波に対応する範囲として予め規定した第1測位使用可能範囲内か否かを判断する第1測位使用可能性判断ステップと、
前記測位装置が、前記高信頼度衛星と前記第1測位使用可能範囲内の前記第1差分に対応する前記通常衛星とを構成要素とする第1測位使用衛星群を生成する第1測位使用衛星群生成ステップと、
前記測位装置が、前記第1測位使用衛星群を使用して測位を行い、出力用の測位位置を示す測位位置情報を生成する第1測位位置情報生成ステップと、
前記測位装置が、連続して出力される2つの前記測位位置の距離が、予め規定した安定距離範囲内であるか否かを判断する距離評価ステップと、
前記測位装置が、連続して出力される2つの前記測位位置の距離が前記安定距離範囲内であるという判断が、前記測位位置の安定性を判断するために予め規定した回数又は時間において継続したか否かを判断する測位位置安定性判断ステップと、
前記測位装置が、前記高信頼度衛星についての前記擬似距離である高信頼度衛星擬似距離を算出する高信頼度衛星擬似距離算出ステップと、
前記測位装置が、前回の前記測位位置と、前回の前記測位装置の速度ベクトル及び前回測位時から現在までの経過時間に基づいて、現在の予測位置を算出する予測位置算出ステップと、
前記測位装置が、前記予測位置と、前記高信頼度衛星の衛星軌道上の現在座標との距離である高信頼度衛星近似距離を算出する高信頼度衛星近似距離算出ステップと、
前記測位装置が、前記高信頼度衛星擬似距離と前記高信頼度衛星近似距離との差分である高信頼度衛星差分を算出する高信頼度衛星差分算出ステップと、
前記測位装置が、すべての前記高信頼度衛星差分の平均値である平均差分算出する平均差分算出ステップと、
前記測位装置が、前記通常衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である第2擬似距離を算出する第2擬似距離算出ステップと、
前記測位装置が、前記予測位置と、前記通常衛星の衛星軌道上の現在座標との距離である第2近似距離を算出する第2近似距離算出ステップと、
前記測位装置が、前記第2擬似距離と前記第2近似距離との差分である第2差分を算出
する第2差分算出ステップと、
前記測位装置が、前記平均差分と前記第2差分との差分である測位使用可能性判定値を算出する測位使用判定値算出ステップと、
前記測位装置が、前記測位使用可能性判定値が、直接波に対応する範囲として予め規定した第2測位使用可能範囲内か否かを判断する第2測位使用可能性判断ステップと、
前記測位装置が、前記高信頼度衛星と前記第2測位使用可能範囲内の前記第2差分に対応する前記通常衛星とを構成要素とする第2測位使用衛星群を生成する第2測位使用衛星群生成ステップと、
前記測位装置が、前記第2測位使用衛星群を使用して測位を行い、出力用の測位位置を示す測位位置情報を生成する第2測位位置情報生成ステップと、
を有することを特徴とする測位装置の制御方法。
【請求項8】
コンピュータに、
複数の測位衛星からの衛星電波に乗せられている測位基礎符号を使用して、現在位置を測位する測位装置が、前記衛星電波を受信する衛星電波受信ステップと、
前記測位装置が、前記衛星電波の受信強度及び前記測位衛星の仰角に基づいて前記衛星電波が直接波である信頼度が高いか否かを判断し、前記信頼度が高い前記衛星電波に対応する前記測位衛星である高信頼度衛星を示す高信頼度衛星情報を生成する高信頼度衛星情報生成ステップと、
前記測位装置が、前記高信頼度衛星を含む基準衛星群を示す基準衛星群情報を生成する基準衛星群情報生成ステップと、
前記測位装置が、前記基準衛星群を使用して現在位置を予備測位して、出力用の測位に使用する前記測位衛星を選択するための基準位置を示す基準位置情報を生成する基準位置情報生成ステップと、
前記測位装置が、前記基準衛星群に含まれない前記測位衛星である通常衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である第1擬似距離を算出する第1擬似距離算出ステップと、
前記測位装置が、前記基準位置と、前記基準衛星群に含まれない前記通常衛星の衛星軌道上の現在座標との距離である第1近似距離を示す第1近似距離情報を算出する第1近似距離算出ステップと、
前記測位装置が、前記第1擬似距離と前記第1近似距離との差分である第1差分を算出する第1差分算出ステップと、
前記測位装置が、前記第1差分が、直接波に対応する範囲として予め規定した第1測位使用可能範囲内か否かを判断する第1測位使用可能性判断ステップと、
前記測位装置が、前記高信頼度衛星と前記第1測位使用可能範囲内の前記第1差分に対応する前記通常衛星とを構成要素とする第1測位使用衛星群を生成する第1測位使用衛星群生成ステップと、
前記測位装置が、前記第1測位使用衛星群を使用して測位を行い、出力用の測位位置を示す測位位置情報を生成する第1測位位置情報生成ステップと、
前記測位装置が、連続して出力される2つの前記測位位置の距離が、予め規定した安定距離範囲内であるか否かを判断する距離評価ステップと、
前記測位装置が、連続して出力される2つの前記測位位置の距離が前記安定距離範囲内であるという判断が、前記測位位置の安定性を判断するために予め規定した回数又は時間において継続したか否かを判断する測位位置安定性判断ステップと、
前記測位装置が、前記高信頼度衛星についての前記擬似距離である高信頼度衛星擬似距離を算出する高信頼度衛星擬似距離算出ステップと、
前記測位装置が、前回の前記測位位置と、前回の前記測位装置の速度ベクトル及び前回測位時から現在までの経過時間に基づいて、現在の予測位置を算出する予測位置算出ステップと、
前記測位装置が、前記予測位置と、前記高信頼度衛星の衛星軌道上の現在座標との距離である高信頼度衛星近似距離を算出する高信頼度衛星近似距離算出ステップと、
前記測位装置が、前記高信頼度衛星擬似距離と前記高信頼度衛星近似距離との差分である高信頼度衛星差分を算出する高信頼度衛星差分算出ステップと、
前記測位装置が、すべての前記高信頼度衛星差分の平均値である平均差分算出する平均差分算出ステップと、
前記測位装置が、前記通常衛星の前記測位基礎符号の送信時刻と受信時刻に基づいて、前記衛星電波が前記送信時刻と前記受信時刻との間に伝播する擬似距離である第2擬似距離を算出する第2擬似距離算出ステップと、
前記測位装置が、前記予測位置と、前記通常衛星の衛星軌道上の現在座標との距離である第2近似距離を算出する第2近似距離算出ステップと、
前記測位装置が、前記第2擬似距離と前記第2近似距離との差分である第2差分を算出
する第2差分算出ステップと、
前記測位装置が、前記平均差分と前記第2差分との差分である測位使用可能性判定値を算出する測位使用判定値算出ステップと、
前記測位装置が、前記測位使用可能性判定値が、直接波に対応する範囲として予め規定した第2測位使用可能範囲内か否かを判断する第2測位使用可能性判断ステップと、
前記測位装置が、前記高信頼度衛星と前記第2測位使用可能範囲内の前記第2差分に対応する前記通常衛星とを構成要素とする第2測位使用衛星群を生成する第2測位使用衛星群生成ステップと、
前記測位装置が、前記第2測位使用衛星群を使用して測位を行い、出力用の測位位置を示す測位位置情報を生成する第2測位位置情報生成ステップと、
を実行させることを特徴とする測位装置の制御プログラム。

【図1】
image rotate

【図2】
image rotate

【図3】
image rotate

【図4】
image rotate

【図5】
image rotate

【図6】
image rotate

【図7】
image rotate

【図8】
image rotate

【図9】
image rotate

【図10】
image rotate

【図11】
image rotate

【図12】
image rotate

【図13】
image rotate

【図14】
image rotate

【図15】
image rotate


【公開番号】特開2007−187455(P2007−187455A)
【公開日】平成19年7月26日(2007.7.26)
【国際特許分類】
【出願番号】特願2006−3533(P2006−3533)
【出願日】平成18年1月11日(2006.1.11)
【出願人】(000002369)セイコーエプソン株式会社 (51,324)
【Fターム(参考)】