特許 6708328 衛星測位システム及び衛星測位方法

(19)【発行国】日本国特許庁(JP)

(12)【公報種別】特許公報(B2)

(11)【特許番号】6708328

(24)【登録日】2020年5月25日

(45)【発行日】2020年6月10日

(54)【発明の名称】衛星測位システム及び衛星測位方法

(51)【国際特許分類】

   G01S 19/26 20100101AFI20200601BHJP

   G01S 19/43 20100101ALI20200601BHJP

   G01C 15/00 20060101ALI20200601BHJP

   G01C 15/06 20060101ALI20200601BHJP

【ＦＩ】

   G01S19/26

   G01S19/43

   G01C15/00 102C

   G01C15/06 T

【請求項の数】5

【全頁数】21

(21)【出願番号】特願2017-40914(P2017-40914)

(22)【出願日】2017年3月3日

(65)【公開番号】特開2018-9959(P2018-9959A)

(43)【公開日】2018年1月18日

【審査請求日】2018年10月18日

(31)【優先権主張番号】特願2016-133721(P2016-133721)

(32)【優先日】2016年7月5日

(33)【優先権主張国】JP

【国等の委託研究の成果に係る記載事項】（出願人による申告）「国立研究開発法人農業・食品産業技術総合研究機構、ＳＩＰ（戦略的イノベーション創造プログラム）「次世代農林水産業創造技術」委託研究、産業技術力強化法第１９条の適用を受ける特許出願」

(73)【特許権者】

【識別番号】503361400

【氏名又は名称】国立研究開発法人宇宙航空研究開発機構

(74)【代理人】

【識別番号】100094569

【弁理士】

【氏名又は名称】田中 伸一郎

(74)【代理人】

【識別番号】100088694

【弁理士】

【氏名又は名称】弟子丸 健

(74)【代理人】

【識別番号】100067013

【弁理士】

【氏名又は名称】大塚 文昭

(74)【代理人】

【識別番号】100086771

【弁理士】

【氏名又は名称】西島 孝喜

(74)【代理人】

【識別番号】100109070

【弁理士】

【氏名又は名称】須田 洋之

(74)【代理人】

【識別番号】100109335

【弁理士】

【氏名又は名称】上杉 浩

(74)【代理人】

【識別番号】100120525

【弁理士】

【氏名又は名称】近藤 直樹

(72)【発明者】

【氏名】渡邊 恵佑

【審査官】 中村 説志

(56)【参考文献】

【文献】 特開２０１０−２５８７２（ＪＰ，Ａ）

【文献】 特開平１０−３００４９３（ＪＰ，Ａ）

【文献】 米国特許出願公開第２０１３／０１６２４６９（ＵＳ，Ａ１）

【文献】 国際公開第２０１７／０２４３５８（ＷＯ，Ａ１）

(58)【調査した分野】（Int.Cl.，ＤＢ名）

Ｇ０１Ｓ ５／００− ５／１４

Ｇ０１Ｓ１９／００−１９／５５

Ｇ０１Ｃ １／００−１５／１４

(57)【特許請求の範囲】

【請求項1】

衛星測位部、マーカ検出部、及び演算部を有する移動体と、
予め地球固定座標系における位置及び姿勢が測定されているマーカと、を備え、
前記演算部は、前記マーカ検出部によって検出された前記マーカから前記移動体の位置を推定し、
前記衛星測位部は前記移動体の当該推定位置に関する情報を受け取って初期化を行い、
前記演算部は、当該初期化後に前記マーカ検出部が前記マーカを観測して得られた移動体の推定位置と、衛星測位によって得られた移動体の推定位置とをフィッティングすることにより前記マーカの位置を推定し、そのマーカの推定位置と予め前記移動体が保持している前記マーカの位置に関する情報を比較することによって、前記マーカの姿勢に誤差があるか否かを判定する、衛星測位システム。

【請求項2】

前記衛星測位部は、単独搬送波位相測位（ＰＰＰ）方式による衛星測位処理を実行するものである、請求項１に記載の衛星測位システム。

【請求項3】

衛星測位部、マーカ検出部、及び演算部を有する移動体によって、マーカの姿勢に誤差があるか否かを判定する方法であって、
予めマーカの位置及び姿勢を測定し、その結果を前記移動体の演算部が保持するステップと、
前記マーカ検出部が前記マーカを観測し、その結果から前記演算部が前記移動体の位置を推定するステップと、
前記衛星測位部が、前記移動体の当該推定位置に関する情報を受け取って初期化を行うステップと、
前記演算部が、前記初期化の後に前記マーカ検出部が前記マーカを観測して得られた移動体の推定位置と、衛星測位によって得られた移動体の推定位置とをフィッティングすることにより前記マーカの位置を推定するステップと、
前記演算部が、前記推定された前記マーカの位置を前記演算部が保持するマーカの位置と比較して、その比較結果に基づいてマーカの姿勢に誤差があるか否かを判定するステップと、
を備える、マーカの姿勢に誤差があるか否かを判定する方法。

【請求項4】

前記衛星測位部は、単独搬送波位相測位（ＰＰＰ）方式による衛星測位処理を実行するものである、請求項３に記載の方法。

【請求項5】

測定及び／又は評価された前記マーカの地球固定座標系における位置及び姿勢の情報を、前記移動体と、前記移動体と異なる移動体との間で共有する、請求項３または４に記載の方法。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、ＧＮＳＳ（Global Navigation Satellite System）を用いた測位、その中でも単独搬送波位相測位（ＰＰＰ）方式による衛星測位システム及び衛星測位方法に関する。

【背景技術】

【0002】

ＧＮＳＳを用いた測位には幾つかの方式が存在し、その中にＲＴＫ（Real-Time Kinematic）と呼ばれる方式がある。ＲＴＫ方式では、数センチメートル程度の精度でリアルタイムに移動体の測位が可能である。その一方で、ＲＴＫ方式では、このような利点を実現するために、移動体の他に基準局を設けることが必要となり、移動体はこの基準局との間でも信号をやりとりしなければならない。

【0003】

