JP2015184113A5 - - Google Patents

Description

本発明の位置検出方法においては、測位衛星からの衛星信号を受信し、該衛星信号に基づき、前記測位衛星までの擬似距離を算出し、３次元地図情報及びレイトレーシング法を用い、前記測位衛星からの電波伝播がＬＯＳであるかＮＬＯＳであるかを判定し、ＬＯＳである場合には直接パス及び反射パスの両方を含むマルチパスであるか否かを判定し、マルチパスであるときには前記擬似距離を遅延を考慮して補正し、補正した擬似距離に基づいて現在位置を決定する。

Claims (19)

1. 測位衛星からの衛星信号を受信し、該衛星信号に基づき、前記測位衛星までの擬似距離を算出する受信ユニットと、
   ３次元地図情報及びレイトレーシング法を用い、前記測位衛星からの電波伝播がＬＯＳであるかＮＬＯＳであるかを判定し、ＬＯＳである場合には直接パス及び反射パスの両方を含むマルチパスであるか否かを判定し、マルチパスであるときには前記受信ユニットが算出した擬似距離を前記反射パスの遅延を考慮して補正し、補正した擬似距離に基づいて現在位置を決定する測位ユニットとを有することを特徴とする位置検出装置。
2. 前記測位ユニットは、前記反射パスの遅延距離に応じたマルチパス誤差を算出し、該マルチパス誤差によって前記擬似距離を補正する請求項１に記載の位置検出装置。
3. 前記マルチパス誤差は、前記受信ユニットが備えるコリレータの特性に応じて設定されたモデルに基づいて算出される請求項２に記載の位置検出装置。
4. 前記測位ユニットは、前記測位衛星からの電波伝播がＬＯＳである場合には、前記受信ユニットが備えるコリレータが出力する相関波の波形に基づいてマルチパスであるか否かを判定する請求項１〜３のいずれか１項に記載の位置検出装置。
5. 前記測位ユニットは、前記受信ユニットが算出した擬似距離に基づいて初期位置を算出し、３次元地図情報及びレイトレーシング法を用いて前記初期位置の周辺の複数位置における前記測位衛星までの擬似距離を算出し、該擬似距離に基づいて前記複数位置のうちから候補位置を選択し、前記初期位置との距離が所定条件を満たす程度に小さい候補位置に基づいて現在位置を決定する請求項１に記載の位置検出装置。
6. 前記複数位置は、前記初期位置の周囲に設定されたメッシュの格子点であり、
   前記測位ユニットは、前記メッシュを設定し、該メッシュの格子点を探索点に設定し、各探索点から各測位衛星までの擬似距離であって、３次元地図情報とレイトレーシング法とによって推定したＮＬＯＳ反射パス遅延距離を含む探索点擬似距離を算出し、該探索点擬似距離に基づいて評価位置を算出し、該評価位置と前記初期位置との距離が閾値以下である探索点を候補位置として選択する請求項５に記載の位置検出装置。
7. 前記測位ユニットは、選択した候補位置の周囲にメッシュを設定し、前記探索点の設定、前記探索点擬似距離の算出、前記評価位置の算出、及び、前記候補位置の選択を繰り返す請求項６に記載の位置検出装置。
8. 前記測位ユニットは、選択した候補位置の数が所定数未満である場合、前記初期位置との距離が最小の候補位置を現在位置に決定し、選択した候補位置の数が前記所定数以上である場合、前記初期位置との距離が閾値以下の候補位置を再度選択し、再度選択した候補位置に対して前記初期位置との距離の逆数で重みを付けた平均値を算出して現在位置を決定する請求項５〜７のいずれか１項に記載の位置検出装置。
9. 前記複数位置は、前記初期位置の周囲にランダムに設定された位置であり、
   前記測位ユニットは、前記複数位置を探索点に設定し、各探索点から各測位衛星までの擬似距離であって、３次元地図情報とレイトレーシング法とによって推定したＮＬＯＳ反射パス遅延距離を含む探索点擬似距離を算出し、該探索点擬似距離に基づいて候補位置を選択し、該候補位置と前記初期位置との距離に基づく値を尤度とし、前記候補位置の尤度に応じた加重平均を現在位置と決定する請求項５に記載の位置検出装置。
