姿勢計測装置
【課題】アンテナ間の距離が短くなっても姿勢の測定精度を向上させることができるようにする。
【解決手段】データテーブル１４には、予め求めておいた各アンテナについて各衛星からの信号の移動体座標系における到来方向ごとのカップリング誤差のデータが格納されている。誤差取得部１５は、この到来方向に対応したカップリング誤差のデータをデータテーブル１４から取得する。姿勢算出部１７は、このカップリング誤差を除いた一重位相差又は二重位相差を用いて船舶の姿勢を算出する。
【解決手段】データテーブル１４には、予め求めておいた各アンテナについて各衛星からの信号の移動体座標系における到来方向ごとのカップリング誤差のデータが格納されている。誤差取得部１５は、この到来方向に対応したカップリング誤差のデータをデータテーブル１４から取得する。姿勢算出部１７は、このカップリング誤差を除いた一重位相差又は二重位相差を用いて船舶の姿勢を算出する。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、移動体の姿勢を計測する姿勢計測装置に関する。
【背景技術】
【０００２】
このような移動体の姿勢を計測するための背景技術について順を追って説明する。
【０００３】
（１）移動体における姿勢の定義
まず、２つの座標系、局所座標系と移動体座標系を次のように定義する。「局所座標系」は、移動体の位置において、ｘ-ｙ平面を水平面と平行させ、ｘ軸を真北に向けた右手系直交座標系である。「移動体座標系」は、移動体に固定された右手系直交座標系である。
【０００４】
このように定義したとき、船舶などの移動体の姿勢を示す、方位、ピッチ、ロールは、次のように表すことができる。
【０００５】
「方位」とは、局所座標系のｘ軸から移動体座標系のｘ軸の局所座標系のｘ-ｙ平面への射影へのなす角である。
【０００６】
「ピッチ」とは、移動体座標系のｘ軸の局所座標系のｘ-ｙ平面への射影からの移動体座標系のｘ軸へのなす角である。
【０００７】
「ロール」とは、移動体座標系のｘ軸を中心とした、移動体座標系のｙ軸の局所座標系の水平面からの回転角である。
【０００８】
（２）移動体姿勢計測装置の装置構成例
次に、前述のように表される方位、ピッチ、ロールからなる移動体の姿勢を計測する移動体姿勢計測装置の装置構成例を、図１、図２を参照して説明する。
【０００９】
この移動体姿勢計測装置１は、移動体の一例としての船舶Ｓに設置されている。移動体姿勢計測装置１は、アンテナ部２と処理部３とから構成される。
【００１０】
アンテナ部２は、アンテナα，β，γとからなり、アンテナαは基準アンテナとなる。このアンテナα，β，γは船舶Ｓ上に設置されているものとする。図１に示すように、移動体座標系のｘ軸はアンテナαとβがなす第１基線ｂαβに一致するものとし、移動体座標系のｘ‐ｙ平面はアンテナα，β，γが作る平面にあるものとする。
【００１１】
処理部３は、３つの受信機４と姿勢算出処理機５とからなる。各受信機４は、それぞれ各アンテナα，β，γに接続されていて、各アンテナα，β，γで受信している衛星信号（ＧＰＳ信号など）を受信する。これにより、各受信機４では、受信している衛星信号の搬送波位相と、衛星への局所座標系での視線方向ベクトル（衛星と船舶Ｓとの位置関係を示す）とが得られる。ここでは、アンテナα，β，γ間の距離は比較的短いもの（例えば１メートル程度）とし、そのことから衛星に対する各アンテナα，β，γからの視線方向ベクトルはすべて同じであるものとする。姿勢算出処理機５は、各受信機４から得られた情報に基づいてアンテナα，β，γの姿勢を算出する演算を行う。
【００１２】
（３）一般的な姿勢算出法
移動体姿勢計測装置１では、衛星航法システムを利用して各アンテナα，β，γ間の基線ベクトルを算出すれば、その算出値から船舶Ｓの姿勢を算出することができる。
【００１３】
図１に示すように、アンテナαからβへのとの第１基線をｂαβ、アンテナαからγへの第２基線をｂαγとすれば、この基線ｂαβ，ｂαγから、船舶Ｓの姿勢、すなわち、方位、ピッチ、ロールは、それぞれ、
【数１】
………（１）
と表すことができる。
【００１４】
ここで、
【数２】
………（２）
である。なお、数１において、arg(・)は複素数の偏角を求める関数であり、添え字ｘ,ｙ,ｚは、ベクトルの座標系における各軸方向の成分を意味する。
【００１５】
（４）基線ベクトルの算出
前述のとおり、基線ベクトルを求めることにより、船舶Ｓの姿勢を算出することができる。ここで、基線ベクトルを求めるには、次のようにする。
【００１６】
まず、受信機４から得られた搬送波位相から一重位相差、二重位相差を求める。ここで、「一重位相差」とは、基準アンテナ（アンテナα）及びユーザアンテナ（アンテナβ，γ）における、同一衛星からの信号の搬送波位相の差分であり、「二重位相差」とは、基準衛星に対する一重位相差と他の衛星の一重位相差の差分である。
【００１７】
そして、このような一重位相差又は二重位相差と衛星への視線方向ベクトルとの関係から、最小二乗法をもちいて基線ベクトルを算出することができる。
【００１８】
（５）基線と一重位相差又は二重位相差との関係
図３を参照して、一重位相差とは基準アンテナ１０１及びユーザアンテナ１０２における、同一衛星１０５からの信号の搬送波位相の差分である。この差分と基準アンテナ１０１（その信号は基準受信機１０３で受信する）及びユーザアンテナ１０２（その信号は基準受信機１０４で受信する）により構成される基線ベクトルの間には行路差から、
【００１９】
【数３】
………（３）
が成り立つ。なお、ｙは位相差、ｈは衛星への単位方向ベクトル、ｂは基線ベクトル、ａは整数の値、Δｔは受信機の位相差の取得タイミングのズレを表す時計誤差、ｅは観測誤差、であり、これらのｙ，ｂ，ａ，Δｔ，ｅの単位は波数とする。また、添え字ｓは一重位相差についての値であることを意味する。
【００２０】
この式は、一重位相差と行路差ｈＴｓｂとの間には、ある波長の整数倍とΔｔとを足し合わせた分だけの差があることを示している。例えば、各アンテナで瞬時位相を観測したとき、その値の範囲は［−０．５：０．５］となる。このとき、一重位相差の値は［−１．０：１．０］でしか表されないため、行路差ｈＴｓｂとの間には、ある波長の整数倍とΔｔとを足し合わせた分だけの差があることになる。この整数値は整数値アンビギュイティと呼ばれ、（３）式中のａｓにあたる。
【００２１】
また、二重位相差とは、ある基線における基準衛星の一重位相差と基準衛星以外の一重位相差の差分である。基準衛星ｉと衛星ｋとにおける二重位相差と基線との関係は、
【数４】
………（４）
と表される。
【００２２】
ここで、
【数５】
………（５）
を意味する。なお、添え字ｄは二重位相差に関する値であることを表している。二重位相差を用いる利点は、時計誤差を打ち消すことができることである。
【００２３】
（６）基線の算出
複数の衛星を受信すれば、基線ベクトルｂに関する連立方程式を立てることができ、この連立方程式を最小二乗法により解けば基線ベクトルｂを算出できる。
【００２４】
一重位相差の場合、連立方程式は、
【数６】
………（６）
と表される。
【００２５】
ここで、
【数７】
………（７）
である。
【００２６】
整数値アンビギュイティが既知であるとすれば、基線と時計誤差は、最小二乗法を用いて、
【数８】
………（８）
と推定できる。
【００２７】
ここで、Ｑは重み行列であり、通常、
【数９】
………（９）
と設定するのが普通である。ここでσ２は規格化係数である。
【００２８】
二重位相差の場合も同様に解け、連立方程式は、
【数１０】
………（１０）
と表され、整数値アンビギュイティが既知であるとすれば、基線と時計誤差の推定値ｂ（ｂにハット）は、
【数１１】
………（１１）
と求めることができる。
【００２９】
整数値アンビギュイティは、周知のＬＡＭＢＤＡ法や、特許文献１に示される手法を用いることで解くことができる。
【先行技術文献】
【特許文献】
【００３０】
【特許文献１】特開２００８‐６４５５５号公報
【発明の概要】
【発明が解決しようとする課題】
【００３１】
移動体の姿勢を測定する場合、測定した姿勢には誤差が含まれる。この誤差の原因は各アンテナの搬送波位相の測定値に混入する誤差である。この誤差ｅは、移動体座標系における衛星信号の到来方向に応じて決まった値をとる誤差（カップリング誤差など）ｅｃとその他の誤差ｅｏｔｈｅｒとに分けることができる。
【００３２】
すなわち、
【数１２】
………（１２）
である。
【００３３】
移動体座標系における衛星信号の到来方向に応じて決まる誤差の代表的なものとしては、アンテナ同士が相互に干渉しあうことにより発生する誤差（カップリング誤差）がある。
【００３４】
そして、アンテナ間の距離が長く、よって基線の長さが長いときには、カップリング誤差ｅｃは十分に小さく、無視することができる。
【００３５】
しかしながら、アンテナ間の距離が短く、基線の長さが短いときには、カップリング誤差ｅｃが大きくなってしまい、そのため、測定した姿勢に含まれる誤差も無視できないほど大きくなってしまうという不具合がある。
【００３６】
本発明の目的は、カップリング誤差などの移動体座標系における衛星信号の到来方向に応じて決まった値をとる誤差が発生する場合において、移動体の姿勢の測定精度を向上させることができるようにすることである。
【課題を解決するための手段】
【００３７】
（１）本発明は、移動体上に設けられる複数のアンテナと、前記アンテナの受信信号から各衛星の搬送波位相値を観測する搬送波位相観測手段と、前記アンテナの受信信号から移動体座標系における前記各衛星信号の到来方向を算出する信号到来方向算出手段と、前記各衛星について前記信号到来方向算出手段で算出した前記移動体座標系における信号の到来方向に応じた搬送波位相誤差を取得する位相誤差取得手段と、前記位相誤差取得手段で取得した前記搬送波位相誤差を前記搬送波位相観測手段で観測した搬送波位相観測値から差し引いた値を用いて前記アンテナの受信信号から前記移動体の姿勢を算出する姿勢算出手段と、を備えている姿勢算出装置である。
【００３８】
（２）別の局面から見た本発明は、移動体上に設けられる複数のアンテナと、前記アンテナの受信信号から各衛星の搬送波位相値を観測する搬送波位相観測手段と、前記アンテナの受信信号から移動体座標系における前記各衛星信号の到来方向を算出する信号到来方向算出手段と、前記各衛星について前記信号到来方向算出手段で算出した前記移動体座標系における信号の到来方向に応じた搬送波位相誤差を取得する位相誤差取得手段と、前記位相差誤差取得手段で取得した前記搬送波位相誤差の位相差誤差を前記搬送波位相観測手段で観測した搬送波位相観測値の位相差から差し引いた値を用いて前記アンテナの受信信号から前記移動体の姿勢を算出する姿勢算出手段と、を備えている姿勢算出装置である。
【００３９】
（３）この場合に、前記移動体の姿勢の概略の値を取得する概略姿勢取得手段をさらに備え、
前記信号到来方向算出手段は、前記概略の姿勢の値に基づいて前記移動体座標系における前記衛星信号の到来方向を算出する、ようにしてもよい。
【００４０】
（４）前記各衛星における衛星信号の各到来方向に応じた誤差を記憶している記憶手段をさらに備え、前記位相誤差取得手段は、前記各衛星について前記信号到来方向算出手段で算出した前記各到来方向に応じた前記搬送波位相誤差を前記記憶手段から取得する、ようにしてもよい。
【発明の効果】
【００４１】
本発明によれば、カップリング誤差などの移動体座標系における衛星信号の到来方向に応じて決まった値をとる誤差を補正して移動体の姿勢を正確に求めることができる。
【図面の簡単な説明】
【００４２】
【図１】本発明の一実施の形態である移動体姿勢計測装置を船体に配置した状態の概念図である。
【図２】本発明の一実施の形態である移動体姿勢計測装置の処理部の構成を説明するブロック図である。
【図３】一重位相差の説明図である。
【図４】衛星信号の到来方向について説明する説明図である。
【図５】本発明の一実施の形態である移動体姿勢計測装置の姿勢算出処理機の機能ブロック図である。
【発明を実施するための形態】
【００４３】
以下、本発明の一実施の形態について説明する。以下では、移動体座標系における衛星信号の到来方向に応じて決まった値をとる誤差としてカップリング誤差を例として説明する。
【００４４】
ここでは、まず、カップリング誤差の特長について説明する。
【００４５】
カップリング誤差ｅｃは、各アンテナについて移動体座標系における衛星信号の到来方向ごとに決まった値をとるという特徴を有している。すなわち、アンテナｉについて移動体座標系おける衛星の信号の到来方向（方位角η、仰角ζ）におけるカップリング誤差をｅｃ-Ａｎｔ（ｉ）（η，ζ）という関数で表すことができる（図４参照）。
【００４６】
よって、アンテナｉとｊとで構成される基線ｋにおけるカップリング誤差による一重位相差の誤差は衛星信号の到来方向ごとに定まり、
【００４７】
【数１３】
………（１３）
と表すことができる。すなわち、ｅｃ（ｓ）-ｂ（ij）（η，ζ）は基線ｋにおけるカップリング誤差による一重位相差の誤差である。
【００４８】
また、基線ｋ、衛星到来方向が方位角ηＡ、仰角ζＡと方位角ηＢ、仰角ζＢの２衛星から算出される二重位相差の誤差は、
【数１４】
………（１４）
と表すことができる。すなわち、ｅｃ(d)-b(ij)（ηＡ，ζＡ，ηＢ，ζＢ）は、基線ｋ、衛星到来方向が方位角ηＡ、仰角ζＡと方位角ηＢ、仰角ζＢの２衛星から算出される二重位相差の誤差である。
【００４９】
これらカップリング誤差ｅｃ-Ａｎｔ（ｉ）（η，ζ）や一重位相差の誤差ｅｃ(s)-ｂ（ij）（η，ζ）といった値は、アンテナ特性の測定や解析などにより求めることができる。また、一重位相差の誤差ｅｃ(s)-ｂ（ij）（η，ζ）は、カップリング誤差ｅｃ-Ａｎｔ（ｉ）（η，ζ）がわかれば、また、二重位相差の誤差ｅｃ(d)-b(ij)（ηＡ，ζＡ，φＢ，ζＢ）はカップリング誤差ｅｃ-Ａｎｔ（ｉ）（η，ζ）又は一重位相差の誤差ｅｃ(s)-ｂ（ij）（η，ζ）がわかれば、それぞれ求めることができる。
【００５０】
次に、このようなカップリング誤差の特徴を利用した姿勢計測装置について説明する。
【００５１】
図１、図２は、本実施の形態の姿勢計測装置の説明図である。
【００５２】
この姿勢計測装置１は、移動体の一例としての船舶Ｓに設置されている。姿勢計測装置１は、アンテナ部２と処理部３とから構成される。
【００５３】
アンテナ部２はアンテナα，β，γとからなり、アンテナαは基準アンテナとなる。このアンテナα，β，γは船舶Ｓ上に設置されているものとする。図１に示すように、移動体座標系のｘ軸はアンテナαとβがなす第１基線ｂαβに一致するものし、移動体座標系のｘ‐ｙ平面はアンテナα，β，γが作る平面に一致するものとする。
【００５４】
処理部３は、３つの受信機４と姿勢算出処理機５とからなる。各受信機４は、それぞれ各アンテナα，β，γに接続されていて、各アンテナα，β，γで受信している衛星信号（ＧＰＳ信号など）を受信する。これにより、各受信機４では、受信している衛星信号の搬送波位相と、衛星への局所座標系での視線方向ベクトル（衛星と船舶Ｓとの位置関係を示す）とが得られる。また、姿勢算出処理機５は、各受信機４から得られた情報に基づいてアンテナα，β，γの姿勢を算出する演算を行う。
【００５５】
次に、姿勢算出処理機５が実行する処理について説明する。
【００５６】
図５は、姿勢算出処理機５が実行する処理を説明する機能ブロック図である。
【００５７】
姿勢算出処理機５が実行する処理は、マイクロコンピュータが所定のプログラムに基づいて実行する。
【００５８】
まず、衛星信号の到来方向を知るために、船舶Ｓの概略の姿勢を知る必要がある。この概略姿勢を（ψ´，θ´，φ´）とする。この概略の姿勢データとしては、（１）カップリング誤差を補正せずに算出した船舶Ｓの姿勢、（２）前回算出した姿勢（前回の算出から姿勢があまり変わっていないと考えられる場合）、（３）前回測定した姿勢を、振動ジャイロなどを用いて補完して予測された現在の姿勢、などの姿勢データを用いることが考えられる。
【００５９】
この例では、姿勢計測装置１の起動初期においては、概略姿勢算出部１１でカップリング誤差を補正せずに算出した船舶Ｓの姿勢を用い、その後、後述する姿勢算出部１７でカップリング誤差を補正して算出した船舶Ｓの姿勢のデータを算出するようになった場合は、その姿勢のデータを記憶部１２に保持し、前回の姿勢算出部１７で求めた姿勢のデータを用いるようにしている。姿勢算出部１７では、受信機４の受信信号に基づき、前述した手段によりカップリング誤差を補正することなく船舶Ｓの姿勢のデータを算出する。
【００６０】
次に、衛星到来方向算出部１３では、姿勢算出部１７又は記憶部１２から得られた概略姿勢（ψ´，θ´，φ´）に基づいて各衛星からの信号の移動体座標系における到来方向（方位角η、仰角ζ）を求める。
【００６１】
これは、局所座標系における衛星への視線方向ベクトルｈを姿勢（ψ´，θ´，φ´）のときの局所座標系から移動体座標系への座標変換行列Ｔ（ψ，θ，φ）を用いて求められた移動体座標系における衛星への視線方向ベクトルｈ´、
【数１５】
………（１５）
から、
【数１６】
………（１６）
【数１７】
………（１７）
と求められる。
【００６２】
ここで、局所座標系から移動体座標系への座標変換行列Ｔ（ψ，θ，φ）は、
【数１８】
とあらわされる。
【００６３】
データテーブル１４には、予め求めておいた各アンテナについて各衛星からの信号の移動体座標系における到来方向（方位角η、仰角ζ）ごとのカップリング誤差のデータが格納されている。
【００６４】
誤差取得部１５は、生成到来方向算出部１３から得られた各衛星からの信号の移動体座標系における到来方向（方位角η、仰角ζ）に対応したカップリング誤差のデータをデータテーブル１４から取得する。なお、カップリング誤差のデータの取得は予め定められた関数により計算で求めてもよい。
【００６５】
位相差算出部１６では、誤差取得部１５で得られたカップリング誤差により、前述のとおり一重位相差又は二重位相差を、カップリング誤差を除いた形で求める。
【００６６】
そして、姿勢算出部１７は、このカップリング誤差を除いた一重位相差又は二重位相差と衛星信号を用いて船舶Ｓの姿勢を算出する。算出した姿勢データは外部に出力される他、次回の姿勢の算出に供するために記憶部１２に記憶される。
【００６７】
以上説明した姿勢算出装置１によれば、カップリング誤差は、アンテナα，β，γを中心とした移動体座標系における信号の到来方向に対して決まった値をとることを利用して、予め求めておいた（あるいは予め定められた関数により計算で求めた）カップリング誤差を用い、その誤差分を差し引いて姿勢を計測することにより、たとえアンテナα，β，γ間の距離が短くなってもカップリング誤差のない正確な姿勢を算出することができる。
【００６８】
以上の説明では、カップリング誤差を例として説明したが、本発明はこれに限定されるものではなく、移動体座標系における衛星信号の到来方向に応じて決まった値をとる誤差であれば、前述と同様の処理によりこれを除去して、正確な移動体の姿勢を算出することができる。
【符号の説明】
【００６９】
１ 姿勢算出装置
１１ 概略姿勢算出部
１２ 記憶部
１３ 衛星到来方向算出部
１４ データテーブル
１５ 誤差取得部
１６ 位相差算出部
１７ 姿勢算出部
Ｓ 船舶
α，β，γ アンテナ
【技術分野】
【０００１】
本発明は、移動体の姿勢を計測する姿勢計測装置に関する。
【背景技術】
【０００２】
このような移動体の姿勢を計測するための背景技術について順を追って説明する。
【０００３】
（１）移動体における姿勢の定義
まず、２つの座標系、局所座標系と移動体座標系を次のように定義する。「局所座標系」は、移動体の位置において、ｘ-ｙ平面を水平面と平行させ、ｘ軸を真北に向けた右手系直交座標系である。「移動体座標系」は、移動体に固定された右手系直交座標系である。
【０００４】
このように定義したとき、船舶などの移動体の姿勢を示す、方位、ピッチ、ロールは、次のように表すことができる。
【０００５】
「方位」とは、局所座標系のｘ軸から移動体座標系のｘ軸の局所座標系のｘ-ｙ平面への射影へのなす角である。
【０００６】
「ピッチ」とは、移動体座標系のｘ軸の局所座標系のｘ-ｙ平面への射影からの移動体座標系のｘ軸へのなす角である。
【０００７】
「ロール」とは、移動体座標系のｘ軸を中心とした、移動体座標系のｙ軸の局所座標系の水平面からの回転角である。
【０００８】
（２）移動体姿勢計測装置の装置構成例
次に、前述のように表される方位、ピッチ、ロールからなる移動体の姿勢を計測する移動体姿勢計測装置の装置構成例を、図１、図２を参照して説明する。
【０００９】
この移動体姿勢計測装置１は、移動体の一例としての船舶Ｓに設置されている。移動体姿勢計測装置１は、アンテナ部２と処理部３とから構成される。
【００１０】
アンテナ部２は、アンテナα，β，γとからなり、アンテナαは基準アンテナとなる。このアンテナα，β，γは船舶Ｓ上に設置されているものとする。図１に示すように、移動体座標系のｘ軸はアンテナαとβがなす第１基線ｂαβに一致するものとし、移動体座標系のｘ‐ｙ平面はアンテナα，β，γが作る平面にあるものとする。
【００１１】
処理部３は、３つの受信機４と姿勢算出処理機５とからなる。各受信機４は、それぞれ各アンテナα，β，γに接続されていて、各アンテナα，β，γで受信している衛星信号（ＧＰＳ信号など）を受信する。これにより、各受信機４では、受信している衛星信号の搬送波位相と、衛星への局所座標系での視線方向ベクトル（衛星と船舶Ｓとの位置関係を示す）とが得られる。ここでは、アンテナα，β，γ間の距離は比較的短いもの（例えば１メートル程度）とし、そのことから衛星に対する各アンテナα，β，γからの視線方向ベクトルはすべて同じであるものとする。姿勢算出処理機５は、各受信機４から得られた情報に基づいてアンテナα，β，γの姿勢を算出する演算を行う。
【００１２】
（３）一般的な姿勢算出法
移動体姿勢計測装置１では、衛星航法システムを利用して各アンテナα，β，γ間の基線ベクトルを算出すれば、その算出値から船舶Ｓの姿勢を算出することができる。
【００１３】
図１に示すように、アンテナαからβへのとの第１基線をｂαβ、アンテナαからγへの第２基線をｂαγとすれば、この基線ｂαβ，ｂαγから、船舶Ｓの姿勢、すなわち、方位、ピッチ、ロールは、それぞれ、
【数１】
………（１）
と表すことができる。
【００１４】
ここで、
【数２】
………（２）
である。なお、数１において、arg(・)は複素数の偏角を求める関数であり、添え字ｘ,ｙ,ｚは、ベクトルの座標系における各軸方向の成分を意味する。
【００１５】
（４）基線ベクトルの算出
前述のとおり、基線ベクトルを求めることにより、船舶Ｓの姿勢を算出することができる。ここで、基線ベクトルを求めるには、次のようにする。
【００１６】
まず、受信機４から得られた搬送波位相から一重位相差、二重位相差を求める。ここで、「一重位相差」とは、基準アンテナ（アンテナα）及びユーザアンテナ（アンテナβ，γ）における、同一衛星からの信号の搬送波位相の差分であり、「二重位相差」とは、基準衛星に対する一重位相差と他の衛星の一重位相差の差分である。
【００１７】
そして、このような一重位相差又は二重位相差と衛星への視線方向ベクトルとの関係から、最小二乗法をもちいて基線ベクトルを算出することができる。
【００１８】
（５）基線と一重位相差又は二重位相差との関係
図３を参照して、一重位相差とは基準アンテナ１０１及びユーザアンテナ１０２における、同一衛星１０５からの信号の搬送波位相の差分である。この差分と基準アンテナ１０１（その信号は基準受信機１０３で受信する）及びユーザアンテナ１０２（その信号は基準受信機１０４で受信する）により構成される基線ベクトルの間には行路差から、
【００１９】
【数３】
………（３）
が成り立つ。なお、ｙは位相差、ｈは衛星への単位方向ベクトル、ｂは基線ベクトル、ａは整数の値、Δｔは受信機の位相差の取得タイミングのズレを表す時計誤差、ｅは観測誤差、であり、これらのｙ，ｂ，ａ，Δｔ，ｅの単位は波数とする。また、添え字ｓは一重位相差についての値であることを意味する。
【００２０】
この式は、一重位相差と行路差ｈＴｓｂとの間には、ある波長の整数倍とΔｔとを足し合わせた分だけの差があることを示している。例えば、各アンテナで瞬時位相を観測したとき、その値の範囲は［−０．５：０．５］となる。このとき、一重位相差の値は［−１．０：１．０］でしか表されないため、行路差ｈＴｓｂとの間には、ある波長の整数倍とΔｔとを足し合わせた分だけの差があることになる。この整数値は整数値アンビギュイティと呼ばれ、（３）式中のａｓにあたる。
【００２１】
また、二重位相差とは、ある基線における基準衛星の一重位相差と基準衛星以外の一重位相差の差分である。基準衛星ｉと衛星ｋとにおける二重位相差と基線との関係は、
【数４】
………（４）
と表される。
【００２２】
ここで、
【数５】
………（５）
を意味する。なお、添え字ｄは二重位相差に関する値であることを表している。二重位相差を用いる利点は、時計誤差を打ち消すことができることである。
【００２３】
（６）基線の算出
複数の衛星を受信すれば、基線ベクトルｂに関する連立方程式を立てることができ、この連立方程式を最小二乗法により解けば基線ベクトルｂを算出できる。
【００２４】
一重位相差の場合、連立方程式は、
【数６】
………（６）
と表される。
【００２５】
ここで、
【数７】
………（７）
である。
【００２６】
整数値アンビギュイティが既知であるとすれば、基線と時計誤差は、最小二乗法を用いて、
【数８】
………（８）
と推定できる。
【００２７】
ここで、Ｑは重み行列であり、通常、
【数９】
………（９）
と設定するのが普通である。ここでσ２は規格化係数である。
【００２８】
二重位相差の場合も同様に解け、連立方程式は、
【数１０】
………（１０）
と表され、整数値アンビギュイティが既知であるとすれば、基線と時計誤差の推定値ｂ（ｂにハット）は、
【数１１】
………（１１）
と求めることができる。
【００２９】
整数値アンビギュイティは、周知のＬＡＭＢＤＡ法や、特許文献１に示される手法を用いることで解くことができる。
【先行技術文献】
【特許文献】
【００３０】
【特許文献１】特開２００８‐６４５５５号公報
【発明の概要】
【発明が解決しようとする課題】
【００３１】
移動体の姿勢を測定する場合、測定した姿勢には誤差が含まれる。この誤差の原因は各アンテナの搬送波位相の測定値に混入する誤差である。この誤差ｅは、移動体座標系における衛星信号の到来方向に応じて決まった値をとる誤差（カップリング誤差など）ｅｃとその他の誤差ｅｏｔｈｅｒとに分けることができる。
【００３２】
すなわち、
【数１２】
………（１２）
である。
【００３３】
移動体座標系における衛星信号の到来方向に応じて決まる誤差の代表的なものとしては、アンテナ同士が相互に干渉しあうことにより発生する誤差（カップリング誤差）がある。
【００３４】
そして、アンテナ間の距離が長く、よって基線の長さが長いときには、カップリング誤差ｅｃは十分に小さく、無視することができる。
【００３５】
しかしながら、アンテナ間の距離が短く、基線の長さが短いときには、カップリング誤差ｅｃが大きくなってしまい、そのため、測定した姿勢に含まれる誤差も無視できないほど大きくなってしまうという不具合がある。
【００３６】
本発明の目的は、カップリング誤差などの移動体座標系における衛星信号の到来方向に応じて決まった値をとる誤差が発生する場合において、移動体の姿勢の測定精度を向上させることができるようにすることである。
【課題を解決するための手段】
【００３７】
（１）本発明は、移動体上に設けられる複数のアンテナと、前記アンテナの受信信号から各衛星の搬送波位相値を観測する搬送波位相観測手段と、前記アンテナの受信信号から移動体座標系における前記各衛星信号の到来方向を算出する信号到来方向算出手段と、前記各衛星について前記信号到来方向算出手段で算出した前記移動体座標系における信号の到来方向に応じた搬送波位相誤差を取得する位相誤差取得手段と、前記位相誤差取得手段で取得した前記搬送波位相誤差を前記搬送波位相観測手段で観測した搬送波位相観測値から差し引いた値を用いて前記アンテナの受信信号から前記移動体の姿勢を算出する姿勢算出手段と、を備えている姿勢算出装置である。
【００３８】
（２）別の局面から見た本発明は、移動体上に設けられる複数のアンテナと、前記アンテナの受信信号から各衛星の搬送波位相値を観測する搬送波位相観測手段と、前記アンテナの受信信号から移動体座標系における前記各衛星信号の到来方向を算出する信号到来方向算出手段と、前記各衛星について前記信号到来方向算出手段で算出した前記移動体座標系における信号の到来方向に応じた搬送波位相誤差を取得する位相誤差取得手段と、前記位相差誤差取得手段で取得した前記搬送波位相誤差の位相差誤差を前記搬送波位相観測手段で観測した搬送波位相観測値の位相差から差し引いた値を用いて前記アンテナの受信信号から前記移動体の姿勢を算出する姿勢算出手段と、を備えている姿勢算出装置である。
【００３９】
（３）この場合に、前記移動体の姿勢の概略の値を取得する概略姿勢取得手段をさらに備え、
前記信号到来方向算出手段は、前記概略の姿勢の値に基づいて前記移動体座標系における前記衛星信号の到来方向を算出する、ようにしてもよい。
【００４０】
（４）前記各衛星における衛星信号の各到来方向に応じた誤差を記憶している記憶手段をさらに備え、前記位相誤差取得手段は、前記各衛星について前記信号到来方向算出手段で算出した前記各到来方向に応じた前記搬送波位相誤差を前記記憶手段から取得する、ようにしてもよい。
【発明の効果】
【００４１】
本発明によれば、カップリング誤差などの移動体座標系における衛星信号の到来方向に応じて決まった値をとる誤差を補正して移動体の姿勢を正確に求めることができる。
【図面の簡単な説明】
【００４２】
【図１】本発明の一実施の形態である移動体姿勢計測装置を船体に配置した状態の概念図である。
【図２】本発明の一実施の形態である移動体姿勢計測装置の処理部の構成を説明するブロック図である。
【図３】一重位相差の説明図である。
【図４】衛星信号の到来方向について説明する説明図である。
【図５】本発明の一実施の形態である移動体姿勢計測装置の姿勢算出処理機の機能ブロック図である。
【発明を実施するための形態】
【００４３】
以下、本発明の一実施の形態について説明する。以下では、移動体座標系における衛星信号の到来方向に応じて決まった値をとる誤差としてカップリング誤差を例として説明する。
【００４４】
ここでは、まず、カップリング誤差の特長について説明する。
【００４５】
カップリング誤差ｅｃは、各アンテナについて移動体座標系における衛星信号の到来方向ごとに決まった値をとるという特徴を有している。すなわち、アンテナｉについて移動体座標系おける衛星の信号の到来方向（方位角η、仰角ζ）におけるカップリング誤差をｅｃ-Ａｎｔ（ｉ）（η，ζ）という関数で表すことができる（図４参照）。
【００４６】
よって、アンテナｉとｊとで構成される基線ｋにおけるカップリング誤差による一重位相差の誤差は衛星信号の到来方向ごとに定まり、
【００４７】
【数１３】
………（１３）
と表すことができる。すなわち、ｅｃ（ｓ）-ｂ（ij）（η，ζ）は基線ｋにおけるカップリング誤差による一重位相差の誤差である。
【００４８】
また、基線ｋ、衛星到来方向が方位角ηＡ、仰角ζＡと方位角ηＢ、仰角ζＢの２衛星から算出される二重位相差の誤差は、
【数１４】
………（１４）
と表すことができる。すなわち、ｅｃ(d)-b(ij)（ηＡ，ζＡ，ηＢ，ζＢ）は、基線ｋ、衛星到来方向が方位角ηＡ、仰角ζＡと方位角ηＢ、仰角ζＢの２衛星から算出される二重位相差の誤差である。
【００４９】
これらカップリング誤差ｅｃ-Ａｎｔ（ｉ）（η，ζ）や一重位相差の誤差ｅｃ(s)-ｂ（ij）（η，ζ）といった値は、アンテナ特性の測定や解析などにより求めることができる。また、一重位相差の誤差ｅｃ(s)-ｂ（ij）（η，ζ）は、カップリング誤差ｅｃ-Ａｎｔ（ｉ）（η，ζ）がわかれば、また、二重位相差の誤差ｅｃ(d)-b(ij)（ηＡ，ζＡ，φＢ，ζＢ）はカップリング誤差ｅｃ-Ａｎｔ（ｉ）（η，ζ）又は一重位相差の誤差ｅｃ(s)-ｂ（ij）（η，ζ）がわかれば、それぞれ求めることができる。
【００５０】
次に、このようなカップリング誤差の特徴を利用した姿勢計測装置について説明する。
【００５１】
図１、図２は、本実施の形態の姿勢計測装置の説明図である。
【００５２】
この姿勢計測装置１は、移動体の一例としての船舶Ｓに設置されている。姿勢計測装置１は、アンテナ部２と処理部３とから構成される。
【００５３】
アンテナ部２はアンテナα，β，γとからなり、アンテナαは基準アンテナとなる。このアンテナα，β，γは船舶Ｓ上に設置されているものとする。図１に示すように、移動体座標系のｘ軸はアンテナαとβがなす第１基線ｂαβに一致するものし、移動体座標系のｘ‐ｙ平面はアンテナα，β，γが作る平面に一致するものとする。
【００５４】
処理部３は、３つの受信機４と姿勢算出処理機５とからなる。各受信機４は、それぞれ各アンテナα，β，γに接続されていて、各アンテナα，β，γで受信している衛星信号（ＧＰＳ信号など）を受信する。これにより、各受信機４では、受信している衛星信号の搬送波位相と、衛星への局所座標系での視線方向ベクトル（衛星と船舶Ｓとの位置関係を示す）とが得られる。また、姿勢算出処理機５は、各受信機４から得られた情報に基づいてアンテナα，β，γの姿勢を算出する演算を行う。
【００５５】
次に、姿勢算出処理機５が実行する処理について説明する。
【００５６】
図５は、姿勢算出処理機５が実行する処理を説明する機能ブロック図である。
【００５７】
姿勢算出処理機５が実行する処理は、マイクロコンピュータが所定のプログラムに基づいて実行する。
【００５８】
まず、衛星信号の到来方向を知るために、船舶Ｓの概略の姿勢を知る必要がある。この概略姿勢を（ψ´，θ´，φ´）とする。この概略の姿勢データとしては、（１）カップリング誤差を補正せずに算出した船舶Ｓの姿勢、（２）前回算出した姿勢（前回の算出から姿勢があまり変わっていないと考えられる場合）、（３）前回測定した姿勢を、振動ジャイロなどを用いて補完して予測された現在の姿勢、などの姿勢データを用いることが考えられる。
【００５９】
この例では、姿勢計測装置１の起動初期においては、概略姿勢算出部１１でカップリング誤差を補正せずに算出した船舶Ｓの姿勢を用い、その後、後述する姿勢算出部１７でカップリング誤差を補正して算出した船舶Ｓの姿勢のデータを算出するようになった場合は、その姿勢のデータを記憶部１２に保持し、前回の姿勢算出部１７で求めた姿勢のデータを用いるようにしている。姿勢算出部１７では、受信機４の受信信号に基づき、前述した手段によりカップリング誤差を補正することなく船舶Ｓの姿勢のデータを算出する。
【００６０】
次に、衛星到来方向算出部１３では、姿勢算出部１７又は記憶部１２から得られた概略姿勢（ψ´，θ´，φ´）に基づいて各衛星からの信号の移動体座標系における到来方向（方位角η、仰角ζ）を求める。
【００６１】
これは、局所座標系における衛星への視線方向ベクトルｈを姿勢（ψ´，θ´，φ´）のときの局所座標系から移動体座標系への座標変換行列Ｔ（ψ，θ，φ）を用いて求められた移動体座標系における衛星への視線方向ベクトルｈ´、
【数１５】
………（１５）
から、
【数１６】
………（１６）
【数１７】
………（１７）
と求められる。
【００６２】
ここで、局所座標系から移動体座標系への座標変換行列Ｔ（ψ，θ，φ）は、
【数１８】
とあらわされる。
【００６３】
データテーブル１４には、予め求めておいた各アンテナについて各衛星からの信号の移動体座標系における到来方向（方位角η、仰角ζ）ごとのカップリング誤差のデータが格納されている。
【００６４】
誤差取得部１５は、生成到来方向算出部１３から得られた各衛星からの信号の移動体座標系における到来方向（方位角η、仰角ζ）に対応したカップリング誤差のデータをデータテーブル１４から取得する。なお、カップリング誤差のデータの取得は予め定められた関数により計算で求めてもよい。
【００６５】
位相差算出部１６では、誤差取得部１５で得られたカップリング誤差により、前述のとおり一重位相差又は二重位相差を、カップリング誤差を除いた形で求める。
【００６６】
そして、姿勢算出部１７は、このカップリング誤差を除いた一重位相差又は二重位相差と衛星信号を用いて船舶Ｓの姿勢を算出する。算出した姿勢データは外部に出力される他、次回の姿勢の算出に供するために記憶部１２に記憶される。
【００６７】
以上説明した姿勢算出装置１によれば、カップリング誤差は、アンテナα，β，γを中心とした移動体座標系における信号の到来方向に対して決まった値をとることを利用して、予め求めておいた（あるいは予め定められた関数により計算で求めた）カップリング誤差を用い、その誤差分を差し引いて姿勢を計測することにより、たとえアンテナα，β，γ間の距離が短くなってもカップリング誤差のない正確な姿勢を算出することができる。
【００６８】
以上の説明では、カップリング誤差を例として説明したが、本発明はこれに限定されるものではなく、移動体座標系における衛星信号の到来方向に応じて決まった値をとる誤差であれば、前述と同様の処理によりこれを除去して、正確な移動体の姿勢を算出することができる。
【符号の説明】
【００６９】
１ 姿勢算出装置
１１ 概略姿勢算出部
１２ 記憶部
１３ 衛星到来方向算出部
１４ データテーブル
１５ 誤差取得部
１６ 位相差算出部
１７ 姿勢算出部
Ｓ 船舶
α，β，γ アンテナ
【特許請求の範囲】
【請求項１】
移動体上に設けられる複数のアンテナと、
前記アンテナの受信信号から各衛星の搬送波位相値を観測する搬送波位相観測手段と、
前記アンテナの受信信号から移動体座標系における前記各衛星信号の到来方向を算出する信号到来方向算出手段と、
前記各衛星について前記信号到来方向算出手段で算出した前記移動体座標系における信号の到来方向に応じた搬送波位相誤差を取得する位相誤差取得手段と、
前記位相誤差取得手段で取得した前記搬送波位相誤差を前記搬送波位相観測手段で観測した搬送波位相観測値から差し引いた値を用いて前記アンテナの受信信号から前記移動体の姿勢を算出する姿勢算出手段と、
を備えている姿勢算出装置。
【請求項２】
移動体上に設けられる複数のアンテナと、
前記アンテナの受信信号から各衛星の搬送波位相値を観測する搬送波位相観測手段と、
前記アンテナの受信信号から移動体座標系における前記各衛星信号の到来方向を算出する信号到来方向算出手段と、
前記各衛星について前記信号到来方向算出手段で算出した前記移動体座標系における信号の到来方向に応じた搬送波位相誤差を取得する位相誤差取得手段と、
前記位相差誤差取得手段で取得した前記搬送波位相誤差の位相差誤差を前記搬送波位相観測手段で観測した搬送波位相観測値の位相差から差し引いた値を用いて前記アンテナの受信信号から前記移動体の姿勢を算出する姿勢算出手段と、
を備えている姿勢算出装置。
【請求項３】
前記移動体の姿勢の概略の値を取得する概略姿勢取得手段をさらに備え、
前記信号到来方向算出手段は、前記概略の姿勢の値に基づいて前記移動体座標系における前記衛星信号の到来方向を算出する、
請求項１又は２に記載の姿勢算出装置。
【請求項４】
前記各衛星における衛星信号の各到来方向に応じた誤差を記憶している記憶手段をさらに備え、
前記位相誤差取得手段は、前記各衛星について前記信号到来方向算出手段で算出した前記各到来方向に応じた前記搬送波位相誤差を前記記憶手段から取得する、
請求項３に記載の姿勢算出装置。
【請求項１】
移動体上に設けられる複数のアンテナと、
前記アンテナの受信信号から各衛星の搬送波位相値を観測する搬送波位相観測手段と、
前記アンテナの受信信号から移動体座標系における前記各衛星信号の到来方向を算出する信号到来方向算出手段と、
前記各衛星について前記信号到来方向算出手段で算出した前記移動体座標系における信号の到来方向に応じた搬送波位相誤差を取得する位相誤差取得手段と、
前記位相誤差取得手段で取得した前記搬送波位相誤差を前記搬送波位相観測手段で観測した搬送波位相観測値から差し引いた値を用いて前記アンテナの受信信号から前記移動体の姿勢を算出する姿勢算出手段と、
を備えている姿勢算出装置。
【請求項２】
移動体上に設けられる複数のアンテナと、
前記アンテナの受信信号から各衛星の搬送波位相値を観測する搬送波位相観測手段と、
前記アンテナの受信信号から移動体座標系における前記各衛星信号の到来方向を算出する信号到来方向算出手段と、
前記各衛星について前記信号到来方向算出手段で算出した前記移動体座標系における信号の到来方向に応じた搬送波位相誤差を取得する位相誤差取得手段と、
前記位相差誤差取得手段で取得した前記搬送波位相誤差の位相差誤差を前記搬送波位相観測手段で観測した搬送波位相観測値の位相差から差し引いた値を用いて前記アンテナの受信信号から前記移動体の姿勢を算出する姿勢算出手段と、
を備えている姿勢算出装置。
【請求項３】
前記移動体の姿勢の概略の値を取得する概略姿勢取得手段をさらに備え、
前記信号到来方向算出手段は、前記概略の姿勢の値に基づいて前記移動体座標系における前記衛星信号の到来方向を算出する、
請求項１又は２に記載の姿勢算出装置。
【請求項４】
前記各衛星における衛星信号の各到来方向に応じた誤差を記憶している記憶手段をさらに備え、
前記位相誤差取得手段は、前記各衛星について前記信号到来方向算出手段で算出した前記各到来方向に応じた前記搬送波位相誤差を前記記憶手段から取得する、
請求項３に記載の姿勢算出装置。
【図１】
【図２】
【図３】
【図４】
【図５】
【図２】
【図３】
【図４】
【図５】
【公開番号】特開２０１０−２１６８２２（Ｐ２０１０−２１６８２２Ａ）
【公開日】平成２２年９月３０日（２０１０．９．３０）
【国際特許分類】
【出願番号】特願２００９−６０６４２（Ｐ２００９−６０６４２）
【出願日】平成２１年３月１３日（２００９．３．１３）
【出願人】（０００００４３３０）日本無線株式会社 (1,186)
【Ｆターム（参考）】
【公開日】平成２２年９月３０日（２０１０．９．３０）
【国際特許分類】
【出願日】平成２１年３月１３日（２００９．３．１３）
【出願人】（０００００４３３０）日本無線株式会社 (1,186)
【Ｆターム（参考）】
[ Back to top ]