ＧＮＳＳを用いた測位の別の方式として、単独搬送波位相測位（ＰＰＰ:Precise Point Positioning）方式、およびＰＰＰ方式において搬送波位相バイアスの整数解を求めることで精度向上を図るＰＰＰ−ＡＲ（PPP Ambiguity Resolution）方式が知られている（本明細書では、両者を比較対照する場合を除いて、ＰＰＰ方式及びＰＰＰ−ＡＲ方式を含めて、ＰＰＰ方式という）。ＰＰＰ方式は、ＲＴＫ方式とは異なり、基準局が不要でありながら、ＲＴＫ方式と同程度の精度が実現できるという利点がある。その一方で、ＰＰＰ方式では、衛星軌道や衛星時計の誤差、および電離層や対流圏を通過することによる信号の遅延量や搬送波位相バイアスなど多数のパラメータを推定する初期化処理が必要となる。それによって、測位開始からパラメータの推定値が収束して実用的な測位精度が達成されるまでに数十分から１時間程度の時間がかかる。このため、例えば測量、土木作業、建設作業、農作業等にＰＰＰ方式を利用しようとする場合は、この初期化処理が終わるまでは作業を開始できないことが欠点とされていた。（非特許文献１〜３参照）

【先行技術文献】

【非特許文献】

【0004】

【非特許文献1】三吉他「複数ＧＮＳＳ対応単独搬送波位相測位（ＰＰＰ）技術の研究開発と評価結果」第５９回宇宙科学技術連合講演会講演集２Ｈ１２，２０１５

【非特許文献2】高須他「ＭＡＤＯＣＡにおけるＰＰＰ−ＡＲ機能の拡張と評価」第５９回宇宙科学技術連合講演会講演集２Ｈ１３，２０１５

【非特許文献3】谷山他「ＰＰＰ初期収束時間短縮のための補強情報の生成と評価」第５９回宇宙科学技術連合講演会講演集２Ｈ１４，２０１５

【発明の概要】

【発明が解決しようとする課題】

【0005】

本発明はこのような事情に基づいてなされたものであり、地球上に設置されたマーカを利用して衛星測位における初期化処理にかかる時間を短縮することができるシステム及び方法、並びに、マーカの位置及び／又は姿勢を正確に測定し又は評価することができる方法を提供することを目的とする。また、マーカの姿勢誤差を判定するシステム又は方法も提供する。

【課題を解決するための手段】

【0006】

本発明に係る衛星測位システムは、
衛星測位部、マーカ検出部、及び演算部を有する移動体と、
予め地球固定座標系における位置及び姿勢が測定されているマーカと、を備え、
前記演算部は、前記マーカ検出部によって検出された前記マーカの位置及び姿勢に基づいて前記移動体の地球固定座標系における位置を算出し、
前記衛星測位部は、前記演算部が算出した前記移動体の位置に関する情報を受け取って、衛星測位処理を実行する。

【0007】

前記マーカ検出部は、前記マーカの画像を撮影する撮影装置を含むことができる。

【0008】

また、本発明に係る衛星測位システムは、
衛星測位部、マーカ検出部、及び演算部を有する移動体と、
予め地球固定座標系における位置が測定されている複数のマーカと、を備え、
前記演算部は、前記マーカ検出部によって検出された前記複数のマーカの位置に基づいて前記移動体の地球固定座標系における位置を算出し、
前記衛星測位部は、前記演算部が算出した前記移動体の位置に関する情報を受け取って、衛星測位処理を実行する。

【0009】

本発明に係る衛星測位方法は、
地球固定座標系におけるマーカの位置、又は前記マーカの姿勢を予め測定するステップと、
移動体に搭載されたマーカ検出部により前記マーカを検出し、それに基づいて移動体の地球固定座標系における位置を算出するステップと、
前記移動体の地球固定座標系における位置に関する情報を移動体に搭載された衛星測位部に供給し、衛星測位処理を実行するステップと、
を備える。

【0010】

本発明に係るマーカの位置及び姿勢を測定する方法は、
衛星測位部、マーカ検出部、及び演算部を有する移動体によって、地上に固定されたマーカの位置及び姿勢を測定する方法であって、
前記移動体の地球固定座標系における位置を取得するステップと、
前記移動体を任意の経路で移動させるステップと、
前記移動体の移動中に、複数の地点のそれぞれにおいて、前記マーカ検出部により前記マーカを観測して前記マーカの前記マーカ検出部に対する相対位置及び相対姿勢を計測し、その計測結果に基づいて各観測地点における前記移動体の前記マーカに対する相対位置を算出するステップと、
前記各観測地点での、前記移動体の地球固定座標系における位置と、前記移動体の前記マーカに対する算出された相対位置を用いて、前記マーカの地球固定座標系における位置及び姿勢を推定するステップと、
を備える。

【0011】

ここで、前記各観測地点での、前記移動体の地球固定座標系における位置と、前記移動体の前記マーカに対する算出された相対位置との間の距離を算出し、前記各観測地点の全てにおける前記距離の総和に基づく評価関数を最小とするような前記マーカの地球固定座標系における位置及び姿勢を推定値とすることができる。

【0012】

さらに、本発明に係るマーカの位置及び姿勢を測定する方法は、
衛星測位部、マーカ検出部、及び演算部を有する移動体によって、地上に固定されたマーカの位置及び姿勢を測定する方法であって、
前記移動体の地球固定座標系における位置を取得するステップと、
前記マーカに対する任意の位置に複数の仮想マーカを設定するステップと、
前記移動体を任意の経路で移動させるステップと、
前記移動体の移動中に、複数の地点のそれぞれにおいて、前記マーカ検出部により前記マーカを観測して前記マーカの位置及び姿勢を計測し、その結果に基づいてそれぞれの地点において前記複数の仮想マーカの移動体に対する相対位置を算出し、各観測地点において算出された前記複数の仮想マーカの算出相対位置から前記複数の仮想マーカの地球固定座標系における位置を推定するステップと、
前記複数の仮想マーカの推定された位置から、前記マーカの位置及び姿勢を推定するステップと、
を備える。

【0013】

ここで、前記任意の経路は、前記マーカからみた遠位点と近位点とを結ぶ直線であり、前記複数の仮想マーカは、前記マーカとそれぞれの前記仮想マーカを結ぶ直線上で前記移動体から前記直線に下ろした垂線と前記直線との交点に位置するものとすることができる。

【0014】

また、本発明に係るマーカの位置及び姿勢を評価する方法は、
衛星測位部、マーカ検出部、及び演算部を有する移動体によって、地上に固定されたマーカの位置及び姿勢を評価する方法であって、
地上に固定されたマーカの位置及び姿勢を、記憶部に予め記憶しておくステップと、
前記記憶部に予め記憶された前記マーカの位置及び姿勢と、請求項６又は７に記載の方法により測定された前記マーカの位置及び姿勢とを比較するステップと、
を備える。

【0015】