10. 前記測位ユニットは、各探索点から各測位衛星までの擬似距離であって、３次元地図情報とレイトレーシング法とによって推定したＮＬＯＳ反射パス遅延距離を含む探索点擬似距離を算出し、該探索点擬似距離の集合と、前記受信ユニットが算出した擬似距離の集合との類似度が高い探索点を候補位置として選択する請求項５に記載の位置検出装置。
11. 前記測位ユニットは、前記候補位置を選択する基準に、前記探索点擬似距離の集合と、前記受信ユニットが算出した擬似距離の集合との類似度を更に加える請求項６、７又は９に記載の位置検出装置。
12. 前記測位ユニットは、前記初期位置を算出する位置算出部と、前記複数位置を探索する周辺探索部と、前記候補位置を選択する候補位置選択部と、前記現在位置を決定する現在位置決定部とを備える請求項５〜１１のいずれか１項に記載の位置検出装置。
13. 前記３次元地図情報に含まれる構造物の壁面に対する垂線方向の位置エラーの可能性を考慮し、前記壁面の座標を前記垂線方向に変化させ、最小２乗法の残差が小さくなる位置を探索し、該位置が前記壁面の位置であると推定する請求項１〜１２のいずれか１項に記載の位置検出装置。
14. 前記測位衛星からの電波伝播が前記３次元地図情報に含まれる構造物のエッジを基準とした一定範囲を通過する場合、前記電波伝播がＬＯＳ及びＮＬＯＳの２つの場合を仮定して、双方において前記測位衛星までの擬似距離を算出し、ＬＯＳ又はＮＬＯＳのうちの尤もらしい方を選択する請求項１〜１２のいずれか１項に記載の位置検出装置。
15. 前記測位衛星からの電波伝播が前記３次元地図情報に含まれる構造物のエッジを基準とした一定範囲を通過する場合、前記エッジの存在位置に誤差モデルを仮定し、前記電波伝播がＬＯＳである確率及びＮＬＯＳである確率を定義する請求項１〜１２のいずれか１項に記載の位置検出装置。
16. 前記測位衛星からの電波伝播が、前記３次元地図情報に含まれる構造物に反射する反射パスであると仮定したときと比較して、直接パスであると仮定したときの方が前記初期位置を算出する際の最小２乗法の残差が小さい場合には、前記構造物が存在しないと判定する請求項５〜１２のいずれか１項に記載の位置検出装置。
17. 前記構造物が存在しないとの判定が複数の位置検出装置によって行われた場合、前記判定を３次元地図情報に反映させる請求項１６に記載の位置検出装置。
18. 測位衛星からの衛星信号を受信し、該衛星信号に基づき、前記測位衛星までの擬似距離を算出する受信ユニットを備える位置検出装置と、
    該位置検出装置と通信可能に接続されたサーバとを有する位置検出システムであって、
    前記サーバは、３次元地図情報及びレイトレーシング法を用い、前記測位衛星からの電波伝播がＬＯＳであるかＮＬＯＳであるかを判定し、ＬＯＳである場合には直接パス及び反射パスの両方を含むマルチパスであるか否かを判定し、マルチパスであるときには前記受信ユニットが算出した擬似距離を遅延を考慮して補正し、補正した擬似距離に基づいて現在位置を決定する測位ユニットを備え、決定した現在位置を前記位置検出装置に送信することを特徴とする位置検出システム。
19. 測位衛星からの衛星信号を受信し、
    該衛星信号に基づき、前記測位衛星までの擬似距離を算出し、
    ３次元地図情報及びレイトレーシング法を用い、
    前記測位衛星からの電波伝播がＬＯＳであるかＮＬＯＳであるかを判定し、
    ＬＯＳである場合には直接パス及び反射パスの両方を含むマルチパスであるか否かを判定し、
    マルチパスであるときには前記擬似距離を遅延を考慮して補正し、
    補正した擬似距離に基づいて現在位置を決定することを特徴とする位置検出方法。