本発明に係る衛星測位システムは、
衛星測位部、マーカ検出部、及び演算部を有する移動体と、
予め地球固定座標系における位置及び姿勢が測定されているマーカと、を備え、
前記演算部は、前記マーカ検出部によって検出された前記マーカから前記移動体の位置を推定し、
前記衛星測位部は前記移動体の当該推定位置に関する情報を受け取って初期化を行い、前記演算部は、
当該初期化後に前記マーカ検出部が前記マーカを観測することによって前記マーカの位置を推定し、そのマーカの推定位置と予め前記移動体が保持している前記マーカの位置に関する情報を比較することによって、あらかじめ前記移動体が保持している前記マーカの姿勢に誤差があるか否かを判定する。

【0016】

本発明に係るマーカの姿勢誤差を判定する方法は、
衛星測位部、マーカ検出部、及び演算部を有する移動体によって、あらかじめ移動体が保持しているマーカの姿勢誤差を判定する方法であって、
予めマーカの位置及び姿勢を測定し、その結果を前記移動体の演算部が保持するステップと、
前記マーカ検出部が前記マーカを観測し、その結果から前記演算部が前記移動体の位置を推定するステップと、
前記衛星測位部が、前記移動体の当該推定位置に関する情報を受け取って初期化を行うステップと、
前記初期化の後に前記マーカ検出部が前記マーカを観測し、その結果に基づいて前記マーカの位置を推定するステップと、
前記演算部が、前記推定された前記マーカの位置を前記演算部が保持するマーカの位置と比較して、その比較結果に基づいてマーカの姿勢に誤差があるか否かを判定するステップと、
を備える。

【0017】

前記衛星測位部は、単独搬送波位相測位（ＰＰＰ）方式による衛星測位処理を実行するものとすることができる。

【0018】

測定及び／又は評価された前記マーカの地球固定座標系における位置及び姿勢の情報を、前記移動体と、前記移動体と異なる移動体との間で共有することができる。

【発明の効果】

【0019】

予め地球固定座標系における位置及び姿勢が測定されているマーカの位置及び姿勢、あるいは、予め地球固定座標系における位置が測定されている複数のマーカの位置を検出し、これに基づいて移動体の地球固定座標系における位置を算出し、その情報を用いて衛星測位処理を実行することにより、衛星測位における初期化処理にかかる時間を従来と比較して大幅に短縮することができる。

【0020】

また、前述の、地上に固定されたマーカの位置及び姿勢を測定する方法を実行することによっても、衛星測位における初期化処理にかかる時間を短縮することができる。

【0021】

さらに、地上に固定されたマーカの位置及び／又は姿勢を予め記憶しておき、前述の方法でマーカの位置及び／又は姿勢を測定し、両者を比較することによって、マーカの現在の位置及び／又は姿勢の正確さを評価することができる。

【図面の簡単な説明】

【0022】

【図1】ＲＴＫ方式とＰＰＰ方式について、誤差の主な原因と、これらの誤差を低減するための処理の方法を比較対照した図である。

【図2】衛星測位を行う移動体と視覚マーカとを示した図である。

【図3】視覚マーカの位置及び姿勢を測定する方法を示した図である。

【図4】視覚マーカの位置及び姿勢を測定する方法を示した図である。

【図5】視覚マーカの位置及び姿勢を測定する方法を示した図である。

【図6】視覚マーカの位置及び姿勢を測定する方法を示した図である。

【図7】視覚マーカの位置及び姿勢を測定する方法を示した図である。

【図8】視覚マーカの位置及び姿勢を測定する方法を示した図である。

【図9】視覚マーカの位置及び姿勢を測定する方法を示した図である。

【図10】視覚マーカの位置及び姿勢を測定する方法を示した図である。

【図11】視覚マーカの位置及び姿勢を測定する方法を示した図である。

【図12】視覚マーカの位置及び姿勢を測定する方法を示した図である。

【図13】視覚マーカの位置及び姿勢を測定する方法を示した図である。

【図14】視覚マーカの位置及び姿勢を測定する方法を示した図である。

【図15】視覚マーカの位置及び姿勢を測定する方法を示した図である。

【図16】視覚マーカの位置及び姿勢を測定する方法を示した図である。

【図17】初期化時の測位誤差を低減する方法について説明する図である。

【図18】初期化時の測位誤差を低減する方法について説明する図である。

【図19】初期化時の測位誤差を低減する方法について説明する図である。

【図20】初期化時の測位誤差を低減する方法について説明する図である。

【図21】マーカ設置姿勢の誤差の検出の原理を説明する図である。

【図22】フロー図と、所定の工程における既知の情報と推定の対象を示した図である。

【図23】実験で使用する座標系と各計算に用いる変数の定義を示した図である。

【図24】実験のめために作製したシステムの構成を示す図である。

【図25】作製したシステムを移動体に搭載して行った実験の方法を示した図である。

【図26】マーカによる初期化を行った場合と行わなかった場合の結果の比較を示した図である。

【図27】（数２）に現れる各記号の意味を示した図である。

【発明を実施するための形態】

【0023】

以下に、本発明の実施形態について説明する。なお、本発明は、以下の実施形態によって限定的に解釈されるものではない。
なお、本明細書で言う「初期化」には、測位中断後の再初期化も含むものとする。すなわち、ＧＮＳＳアンテナと衛星との間に障害物が存在することなどにより衛星からの信号が受信できなくなった場合、その後に再び受信できるようになったとしても、測位を再開するためには中断時間に応じて初期化と同様の処理（再初期化）が必要になる場合があり、このような測位中断後の再初期化も含むものとする。

【0024】

図１は、ＲＴＫ方式とＰＰＰ方式について、誤差の主な原因と、これらの誤差を低減するための処理の方法を比較対照した図である。図１には、測位衛星からの信号を受信する移動体として、建設現場で使用される車両が示されており、この車両に測位衛星からの信号を受信するＧＮＳＳアンテナが搭載されている。この他に、農業で使用される農業機械、測量現場で使用される測量機器、建設現場などで使用される建設機器などの移動体にも、測位衛星からの信号を受信するＧＮＳＳアンテナを搭載して、衛星測位を実行することができる。

【0025】

図１に示すように、衛星には高精度の時計が搭載されているが、その時計にも誤差が生じ、また衛星の軌道にも誤差が生じる。そして、測位衛星から発せられる信号は、移動体のＧＮＳＳアンテナに到達するまでに電離層及び対流圏を伝搬するが、その際に遅延を受け、この遅延による誤差も生じる。ＲＴＫ方式ではこのような誤差に対して、精密な位置が分かっている基準局を設置し、移動体と基準局の両方で少なくとも５つの測位衛星からの電波を受け、さらに移動体と基準局との間で信号のやりとりをすることで、このような誤差をキャンセルし、数センチメートル程度の精度を達成することができる。

【0026】

一方、ＰＰＰ方式では、４つ以上の測位衛星から電波を受け、観測結果及びモデルを用い、衛星軌道や衛星時計の誤差、および電離層や対流圏を通過することによる信号の遅延量や搬送波位相バイアスなど多数のパラメータを推定する初期化処理を行う。初期化処理は、衛星測位を行おうとする移動体に搭載された演算装置によって行うことができる。かかる初期化処理が済めば、地球に固定された座標系（地球固定座標系という）の上での位置について、ＲＴＫと同程度の精度で推定することができる。このようにＰＰＰ方式では基準局及び基準局と移動体との間の通信手段は不要となるものの、初期化処理に数十分から１時間程度の時間がかかる。

【0027】

（実施形態１）
本実施形態では、ＰＰＰ方式における初期化処理にかかる時間を短縮するために、図２に符号２１１で示すような視覚マーカを設置する。視覚マーカ２１１は、必要に応じて支持台２１２に固定する。そして、設置した視覚マーカ２１１の位置及び姿勢を予め精密に測定しておく。ここで、視覚マーカの「位置」は、地球固定座標系の上での位置を指す。また、視覚マーカの「姿勢」は、地球固定座標系に対する視覚マーカに固定された座標系（以下必要に応じて「マーカ座標系」という）の姿勢として定義する。

【0028】

予め測定された視覚マーカ２１１の位置及び姿勢は、図２に示す移動体２０１に搭載された演算装置に関連する記憶装置に視覚マーカ２１１のＩＤ番号と対応付けて記憶させておく。移動体２０１にはさらに、マーカ検出部としてのカメラ２０２及び測位衛星から信号を受信する衛星測位部の一部としてのＧＮＳＳアンテナ２０３が搭載されている。カメラ２０２とＧＮＳＳアンテナ２０３との相対的な位置関係は予め計測しておく。そして、移動体２０１を起動してその位置及び姿勢を迅速かつ精密に推定するために、カメラ２０２の視野に視覚マーカ２１１が入るように移動体２０１を移動させ、カメラ２０２で視覚マーカ２１１を撮影する。

【0029】

ここで、視覚マーカ２１１について説明する。本実施形態で使用する視覚マーカ２１１は、一例として、２次元平面上に所定の間隔で配置されたドットパターンの上に、２次元平面上に配列された多数のレンズからなるレンズアレイを配置・固定したものであり、ドットパターンのドット同士の間隔とレンズアレイのレンズ同士の間隔はわずかに異ならせてある。このような視覚マーカは、特許第５８４２２４８号公報に記載されており、同公報の図３７、図３８、図３９にこのような視覚マーカの具体的構造が示されている。

【0030】

上記特許公報の図３７に示されているように、２次元平面上に配列されたドットパターンの上に、レンズ同士の間隔がドットパターンの間隔とは異なるレンズアレイを配置すると、同公報の図３８に示されているように各レンズを通して拡大されて見えるドットパターンの位置は、ドットパターンとレンズ中心とのずれに応じて、元の位置からずれて見える。これを遠くから見ると、同公報の図３９に示されているように濃淡パターン（一つの大きな濃いパターン）として見える。この濃淡パターンの位置は、視覚マーカの法線とこれを見る視線との角度に応じて変化する。濃淡パターンが視覚マーカの中心にあるときは、視線の方向が視覚マーカの法線と一致しているが、視線の方向と視覚マーカの法線方向との角度の変化に応じて、濃淡パターンの位置が変化する。

【0031】

上記特許公報の図３７に示された構造の視覚マーカは、全体としては平面状だが、視線の方向と視覚マーカの法線との間の角度の変化に対して濃淡パターンの位置が敏感に変化する。このため、平面状の視覚マーカに仮想的に奥行き情報を付加することができる。この平面状の視覚マーカを使用すると、特に視覚マーカの正面付近で高い精度で角度の変化を検出できる。視線の方向と視覚マーカの法線との間の角度と濃淡パターンの位置との関係は、予め測定し記憶させておく。

【0032】

視覚マーカ２１１の正確な位置及び姿勢を予め精密に測定しておくことによって、この視覚マーカを移動体２０１に搭載されたカメラ２０２で撮影し、その画像を入力として移動体に搭載した演算装置上のプログラムによってカメラ２０２に対する視覚マーカ２１１の位置及び姿勢を算出することができる。この結果と、予め精密に測定し記憶させてある視覚マーカ２１１の位置及び姿勢のデータと、カメラ２０２とＧＮＳＳアンテナ２０３との相対的な位置関係とから、地球固定座標系におけるＧＮＳＳアンテナ２０３の位置及び姿勢を求めることができる。

【0033】

こうして得られたＧＮＳＳアンテナ２０３の正確な位置及び姿勢の情報を、ＰＰＰ方式の測位パラメータの推定に利用する。前述のようにＰＰＰ方式の演算装置は、起動してから位置を高い精度で推定できるようになるまでには数十分から１時間程度の時間がかかるが、これはＧＮＳＳアンテナ２０３の初期の位置推定精度が高くない場合、位置を含めた測位パラメータの推定を行うにあたって十分な精度で推定値を求めるには多量の衛星信号を観測する必要があるためである。これに対し、視覚マーカを撮影して得られたＧＮＳＳアンテナ２０３の正確な位置の情報をＰＰＰ方式の演算プログラムに供給することによって、同程度の測位パラメータ推定精度を得るために必要な衛星信号の観測量を劇的に減らすことが可能となり、その結果、高い精度の位置推定ができるようになるまでの時間を、例えば数分程度までに短縮できることが確かめられた。

【0034】

ここで、移動体２０１として農業分野の作業機械にカメラ２０２及びＧＮＳＳアンテナ２０３を搭載した場合を考えると、農場の入口付近などに設けられた支持台２１２に視覚マーカ２１１を設置し、その位置及び姿勢を予め精密に測定しておくことにより、作業機械を起動し、カメラ２０２で視覚マーカ２１１を撮影することによって、作業機械の起動後数分で、ＧＮＳＳアンテナ２０３の正確な位置を高精度に推定できるようになる。したがって、作業機械の起動から作業開始までの時間を大幅に短縮することができる。

【0035】

以上では、視覚マーカとして平面的なものを使用した。視覚マーカの他の例としては、例えば宇宙用途でしばしば用いられる３点マーカを使用することができる。３点マーカは、奥行き情報を求めるために、法線方向に伸びた棒状部材を有している。この棒状部材の先端と後端との視覚上の像のずれと棒状部材の長さから、その３点マーカの姿勢を推定できるというものである。宇宙ステーションなどには、外から宇宙ステーションの姿勢を求めるために、複数の３点マーカが設置されていることが多い。設置場所の要求が厳しくない状況においては、このような３点マーカを視覚マーカとして利用することができる。

【0036】

本実施形態では、ＧＮＳＳを用いた衛星測位方式としてＰＰＰ方式を用いた場合について説明した。しかしながら、本実施形態は、基準局を不要とする方式であって初期化処理に時間を要する衛星測位方式であれば、ＰＰＰ方式には限られない。この点は、以下の各実施形態においても同様である。

【0037】

（実施形態２）
実施形態１では、視覚マーカ２１１の位置及び姿勢を予め精密に測定しておくことが前提となる。視覚マーカ２１１の位置及び姿勢の測定には、測量機器を使う方法を始めとして、種々の方法が考えられるが、実施形態２では、位置を高精度に推定できるようになった移動体２０１を利用して、視覚マーカ２１１の位置及び姿勢を精密に測定する。既に述べたように、ＰＰＰ方式では、移動体２０１の位置を精密に推定できるようになるまでにはある程度の時間がかかるが、時間がかかっても位置を高精度に推定できるようになれば、次のようにして移動体２０１に搭載されたカメラ２０２を利用して、視覚マーカ２１１の精密な位置及び姿勢を測定することができる。

【0038】

図３〜図９は、視覚マーカ２１１の位置及び姿勢を測定する方法を示した図である。図３に示すように、視覚マーカ２１１は右側にあり、カメラ２０２及びＧＮＳＳアンテナ２０３を搭載した移動体２０１は左側にある。移動体２０１と視覚マーカ２１１との距離は、一例として１０メートル程度とする。このとき、ＧＮＳＳアンテナ２０３の位置は、すでにＰＰＰ方式によって高精度に推定できる状態となっている。また、移動体には、例えば地磁気を利用して方位角を測定する機能を有する慣性計測装置（ＩＭＵ:Inertial Measurement Unit）を搭載しておき、これにより移動体の姿勢を推定することができるようになっている。この姿勢の精度は、角度にして数度程度あれば十分である。この移動体２０１の姿勢は、カメラ２０２に対するＧＮＳＳアンテナ２０３の位置を算出するために必要となる。さらに、例えば移動体２０１の遠位点と近位点とを結ぶ直線の垂直二等分線上に、直線に関して対称かつ直線からある程度離れた２つの地点にそれぞれ仮想マーカＡ及びＢを設定し、マーカ座標系における各仮想マーカの位置を記憶する。

【0039】

その後、図４に示すように、遠位点から近位点に向けて移動体２０１の移動を開始する。移動を開始したら、カメラ２０２で視覚マーカ２１１を観測し、カメラ２０２に対する視覚マーカ２１１の相対位置及び姿勢を計測する。そして、図５に示すように、それぞれの観測地点において、最初に記憶したマーカ座標系における各仮想マーカＡ、Ｂの位置と、その観測地点において計測されたカメラ２０２に対する視覚マーカ２１１の相対位置・姿勢から、カメラ２０２に対する各仮想マーカＡ、Ｂの位置を求め、これをもとにカメラ２０２から各仮想マーカＡ、Ｂまでの距離を算出する。

【0040】

さらに、図６に示すように、地球固定座標系におけるカメラ位置（衛星測位及びＩＭＵによって計測）を中心として、図５で求めた各仮想マーカＡ、Ｂまでの距離を半径とする円、すなわち、各仮想マーカＡ、Ｂに対応して一つの観測地点ごとに２つの円を求める。このような観測動作を、図７に示すように、移動体２０１が遠位点から近位点まで移動する間に多数の観測地点（例えば１００地点）において実行する。すると、図８に示すように、各仮想マーカＡ、Ｂについて、観測地点の数に等しい数の円が得られ、それらの円の交点（図８中の星印）が地球固定座標系における各仮想マーカの推定位置となる。なお、ここでは便宜上、円の交点が仮想マーカの推定位置となるという幾何学的解釈に基づいて説明しているが、実際の計算においては、図５について説明した各観測地点から各仮想マーカまでの距離と、各観測地点の位置及び仮想マーカの推定位置から求められる距離との残差をもとに、最適化手法を用いて仮想マーカの推定位置を算出する。

【0041】

このようにして求められた地球固定座標系における各仮想マーカＡ、Ｂの推定位置（図９中の星印）と、図３に関連して説明した予め設定した仮想マーカＡ、Ｂのマーカ座標系における位置から、図９に示すように、地球固定座標系における視覚マーカ２１１の位置及び姿勢（地球固定座標系に対するマーカ座標系の位置・姿勢）を算出する。

【0042】

このようにして視覚マーカ２１１の位置及び姿勢の精密な測定結果が得られたら、この結果を、実施形態１の視覚マーカ２１１の位置及び姿勢の情報として利用できることは直ちに理解されよう。

【0043】

なお、仮想マーカを設定する位置は、上記のように遠位点と近位点とを結ぶ直線の垂直二等分線上とする以外にも、種々の設定の仕方が可能である。また、視覚マーカを観測しながら移動する移動体の走行経路も、上記のように遠位点と近位点を結ぶ直線には限られない。しかしながら、多数の観測地点での観測によって仮想マーカの位置を推定する際の誤差を最小にすることを考慮すると、仮想マーカの設置位置及び移動体の走行経路を上記のようにすることが有利となる。

【0044】

また、上記では、２次元平面上での例を示したが、仮想マーカの数を増やし、距離を半径とする円を球に変更することで、３次元空間への拡張も容易に可能である。

【0045】

（実施形態３）
図１０〜１６は、視覚マーカ２１１の位置及び姿勢を測定する方法を示した図である。図１０に示すように、視覚マーカ２１１は、カメラ２０２及びＧＮＳＳアンテナ２０３を搭載した移動体２０１の前方にある。移動体２０１と視覚マーカ２１１との距離は、一例として１０メートル程度とする。このとき、ＧＮＳＳアンテナ２０３の位置は、すでにＰＰＰ方式によって高精度に推定できる状態となっている。この実施形態では、視覚マーカ２１１の地球固定座標系における正確な位置及び姿勢は未知であるが、以下で示す計算に用いるため、それぞれに仮の値を設定しておく。この仮の値は、真値にできるだけ近い値を設定する必要はなく、例えば、真値との誤差が位置にして１０ｍ程度であってもよく、姿勢にして１０度程度であってもよい。

【0046】

その後、視覚マーカ２１１に近づく方向に移動体２０１の移動を開始する。移動を開始したら、カメラ２０２で視覚マーカ２１１を観測し、カメラ２０２に対する視覚マーカ２１１の相対位置及び姿勢を計測する。そして、図１１に示すように、それぞれの観測地点において、その観測地点において計測されたカメラ２０２に対する視覚マーカ２１１の相対位置及び姿勢と、仮に設定された視覚マーカ２１１の地球固定座標系における位置及び姿勢から、ＧＮＳＳアンテナ２０３の地球固定座標系における推定位置を算出する。同時に、図１２に示すように、衛星測位によってＧＮＳＳアンテナ２０３の地球固定座標系における計測位置を計測する。その際、カメラ２０２が視覚マーカ２１１を撮影する時刻と、衛星測位によりＧＮＳＳアンテナ２０３の位置を計測する時刻は、同期が取れている必要がある。この撮影時刻と計測時刻との同期は、例えば、ＧＮＳＳ受信機からＧＰＳ時刻に同期して出力されるパルス信号を、外部トリガ入力機能を持ったカメラに入力し、ＧＰＳ時刻に同期してカメラのシャッターを切ることによって実現できる。

【0047】

こうして、移動体２０１の移動中に、１つの観測点につき、カメラ２０２と視覚マーカ２１１を利用して求められたＧＮＳＳアンテナ２０３の地球固定座標系における位置（図１３に「＋印（プラス印）」で示す）と、衛星測位を利用して求められたＧＮＳＳアンテナ２０３の地球固定座標系における位置（図１３に「○印（白丸印）」で示す）の、２通りの位置測定結果を得ることができる。

【0048】

このような観測動作を、図１４に示すように、移動体２０１が視覚マーカ２１１に対する遠位点から近位点まで移動する間に多数の観測地点（例えば１００地点）において実行する。すると、図１５に示すように、観測地点の数に等しい組のＧＮＳＳアンテナ２０３の地球固定座標系における位置測定結果が得られる。ここで、図１５中に＋印で示された、カメラ２０２と視覚マーカ２１１を利用して求められたＧＮＳＳアンテナ２０３の各観測地点での地球固定座標系における位置は、移動体２０１による観測開始前に仮に設定した視覚マーカ２１１の地球固定座標系における位置及び姿勢の値に応じて変化する。そこで、この＋印で示された位置の中心と、○印で示された衛星測位によって計測された位置の中心との差（図１６に矢印で示す）が、すべての観測地点についてなるべく小さくなるような視覚マーカ２１１の地球固定座標系における位置及び姿勢の値を求める。これにより、各観測地点における衛星測位の結果と最も整合する、視覚マーカ２１１の地球固定座標系における位置及び姿勢を推定することができる。

【0050】

このようにして、得られた視覚マーカ２１１の位置及び姿勢の精密な測定結果を、実施形態１における視覚マーカの位置及び姿勢の情報として利用できることは直ちに理解されるだろう。すなわち、本実施形態における視覚マーカ２１１の地球固定座標系における位置及び姿勢についての精密な測定結果を実施形態１において視覚マーカの測定結果からＧＮＳＳアンテナの位置を算出する際に用いることによって、ＰＰＰ方式での高い精度の位置推定ができるようになるまでの時間を大幅に短縮することができる。

【0051】

（実施形態４）
次に、実施形態４として、初期化時の測位誤差を低減する方法について説明する。まず、図１７に示すように、実施形態１に示した方法（以下「方法１」とする）と同様の方法によって、測位パラメータの推定を行う。このとき、視覚マーカ２１１は、その位置及び姿勢が本来あるべき正確な位置及び姿勢であるかどうかは分からないことが前提である。その後、図１８に示すように、推定された測位パラメータを用いて実施形態２に示した方法（以下「方法２」とする）により、地球固定座標系における視覚マーカ２１１の位置を推定する。

【0052】

このように推定された位置（Ｐとする）と、事前に測定した結果として記憶している視覚マーカの位置（Ｑとする）から、方法２において視覚マーカを計測している間の衛星測位誤差が一定であると仮定すると（このように仮定することは、想定している時間範囲内においては妥当である）、方法１による測位パラメータ推定時の推定誤差に起因する測位誤差を算出できる。図１９は、このことを模式的に示している。

【0053】

そこで、位置Ｐと位置Ｑとの差から測位誤差を求め、図２０に示すように、これを補正量として初期位置を修正し、再び方法１による測位パラメータ推定を行えば、測位誤差を著しく低減することができる。さらに、測位誤差が低減された状態で方法２によって視覚マーカの位置及び姿勢の推定を行えば、測位開始から十分時間が経過していない段階でも、実施形態５で述べる視覚マーカの設置位置及び姿勢の評価が可能である。

【0054】

（実施形態５）
次に、実施形態５について説明する。実施形態１では、視覚マーカ２１１の位置及び姿勢が高い精度で正確であることが求められるが、例えば地震などがあって地面の位置や方向が変化するなど、何らかの理由で視覚マーカ２１１の位置及び姿勢が変化することが起こり得る。このようなことが起こると、実施形態１で述べた作業機械の起動後数分でＧＮＳＳアンテナ２０３の正確な位置及び姿勢を高精度に推定する、ということができなくなる可能性がある。そこで、実施形態５では、既に位置及び姿勢が測定されている視覚マーカ２１１の、その位置及び姿勢の精度の評価を行う。

【0055】

実施形態１で説明したように、ＰＰＰ方式では、ＧＮＳＳアンテナ２０３の位置推定の精度は、推定動作を一定時間以上継続すれば数センチメートル程度になる。例えば移動体２０１がその日の作業を終える頃には、この程度の推定精度が得られていると考えられる。これとは別に、例えば作業を終えて格納庫に戻る途中において、視覚マーカ２１１を撮影し、実施形態１で説明したようにその画像を入力として移動体に搭載した演算装置上のプログラムによってカメラ２０２に対する視覚マーカ２１１の位置及び姿勢を算出し、予め精密に測定し記憶させてある視覚マーカ２１１の位置及び姿勢のデータと、カメラ２０２とＧＮＳＳアンテナ２０３との相対的な位置関係とから、地球固定座標系におけるＧＮＳＳアンテナ２０３の位置及び姿勢を求める。

【0056】

こうして得られた２つの結果を比較することによって、視覚マーカ２１１が正しく設置されているかどうかを確認・評価できる。例えばこのとき両者の結果に相違があるとすれば、視覚マーカ２１１の位置及び姿勢に何らかの変化が生じたと考えられるので、必要に応じて、視覚マーカ２１１の位置及び姿勢を修正するか、あるいはここで得られた視覚マーカ２１１の位置及び姿勢を新たに記憶装置に記憶し、次回の作業開始時にこれを利用することができる。

【0057】

（実施形態６）
これまでは、１つの視覚マーカを用いた場合について説明した。しかしながら、地球固定座標系における位置のみを高精度に計測できるマーカが複数あれば、マーカの姿勢を高精度に計測することができなくても、実施形態１と同様に、ＧＮＳＳアンテナの初期位置情報を用いることで、測位開始から高い精度を得られるようになるまでに要する時間を短縮することができる。

【0058】

一例として、既知の半径（例えば５０ｍｍ）を有する２本の円柱をマーカとして用い、これらをある程度離して（例えば５ｍ離して）鉛直に設置し、地球固定座標系における円柱中心位置を事前に計測しておく。そして、移動体にはマーカ検出部としてのレーザスキャナ及びＩＭＵを搭載する。ここで、レーザスキャナは、レーザ光線を発射し、対象物体で反射して戻ってくるまでの時間から対象物体までの距離を高精度に測定できるレーザ距離計のうちレーザ光線を放射状に走査させることができるものを用いる。

【0059】

レーザスキャナで２本の円柱までの距離及びそれぞれの円柱を見込む角度を計測し、それらの結果をもとに三角測量の手法を用いて地球固定座標系におけるレーザスキャナの位置を算出する。移動体上でのレーザスキャナとＧＮＳＳアンテナの位置関係を事前に計測しておけば、地球固定座標系におけるレーザスキャナの位置及びＩＭＵによって得られる方位角から、地球固定座標系におけるＧＮＳＳアンテナの位置を算出することが可能となり、これを用いて実施形態１と同様に衛星測位の処理を実行することができる。

【0060】

（実施形態７）
次に、実施形態７として、マーカ設置姿勢の誤差の検出について説明する。図２１に、その検出原理を示す。

【0061】

図２１の左側は、マーカ設置姿勢に誤差がない場合、すなわち、事前に計測し、システムが保持しているマーカ設置姿勢と実際のマーカ設置姿勢が一致している場合を示している。上側の枠内の線でつながれた●印は、マーカを観測することによって得られた移動体の推定位置であり、下側の枠内の線でつながれた★印は、衛星測位によって得られた移動体の推定位置である。先に述べた視覚マーカの位置及び姿勢を測定する方法により、各観測点における●印と★印がなるべく一致するようにフィッティングを行うことで、マーカが設置された推定位置を得ることができる。マーカ設置姿勢に誤差がない場合、この推定設置位置は、事前に計測しシステムが保持している設置位置とほぼ一致する。

【0062】

一方、図２１の右側は、マーカ設置姿勢に誤差がある場合を示している。最初の観測点においてマーカを観測することによって得られた移動体の推定位置は、マーカ設置姿勢の誤差の影響により、上側枠内の左端の●印のように、設置姿勢に誤差がない場合に比べてオフセット（補正）する。この推定位置情報を用いて衛星測位の初期化を行った場合、初期化完了後の衛星測位結果にも先のオフセットに相当する誤差が残る。なお、この誤差は時間の経過と共に徐々に低減するが、ここで考える時間範囲内では一定と見做して差し支えない。これらの測定結果を用いて先に述べたのと同様のフィッティングによりマーカが設置された推定位置を求めると、事前に計測しシステムが保持している設置位置とは一致せず、差が生じる。これはマーカの観測によって求められる移動体の推定位置の誤差量がマーカからの距離に応じて変化するのに対し、衛星測位によって求められる移動体の推定位置の誤差量はほぼ一定であることに起因する。

【0063】

よって、マーカの推定位置と、事前に計測しシステムが保持しているマーカの位置とが一致するか否かによって、マーカ設置姿勢に誤差があるかどうかを検出することができる。なお、この方法によって検出できるのはマーカの設置姿勢の誤差のみであり、マーカの設置位置の誤差は検出できない。しかし、設置状態のマーカが変位する場合、地殻変動などによる大域的変化という極端な場合を除けば、姿勢変化を伴わずにマーカが並進して位置のみが変化することは考えにくい。したがって、マーカに変位が生じたかどうかは、この方法によって十分に判定可能である。

【0064】

（実施形態８）
上述の各実施形態において、マーカの観測結果やマーカの設置位置及び姿勢の推定結果は、通信を利用して複数の移動体の間で共有することができる。これにより、例えばある移動体Ａが実施形態３で説明した方法で推定したマーカの設置位置及び姿勢の情報を、別の移動体Ｂと共有することによって、移動体Ｂは実施形態３で説明した方法による推定を自ら行わなくても、正確なマーカの設置位置及び姿勢の情報を利用することができる。

【0065】

また、マーカの位置及び姿勢の情報は、２次元コードなどの手段によってマーカに付与されたＩＤと共に共有される。ＩＤ及び移動体の大まかな位置情報により、どこに設置されたマーカであるかを一意に決定することができる。

【0066】

（実施例）
次に、発明者らが実際に行った実験と、その結果について、実施例として説明する。図２２は、これまでに説明したいくつかの実施形態の内容と、それぞれの実施形態において、既知の情報が何で、推定の対象が何であるかを分かりやすく示してある。左右の図において（Ａ）、（Ｂ）、（Ｃ）は対応しており、また（Ａ）、（Ｂ）、（Ｃ）は、それぞれ上述の実施形態１、実施形態３、実施形態２にそれぞれ対応している。また、図２３は以下の説明で用いる座標系を示し、図２４は実験のために作製したシステムの構成を示し、図２５は作製したシステムを移動体に搭載して行った実験の方法を示している。なお、図２３に示した各記号の意味は図２７に示した。

【0067】

まず、図２２の（Ａ）に示した初期化実験について説明する。道路脇にマーカを設置し、地球固定座標系に対する位置及び姿勢を予め正確に計測した。以下は、位置及び姿勢の計測方法の一例である。まず、マーカを設置する地点（Ａ地点とする）と、マーカから１０ｍ離れた地点（地点Ｂとする）の地球固定座標系における位置を、後処理ＲＴＫなどの手段により正確に計測した。

【0068】

次に、図２３に示すように、Ａ地点にマーカ座標系のｙ軸が鉛直方向と一致するようにマーカを設置し、Ｂ地点に光学中心がＢ地点の真上にくるようにカメラを設置した。そして、カメラでマーカを撮影し、画像中心にマーカの中心が一致するようカメラの高さと方位角を調整した。このとき、カメラの光軸はＡ地点とＢ地点を結ぶ線分と平行になっている。

【0069】

カメラに対するマーカの姿勢を計測することで、Ａ地点とＢ地点とを結ぶ線分に対するマーカの姿勢を得ることができる。これと、先に計測したＡ地点とＢ地点の地球固定座標系における位置から、マーカの地球固定座標系における姿勢を算出する。さらに、Ａ地点からマーカの中心までの高さを計測する。これと、先に計測したＡ地点の地球固定座標系における位置から、マーカの地球固定座標系における位置を算出する。

【0070】

なお、上記の実験において、リファレンス用に、後処理ＲＴＫを行うための基地局を道路脇に設置し、測位データを収集した。

【0071】

移動体をマーカの手前からマーカに向けて前進させ、マーカから約１０ｍ離れた、マーカがカメラの視野に入る地点で移動体を停止させ、この地点をスタート地点とした。なお、この地点の位置は未知である。

【0072】

ここで、ＰＰＰによる衛星測位を開始し、併せて、マーカの計測を開始し、衛星の暦（軌道・時刻情報）を取得した。衛星の暦は、通常３０秒以内に取得できる。衛星の暦が取得できたら、マーカの計測結果を用いて下記の式

【数2】

によって算出されたＧＮＳＳアンテナの位置を初期値として測位計算を開始する。
この式の各記号の意味ついては、図２３及び図２７を参照されたい。

【0073】

マーカの計測を終了したのち、測位開始から６０秒経過後、スタート地点から約２０ｍ離れた地点まで移動体を前進させながら、測位データを取得した。こうして取得したデータを、後処理ＲＴＫをリファレンスとして比較評価した。

【0074】

図２６は、この比較結果を示した図である。図２６の左側はマーカを用いた初期化を行わなかった場合である。６０秒では十分に収束せず、１ｍを超える誤差が出ていることが分かる。これに対し、図２６の右側に示したマーカを用いて初期化を行った場合では、瞬時に収束して水平誤差３ｃｍ以内の精度が達成されていることが分かる。表１に、５回の試行実験での各試行における水平測位精度を示す。表１から分かるように、非常に高い精度が得られた。

【0075】

【表1】

【0076】

次に、図２２の（Ｃ）に示した、マーカの設置位置及び姿勢の計測実験について説明する。上記（Ａ）の実験と同様に、移動体をスタート地点まで前進させ、ＰＰＰによる衛星測位及びマーカの計測を開始し、初期化を行う。（Ａ）の初期化の場合とは異なり、マーカの計測を継続したまま移動体の前進を開始する。マーカがカメラの視野から外れないように注意しながら、マーカの手前約１ｍの地点まで前進する。これにより、移動中に測位データ及び測位データに同期したマーカ計測データを取得することができる。

【0077】

前述したマーカの設置位置及び姿勢の推定方法により、取得したデータと式１に基づいてマーカの位置及び姿勢を推定し、水平位置誤差７．２ｍｍ、方位角誤差０．０８１度という結果が得られた。

【0078】

次に、図２２の（Ｂ）に示した初期化結果の検証実験について説明する。マーカの設置姿勢（方位角）を人為的に０．１度から０．５度まで０．１度刻みで変化させ、それぞれについて設置位置及び姿勢の計測実験と同様の手順で測位データ及びマーカの計測データを取得し、マーカの設置位置を推定した。表２に、マーカ位置の推定量の差（初期化の際に用いたマーカ位置と推定位置との差）を示す。表２の結果から分かるように、位置の推定量に適切な閾値（例えば２０ｍｍ）を設け、これを超えた場合にはマーカの設置姿勢が変化したと推定し、この閾値以下であればマーカの設置姿勢に変化がないと推定することで、マーカの設置姿勢が変化したかどうかを検出することが可能であることが示される。

【0079】

【表2】

【0080】

（測位パラメータ推定方法）
ところで、測位パラメータの推定は、通常は逐次処理（フィルタ）によって行う。上記各実施例でも、パラメータの推定にはフィルタ（拡張カルマンフィルタ）を用いており、マーカの観測によって求められたＧＮＳＳアンテナの位置の推定値をフィルタの初期値として入力することで初期化している。しかし、測位パラメータの推定はフィルタ以外の方法によっても可能である。また、フィルタも含めて、マーカとの組み合わせによってさらにパラメータの推定精度の向上及び推定時間の短縮が期待できる。以下に、そのような推定方法の具体的な例を挙げる。なお、以下では、実施形態２に示したように、移動体が移動しながら衛星測位とマーカの観測とを同期して実行し、両方の観測データを得られるものとする。

【0081】

第１の例は、フィルタを用いる場合である。カルマンフィルタやその派生手法において、マーカの観測によって得られた移動体の相対位置／速度や相対姿勢／角速度など情報をシステムのダイナミクスに取り込むなどにより、推定精度の向上を図ることができる。

【0082】

第２の例は、バッチ処理によるものである。一定期間の衛星測位データとマーカ観測データとを一括して扱い、非線形最小二乗法などの手法によってパラメータを推定することができる。

【0083】

第３の例は、ハイブリッド手法である。すなわち、フィルタとバッチ処理の両方の側面を持つ手法である。これは、ロボティクスの分野において、smoothing and mapping と呼ばれている手法に相当する。一定期間のデータを用いてバッチ的に推定を行うとともに、時間経過とともに対象とする期間をスライドさせて行くなどにより、精度の向上と計算負荷の軽減を図ることができる。

【0084】

（実施形態４についての補足）
実施形態４に示した「マーカ設置姿勢誤差検出手法」を繰り返し実行することで、マーカの設置姿勢誤差がアンテナの位置推定に求められる許容範囲より大きい場合にも初期化を行うことが可能となる。また実施形態４の方法によってマーカ位置の推定量の差を求めることができる。この値は、理論上は、マーカ設置姿勢の誤差の増大に伴って単調増加する。そこで、マーカ位置の推定量の差から、マーカ設置姿勢の誤差（のおおよその値）を推定することが可能である。この推定された誤差分を、衛星測位の初期化を行う際に用いたマーカ設置姿勢に対して補正し、補正後のマーカ設置姿勢を用いて後処理計算により再度測位の初期化とマーカ設置姿勢の誤差の検出計算を行う。これは、測位データとマーカの観測データを同期して取得してあるため、後処理による計算が可能である。こうして求めたマーカ位置の推定量の差は、初回に求めた値よりも小さくなっていることが期待できる。このようなプロセスを繰り返すことによって、最終的にマーカの設置姿勢の誤差をアンテナ位置の推定に求められる許容範囲内に抑えることができる。

【符号の説明】

【0085】

２０１ 移動体
２０２ カメラ
２０３ ＧＮＳＳアンテナ
２１１ 視覚マーカ
２１２ 支持台

【図1】

【図2】

【図3】

【図4】

【図5】

【図6】

【図7】

【図8】

【図9】

【図10】

【図11】

【図12】

【図13】

【図14】

【図15】

【図16】

【図17】

【図18】

【図19】

【図20】

【図21】

【図22】

【図23】

【図24】

【図25】

【図26】

【図27】