外部情報を得られない環境における装置の方位計測方法
【課題】ジャイロ回転軸が鉛直でなく傾斜している場合において、装置の方位角を的確に計測することができる外部情報を得られない環境における装置の方位計測方法を提供する。
【解決手段】外部情報を得られない環境における装置の方位計測方法において、鉛直でない軸回りにジャイロを回転させ、地球自転軸の方向を検出する方位計測方法であって、ジャイロ感度変化及びオフセット変化の影響を受けないように装置主軸の方位角を計測する。
【解決手段】外部情報を得られない環境における装置の方位計測方法において、鉛直でない軸回りにジャイロを回転させ、地球自転軸の方向を検出する方位計測方法であって、ジャイロ感度変化及びオフセット変化の影響を受けないように装置主軸の方位角を計測する。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、外部情報を得られない環境における装置の方位計測方法に関するものである。
【背景技術】
【０００２】
従来の水平系掘削における位置測定法として、ターゲットが発する電磁波を用いる方法や、レーザ光等の光学的手段を用いてターゲットとの相対角度を測り、位置を算出する方法がある（下記特許文献１，２参照）。
【０００３】
また、推進装置内に搭載したジャイロから得られる角度データ、推進装置の傾きを検知する傾斜計からの角度データ及び推進装置の推進距離を計測する距離計からの距離データを用いて装置の水平位置を演算する際、装置内に設置された位置計測用ターゲット板を用いて推進中の装置の水平変位を測量し、その測量データ及び同時に得られるジャイロの回転角データを用いて、推進装置の推進基線に対する初期角度を演算するようにした地中推進装置の初期角度検知方法及び位置連続検知方法が提案されている（下記特許文献３参照）。
【０００４】
また、本願発明者らは、比較的小さな径を有する管などの水平系の掘削において、地中の水平方向掘削先端位置を、外部環境および作業環境の影響を受けずに的確に測定することができる、水平方向掘削先端位置の測定装置を提案した（下記特許文献４，５参照）。
【特許文献１】特開平１１−０２３２７１号公報
【特許文献２】特開２００２−４８５４３号公報
【特許文献３】特開平１１−１０７６７９号公報
【特許文献４】特願２００４−３５２１２８号
【特許文献５】特願２００４−３５２１２９号
【発明の開示】
【発明が解決しようとする課題】
【０００５】
しかしながら、上記した従来技術では、ジャイロ回転軸が鉛直でなく傾斜している場合には、地球自転軸の方向を検出し、装置の方位角を求めることは困難であった。
【０００６】
本発明は、上記状況に鑑みて、ジャイロ回転軸が鉛直でなく傾斜している場合において、装置の方位角を的確に計測することができる外部情報を得られない環境における装置の方位計測方法を提供することを目的とする。
【課題を解決するための手段】
【０００７】
本発明は、上記目的を達成するために、
〔１〕外部情報を得られない環境における装置の方位計測方法において、鉛直でない軸回りにジャイロを回転させ、地球自転軸の方向を検出する方位計測方法であって、ジャイロ感度変化及びオフセット変化の影響を受けないように装置主軸の方位角を計測することを特徴とする。
【０００８】
〔２〕上記〔１〕記載の外部情報を得られない環境における装置の方位計測方法において、
（ａ）光ファイバージャイロを回転テーブル上に配置し、所定角度（例えば５度毎）に回転して停止し、光ファイバージャイロの出力を多数回（１０００〜１万回程度）計測して平均を求め、そのときのジャイロ回転角θと光ファイバージャイロの平均出力を記録し、
（ｂ）上記（ａ）を１回転にわたって繰り返し、ジャイロ回転角度とその位置における平均ジャイロ出力を記録し、
（ｃ）計測したジャイロ出力値から一回転にわたる平均ジャイロ出力値を差し引き、この平均値を差し引いた後の（実効値×√２）で割算して、振幅・オフセットを規格化し、
（ｄ）前記データの点間を補間して所要の角度ピッチで規格化信号を作成し、
（ｅ）計測ユニットの基準軸を原点とし、所要の角度ピッチでもって、３６０度で１周期になる余弦波を基準信号として作成し、
（ｆ）前記基準信号と前記規格化信号の誤差２乗和を規格化信号をずらしながら演算し、前記基準信号と規格化信号との位相差である、誤差２乗和が最小となるずれ量（前記基準信号との位相差）を演算して、ジャイロ感度軸が最も地軸方向に近づく角度をθ0 とし、
（ｇ）計測ユニットに取り付けた傾斜センサ５Ａ，５ＢでＸ，Ｙ軸方向の傾斜角度を測定し、測定位置における緯度は既知であるとして、装置主軸の方位角を求めることを特徴とする。
【０００９】
〔３〕上記〔２〕記載の外部情報を得られない環境における装置の方位計測方法において、前記ステップ（ａ）における所定角度は５度程度の比較的荒いステップであることを特徴とする。
【００１０】
〔４〕上記〔２〕記載の外部情報を得られない環境における装置の方位計測方法において、前記ステップ（ａ）における多数回は１０００〜１万回程度であることを特徴とする。
【００１１】
〔５〕外部情報を得られない環境における装置の方位計測方法において、光ファイバージャイロ及び傾斜計を２点間に渡したリンクの上に設置して、方位と重力加速度を基準とする姿勢角を直接的に計測し、位置の計測を行うことを特徴とする。
【００１２】
〔６〕上記〔５〕記載の外部情報を得られない環境における装置の方位計測方法において、前記光ファイバージャイロ及び傾斜計を剛性の高い掘削管本体又は掘削機本体内に設置することを特徴とする。
【発明の効果】
【００１３】
本発明によれば、ジャイロ回転軸が鉛直でなく傾斜している場合において、装置の方位角を的確に計測することができる。
【発明を実施するための最良の形態】
【００１４】
本発明の外部情報を得られない環境における装置の方位計測方法は、鉛直でない軸回りにジャイロを回転させ、地球自転軸の方向を検出する方位計測方法であって、ジャイロ感度変化及びオフセット変化の影響を受けないようにする。
【実施例】
【００１５】
以下、本発明の実施の形態について詳細に説明する。
【００１６】
図１は本発明の実施例を示す計測ユニットの模式図である。
【００１７】
この図において、１はリンク支持機構、２はリンク、２Ｂはリンク後端支持点、３は台、４はジャイロコンパス、５Ａ，５Ｂは傾斜センサー、６は二股状のアーム、７は四角形状のリンク、８Ａはリンク支点、９はピッチ回転軸（ｙ軸）、１０はピッチ回転軸９回りの回転を検出するロータリーエンコーダ、１１はヨー角回転軸（ｚ軸）回りの回転を検出するロータリーエンコーダ、１２はピッチ回転軸受取付部、１３はスリーブ管であり、計測ユニットはスリーブ管１３内を進むことができる。また、リンク支持機構１は、台３のｘ，ｙ軸回りの回転を許容している。
【００１８】
図２は高精度の光ファイバージャイロの座標系を示す図、図３はその光ファイバージャイロで地球の自転軸方向を検出するための説明図である。
【００１９】
これらの図において、２１は回転テーブル、２２はこの回転テーブル２１上に搭載される光ファイバージャイロ、２３はｘ軸（計測器の長手方向）、２４はｙ軸、２５はｚ軸（ジャイロ回転軸）、２６は地軸、２７は光ファイバージャイロ２２の角速度検出軸、２８は鉛直軸である。
【００２０】
本発明の計測方法の実現方法について説明する。
【００２１】
（１）光ファイバージャイロ２２を回転テーブル２１上に配置し、その回転テーブル２１を適当な角度（例えば５度）ごとにｚ軸２５回りに回転させて停止し、光ファイバージャイロ２２の出力を多数回（１０００〜１万回程度）計測して平均を求める。そのときの回転角θと光ファイバージャイロ２２の出力を記録しておく〔図３（ａ）参照〕。
【００２２】
（２）上記を１回転にわたって繰り返し、角度とその位置における平均ジャイロ出力を記録する。
【００２３】
（３）上記（２）で求めた各点の平均ジャイロ出力を１回転にわたって平均し、各点の平均ジャイロ出力から差し引き、さらにこの平均値を差し引いた後の（実効値×√２）で割算して振幅・オフセットを規格化する。
【００２４】
（４）上記データの点間を補間して所要の角度ピッチで規格化信号を作成する〔図３（ａ）参照〕。
【００２５】
（５）計測器基準軸〔図３（ｃ）参照〕を原点とし、所要の角度ピッチで、３６０度で１周期になるコサイン波を基準信号として作成する〔図３（ｂ）参照〕。
【００２６】
（６）基準信号と規格化信号の誤差２乗和を規格化信号をずらしながら計算し、誤差２乗和が最小となるずれ量（基準信号との位相差）を計算し、ジャイロ回転角θ〔後述の式（１０）〕とする〔図３（ｄ）参照〕。
（７）計測ユニットに取り付けた傾斜計（傾斜センサー）５Ａ，５Ｂでｘ，ｙ軸方向の傾斜角度を測定し、測定位置における緯度は既知であるとして、装置主軸の方位角Ψ0 〔後述の式（１２）〕を計算する。
【００２７】
以下、ジャイロ感度誤差の影響を受けない方位測定について詳細に説明する。
【００２８】
〔座標の定義〕
図４は座標の定義を示す図である。
【００２９】
図４に示すように、任意の姿勢をとる計測器（計測装置）の長手軸線をｘ軸、ジャイロ回転軸をｚ軸、それらに直交する軸をｙ軸とする座標系を座標系Ａとする。なお、Ｈは水平面である。
【００３０】
また、鉛直方向をＺ軸、ｘ軸とＺ軸を含む面と水平面Ｈの交線をＸ軸、Ｘ，Ｚ軸に直交する方向をＹ軸とする座標系をＢとする。傾斜センサーで測定したｘ軸方向の傾斜角をａ、ｙ軸方向の傾斜角をｂとする。Ｘ軸を起点とするジャイロのＣＣＷ（反時計方向）回転をθとする。
【００３１】
〔Ａ→Ｂ座標系への変換〕
Ｂ座標系から見たＡ座標系の軸上の単位ベクトルを（ｌ，ｍ，ｎ）とする。定義より、
ｌx ＝ｃｏｓ（ａ），ｌy ＝０，ｌz ＝−ｓｉｎ（ａ） …（１）
ｍz ＝−ｓｉｎ（ｂ） …（２）
【００３２】
ｌx ｍx ＋ｌy ｍy ＋ｌz ｍz ＝０
ｃｏｓ（ａ）・ｍx ＋〔−ｓｉｎ（ａ）・〔−ｓｉｎ（ｂ）〕＝０
ｍx ＝〔ｓｉｎ（ａ）・ｓｉｎ（ｂ）〕／ｃｏｓ（ａ） …（３）
【００３３】
ｍx 2 ＋ｍy 2 ＋ｍz 2 ＝１
ｍy ＝√（１−ｍx 2 −ｍz 2 ） …（４）
【００３４】
Ａ→Ｂの変換は、
【００３５】
【数１】
よって、Ａ→Ｂの変換行列は下記式（７）のようになる。
【００３６】
【数２】
地球自転軸の方向
【００３７】
を満たすΨを求めれば装置主軸から見た真北の角度が分かる。
【００３８】
よって、装置主軸の方向角Ψ0 は下記式（１２）となる。
【００３９】
Ψ0 ＝−Ψ …（１２）
なお、図６において、Ｌは測定位置における緯度である。
【００４０】
また、図７には、回転角度（ロータリーエンコーダによる計測角度）に対するジャイロ出力実測値の特性が示されており、上記ステップ（１）において求められた平均値に基づいている。
【００４１】
図８には、回転角度（ロータリーエンコーダによる計測角度）に対する、計測したジャイロ出力から、平均ジャイロ出力を差し引き、規格化を行った規格化信号が示されており、ここでは、実線は規格化信号、鎖線は基準信号を示している。
【００４２】
図９には、回転角度（ロータリーエンコーダによる計測角度）に対する、基準信号と規格化信号の位相差が示されており、ここでは、点線は規格化信号、鎖線は基準信号、実線は規格化信号が移動した値を示している。
【００４３】
このようにして、地中掘削等の外部情報を得られない環境における装置主軸の方位角を的確に計測することができる。
【００４４】
図１０は本発明の他の実施例を示す計測方式の構成図、図１１はその模式図、図１２はその計測ユニットが管の中心にない場合の模式図である。
【００４５】
つまり、ここでは、光ファイバージャイロ及び傾斜計３３より求められる方位（真北）及び重力加速度から計測ユニットの姿勢角を測定する。
【００４６】
なお、ここでは、スリーブ管３１は剛性の高い掘削管である。
【００４７】
また、図１２に示すように、剛性の高いスリーブ管３１の中心点Ｏからずれた位置に光ファイバージャイロ及び傾斜計３３が位置する場合においても、計測リンク３２はスリーブ管３１に対してロール方向に拘束されているので、計測リンク３２はスリーブ管３１の中心点Ｏまわりのロールとなる。すなわち、
Ｏ＝ｄｍ＋Ｐn となる。
【００４８】
よって、計測リンク３２がスリーブ管３１の中心点Ｏになくても中心位置を計測できる。
【００４９】
なお、本発明は上記実施例に限定されるものではなく、本発明の趣旨に基づき種々の変形が可能であり、これらを本発明の範囲から排除するものではない。
【産業上の利用可能性】
【００５０】
本発明の方位の計測方法は、地中掘削等の外部情報を得られない環境ににおける装置の方位の計測方法に好適である。
【図面の簡単な説明】
【００５１】
【図１】本発明の実施例を示す計測ユニットの模式図である。
【図２】高精度の光ファイバージャイロの座標系を示す図である。
【図３】高精度の光ファイバージャイロで地球の自転軸方向を検出するための説明図である。
【図４】座標の定義を示す図である。
【図５】ベクトルA ＮとベクトルA ｕの関係を示す図である。
【図６】ベクトルB ＮとベクトルB ｕの関係を示す図である。
【図７】回転角度（ロータリーエンコーダによる計測角度）に対するジャイロ出力実測値の特性図である。
【図８】回転角度（ロータリーエンコーダによる計測角度）に対する、計測したジャイロ出力から、平均ジャイロ出力を差し引き、規格化を行った規格化信号を示す図である。
【図９】回転角度（ロータリーエンコーダによる計測角度）に対する、基準信号と規格化信号の位相差を示す図である。
【図１０】本発明の他の実施例を示す計測方式の構成図である。
【図１１】本発明の他の実施例を示す計測方式の模式図である。
【図１２】本発明の他の実施例を示す計測ユニットが管の中心にない場合の模式図である。
【符号の説明】
【００５２】
１ リンク支持機構
２ リンク
２Ｂ リンク後端支持点
３ 台
４ ジャイロコンパス
５Ａ，５Ｂ 傾斜センサー
６ 二股状のアーム
７ 四角形状のリンク
８Ａ リンク支点
９ ピッチ回転軸
１０ ピッチ回転軸回りの回転を検出するロータリーエンコーダ
１１ ヨー角回転軸回りの回転を検出するロータリーエンコーダ
１２ ピッチ回転軸受取付部
１３ スリーブ管
２１ 回転テーブル
２２ 光ファイバージャイロ
２３ ｘ軸
２４ ｙ軸
２５ ｚ軸
２６ 地軸
２７ 角速度検出軸
２８ 鉛直軸
３１ スリーブ管
３２ 計測リンク
３３ 光ファイバージャイロ及び傾斜計
【技術分野】
【０００１】
本発明は、外部情報を得られない環境における装置の方位計測方法に関するものである。
【背景技術】
【０００２】
従来の水平系掘削における位置測定法として、ターゲットが発する電磁波を用いる方法や、レーザ光等の光学的手段を用いてターゲットとの相対角度を測り、位置を算出する方法がある（下記特許文献１，２参照）。
【０００３】
また、推進装置内に搭載したジャイロから得られる角度データ、推進装置の傾きを検知する傾斜計からの角度データ及び推進装置の推進距離を計測する距離計からの距離データを用いて装置の水平位置を演算する際、装置内に設置された位置計測用ターゲット板を用いて推進中の装置の水平変位を測量し、その測量データ及び同時に得られるジャイロの回転角データを用いて、推進装置の推進基線に対する初期角度を演算するようにした地中推進装置の初期角度検知方法及び位置連続検知方法が提案されている（下記特許文献３参照）。
【０００４】
また、本願発明者らは、比較的小さな径を有する管などの水平系の掘削において、地中の水平方向掘削先端位置を、外部環境および作業環境の影響を受けずに的確に測定することができる、水平方向掘削先端位置の測定装置を提案した（下記特許文献４，５参照）。
【特許文献１】特開平１１−０２３２７１号公報
【特許文献２】特開２００２−４８５４３号公報
【特許文献３】特開平１１−１０７６７９号公報
【特許文献４】特願２００４−３５２１２８号
【特許文献５】特願２００４−３５２１２９号
【発明の開示】
【発明が解決しようとする課題】
【０００５】
しかしながら、上記した従来技術では、ジャイロ回転軸が鉛直でなく傾斜している場合には、地球自転軸の方向を検出し、装置の方位角を求めることは困難であった。
【０００６】
本発明は、上記状況に鑑みて、ジャイロ回転軸が鉛直でなく傾斜している場合において、装置の方位角を的確に計測することができる外部情報を得られない環境における装置の方位計測方法を提供することを目的とする。
【課題を解決するための手段】
【０００７】
本発明は、上記目的を達成するために、
〔１〕外部情報を得られない環境における装置の方位計測方法において、鉛直でない軸回りにジャイロを回転させ、地球自転軸の方向を検出する方位計測方法であって、ジャイロ感度変化及びオフセット変化の影響を受けないように装置主軸の方位角を計測することを特徴とする。
【０００８】
〔２〕上記〔１〕記載の外部情報を得られない環境における装置の方位計測方法において、
（ａ）光ファイバージャイロを回転テーブル上に配置し、所定角度（例えば５度毎）に回転して停止し、光ファイバージャイロの出力を多数回（１０００〜１万回程度）計測して平均を求め、そのときのジャイロ回転角θと光ファイバージャイロの平均出力を記録し、
（ｂ）上記（ａ）を１回転にわたって繰り返し、ジャイロ回転角度とその位置における平均ジャイロ出力を記録し、
（ｃ）計測したジャイロ出力値から一回転にわたる平均ジャイロ出力値を差し引き、この平均値を差し引いた後の（実効値×√２）で割算して、振幅・オフセットを規格化し、
（ｄ）前記データの点間を補間して所要の角度ピッチで規格化信号を作成し、
（ｅ）計測ユニットの基準軸を原点とし、所要の角度ピッチでもって、３６０度で１周期になる余弦波を基準信号として作成し、
（ｆ）前記基準信号と前記規格化信号の誤差２乗和を規格化信号をずらしながら演算し、前記基準信号と規格化信号との位相差である、誤差２乗和が最小となるずれ量（前記基準信号との位相差）を演算して、ジャイロ感度軸が最も地軸方向に近づく角度をθ0 とし、
（ｇ）計測ユニットに取り付けた傾斜センサ５Ａ，５ＢでＸ，Ｙ軸方向の傾斜角度を測定し、測定位置における緯度は既知であるとして、装置主軸の方位角を求めることを特徴とする。
【０００９】
〔３〕上記〔２〕記載の外部情報を得られない環境における装置の方位計測方法において、前記ステップ（ａ）における所定角度は５度程度の比較的荒いステップであることを特徴とする。
【００１０】
〔４〕上記〔２〕記載の外部情報を得られない環境における装置の方位計測方法において、前記ステップ（ａ）における多数回は１０００〜１万回程度であることを特徴とする。
【００１１】
〔５〕外部情報を得られない環境における装置の方位計測方法において、光ファイバージャイロ及び傾斜計を２点間に渡したリンクの上に設置して、方位と重力加速度を基準とする姿勢角を直接的に計測し、位置の計測を行うことを特徴とする。
【００１２】
〔６〕上記〔５〕記載の外部情報を得られない環境における装置の方位計測方法において、前記光ファイバージャイロ及び傾斜計を剛性の高い掘削管本体又は掘削機本体内に設置することを特徴とする。
【発明の効果】
【００１３】
本発明によれば、ジャイロ回転軸が鉛直でなく傾斜している場合において、装置の方位角を的確に計測することができる。
【発明を実施するための最良の形態】
【００１４】
本発明の外部情報を得られない環境における装置の方位計測方法は、鉛直でない軸回りにジャイロを回転させ、地球自転軸の方向を検出する方位計測方法であって、ジャイロ感度変化及びオフセット変化の影響を受けないようにする。
【実施例】
【００１５】
以下、本発明の実施の形態について詳細に説明する。
【００１６】
図１は本発明の実施例を示す計測ユニットの模式図である。
【００１７】
この図において、１はリンク支持機構、２はリンク、２Ｂはリンク後端支持点、３は台、４はジャイロコンパス、５Ａ，５Ｂは傾斜センサー、６は二股状のアーム、７は四角形状のリンク、８Ａはリンク支点、９はピッチ回転軸（ｙ軸）、１０はピッチ回転軸９回りの回転を検出するロータリーエンコーダ、１１はヨー角回転軸（ｚ軸）回りの回転を検出するロータリーエンコーダ、１２はピッチ回転軸受取付部、１３はスリーブ管であり、計測ユニットはスリーブ管１３内を進むことができる。また、リンク支持機構１は、台３のｘ，ｙ軸回りの回転を許容している。
【００１８】
図２は高精度の光ファイバージャイロの座標系を示す図、図３はその光ファイバージャイロで地球の自転軸方向を検出するための説明図である。
【００１９】
これらの図において、２１は回転テーブル、２２はこの回転テーブル２１上に搭載される光ファイバージャイロ、２３はｘ軸（計測器の長手方向）、２４はｙ軸、２５はｚ軸（ジャイロ回転軸）、２６は地軸、２７は光ファイバージャイロ２２の角速度検出軸、２８は鉛直軸である。
【００２０】
本発明の計測方法の実現方法について説明する。
【００２１】
（１）光ファイバージャイロ２２を回転テーブル２１上に配置し、その回転テーブル２１を適当な角度（例えば５度）ごとにｚ軸２５回りに回転させて停止し、光ファイバージャイロ２２の出力を多数回（１０００〜１万回程度）計測して平均を求める。そのときの回転角θと光ファイバージャイロ２２の出力を記録しておく〔図３（ａ）参照〕。
【００２２】
（２）上記を１回転にわたって繰り返し、角度とその位置における平均ジャイロ出力を記録する。
【００２３】
（３）上記（２）で求めた各点の平均ジャイロ出力を１回転にわたって平均し、各点の平均ジャイロ出力から差し引き、さらにこの平均値を差し引いた後の（実効値×√２）で割算して振幅・オフセットを規格化する。
【００２４】
（４）上記データの点間を補間して所要の角度ピッチで規格化信号を作成する〔図３（ａ）参照〕。
【００２５】
（５）計測器基準軸〔図３（ｃ）参照〕を原点とし、所要の角度ピッチで、３６０度で１周期になるコサイン波を基準信号として作成する〔図３（ｂ）参照〕。
【００２６】
（６）基準信号と規格化信号の誤差２乗和を規格化信号をずらしながら計算し、誤差２乗和が最小となるずれ量（基準信号との位相差）を計算し、ジャイロ回転角θ〔後述の式（１０）〕とする〔図３（ｄ）参照〕。
（７）計測ユニットに取り付けた傾斜計（傾斜センサー）５Ａ，５Ｂでｘ，ｙ軸方向の傾斜角度を測定し、測定位置における緯度は既知であるとして、装置主軸の方位角Ψ0 〔後述の式（１２）〕を計算する。
【００２７】
以下、ジャイロ感度誤差の影響を受けない方位測定について詳細に説明する。
【００２８】
〔座標の定義〕
図４は座標の定義を示す図である。
【００２９】
図４に示すように、任意の姿勢をとる計測器（計測装置）の長手軸線をｘ軸、ジャイロ回転軸をｚ軸、それらに直交する軸をｙ軸とする座標系を座標系Ａとする。なお、Ｈは水平面である。
【００３０】
また、鉛直方向をＺ軸、ｘ軸とＺ軸を含む面と水平面Ｈの交線をＸ軸、Ｘ，Ｚ軸に直交する方向をＹ軸とする座標系をＢとする。傾斜センサーで測定したｘ軸方向の傾斜角をａ、ｙ軸方向の傾斜角をｂとする。Ｘ軸を起点とするジャイロのＣＣＷ（反時計方向）回転をθとする。
【００３１】
〔Ａ→Ｂ座標系への変換〕
Ｂ座標系から見たＡ座標系の軸上の単位ベクトルを（ｌ，ｍ，ｎ）とする。定義より、
ｌx ＝ｃｏｓ（ａ），ｌy ＝０，ｌz ＝−ｓｉｎ（ａ） …（１）
ｍz ＝−ｓｉｎ（ｂ） …（２）
【００３２】
ｌx ｍx ＋ｌy ｍy ＋ｌz ｍz ＝０
ｃｏｓ（ａ）・ｍx ＋〔−ｓｉｎ（ａ）・〔−ｓｉｎ（ｂ）〕＝０
ｍx ＝〔ｓｉｎ（ａ）・ｓｉｎ（ｂ）〕／ｃｏｓ（ａ） …（３）
【００３３】
ｍx 2 ＋ｍy 2 ＋ｍz 2 ＝１
ｍy ＝√（１−ｍx 2 −ｍz 2 ） …（４）
【００３４】
Ａ→Ｂの変換は、
【００３５】
【数１】
よって、Ａ→Ｂの変換行列は下記式（７）のようになる。
【００３６】
【数２】
地球自転軸の方向
【００３７】
を満たすΨを求めれば装置主軸から見た真北の角度が分かる。
【００３８】
よって、装置主軸の方向角Ψ0 は下記式（１２）となる。
【００３９】
Ψ0 ＝−Ψ …（１２）
なお、図６において、Ｌは測定位置における緯度である。
【００４０】
また、図７には、回転角度（ロータリーエンコーダによる計測角度）に対するジャイロ出力実測値の特性が示されており、上記ステップ（１）において求められた平均値に基づいている。
【００４１】
図８には、回転角度（ロータリーエンコーダによる計測角度）に対する、計測したジャイロ出力から、平均ジャイロ出力を差し引き、規格化を行った規格化信号が示されており、ここでは、実線は規格化信号、鎖線は基準信号を示している。
【００４２】
図９には、回転角度（ロータリーエンコーダによる計測角度）に対する、基準信号と規格化信号の位相差が示されており、ここでは、点線は規格化信号、鎖線は基準信号、実線は規格化信号が移動した値を示している。
【００４３】
このようにして、地中掘削等の外部情報を得られない環境における装置主軸の方位角を的確に計測することができる。
【００４４】
図１０は本発明の他の実施例を示す計測方式の構成図、図１１はその模式図、図１２はその計測ユニットが管の中心にない場合の模式図である。
【００４５】
つまり、ここでは、光ファイバージャイロ及び傾斜計３３より求められる方位（真北）及び重力加速度から計測ユニットの姿勢角を測定する。
【００４６】
なお、ここでは、スリーブ管３１は剛性の高い掘削管である。
【００４７】
また、図１２に示すように、剛性の高いスリーブ管３１の中心点Ｏからずれた位置に光ファイバージャイロ及び傾斜計３３が位置する場合においても、計測リンク３２はスリーブ管３１に対してロール方向に拘束されているので、計測リンク３２はスリーブ管３１の中心点Ｏまわりのロールとなる。すなわち、
Ｏ＝ｄｍ＋Ｐn となる。
【００４８】
よって、計測リンク３２がスリーブ管３１の中心点Ｏになくても中心位置を計測できる。
【００４９】
なお、本発明は上記実施例に限定されるものではなく、本発明の趣旨に基づき種々の変形が可能であり、これらを本発明の範囲から排除するものではない。
【産業上の利用可能性】
【００５０】
本発明の方位の計測方法は、地中掘削等の外部情報を得られない環境ににおける装置の方位の計測方法に好適である。
【図面の簡単な説明】
【００５１】
【図１】本発明の実施例を示す計測ユニットの模式図である。
【図２】高精度の光ファイバージャイロの座標系を示す図である。
【図３】高精度の光ファイバージャイロで地球の自転軸方向を検出するための説明図である。
【図４】座標の定義を示す図である。
【図５】ベクトルA ＮとベクトルA ｕの関係を示す図である。
【図６】ベクトルB ＮとベクトルB ｕの関係を示す図である。
【図７】回転角度（ロータリーエンコーダによる計測角度）に対するジャイロ出力実測値の特性図である。
【図８】回転角度（ロータリーエンコーダによる計測角度）に対する、計測したジャイロ出力から、平均ジャイロ出力を差し引き、規格化を行った規格化信号を示す図である。
【図９】回転角度（ロータリーエンコーダによる計測角度）に対する、基準信号と規格化信号の位相差を示す図である。
【図１０】本発明の他の実施例を示す計測方式の構成図である。
【図１１】本発明の他の実施例を示す計測方式の模式図である。
【図１２】本発明の他の実施例を示す計測ユニットが管の中心にない場合の模式図である。
【符号の説明】
【００５２】
１ リンク支持機構
２ リンク
２Ｂ リンク後端支持点
３ 台
４ ジャイロコンパス
５Ａ，５Ｂ 傾斜センサー
６ 二股状のアーム
７ 四角形状のリンク
８Ａ リンク支点
９ ピッチ回転軸
１０ ピッチ回転軸回りの回転を検出するロータリーエンコーダ
１１ ヨー角回転軸回りの回転を検出するロータリーエンコーダ
１２ ピッチ回転軸受取付部
１３ スリーブ管
２１ 回転テーブル
２２ 光ファイバージャイロ
２３ ｘ軸
２４ ｙ軸
２５ ｚ軸
２６ 地軸
２７ 角速度検出軸
２８ 鉛直軸
３１ スリーブ管
３２ 計測リンク
３３ 光ファイバージャイロ及び傾斜計
【特許請求の範囲】
【請求項１】
鉛直でない軸回りにジャイロを回転させ、地球自転軸の方向を検出する方位計測方法であって、ジャイロ感度変化及びオフセット変化の影響を受けないように装置主軸の方位角を計測することを特徴とする外部情報を得られない環境における装置の方位計測方法。
【請求項２】
請求項１記載の外部情報を得られない環境における装置の方位計測方法において、
（ａ）光ファイバージャイロを回転テーブル上に配置し、所定角度に回転して停止し、光ファイバージャイロの出力を多数回計測して平均を求め、そのときのジャイロ回転角θと光ファイバージャイロの平均出力を記録し、
（ｂ）上記（ａ）を１回転にわたって繰り返し、ジャイロ回転角度とその位置における平均ジャイロ出力を記録し、
（ｃ）計測したジャイロ出力値から一回転にわたる平均ジャイロ出力値を差し引き、該平均値を差し引いた後の（実効値×√２）で割算して振幅・オフセットを規格化し、
（ｄ）前記データの点間を補間して所要の角度ピッチで規格化信号を作成し、
（ｅ）計測ユニットの基準軸を原点とし、所要の角度ピッチで、３６０度で１周期になる余弦波を基準信号として作成し、
（ｆ）前記基準信号と前記規格化信号の誤差２乗和を規格化信号をずらしながら演算し、前記基準信号と規格化信号との位相差である、誤差２乗和が最小となるずれ量を演算して、ジャイロ感度軸が最も地軸方向に近づく角度θO とし、
（ｇ）計測ユニットに取り付けた傾斜センサでＸ，Ｙ軸方向の傾斜角度を測定し、測定位置における緯度は既知であるとして、装置主軸の方位角を求めることを特徴とする外部情報を得られない環境における装置の方位計測方法。
【請求項３】
請求項２記載の外部情報を得られない環境における装置の方位計測方法において、前記ステップ（ａ）における所定角度は５度程度の比較的荒いステップであることを特徴とする外部情報を得られない環境における装置の方位計測方法。
【請求項４】
請求項２記載の外部情報を得られない環境における装置の方位計測方法において、前記ステップ（ａ）における多数回は１０００〜１万回程度であることを特徴とする外部情報を得られない環境における装置の方位計測方法。
【請求項５】
光ファイバージャイロ及び傾斜計を２点間に渡したリンクの上に設置して、真北（方位）と重力加速度を基準とする姿勢角を直接的に計測し、方位の計測を行うことを特徴とする外部情報を得られない環境における装置の方位計測方法。
【請求項６】
請求項５記載の外部情報を得られない環境における装置の方位計測方法において、前記光ファイバージャイロ及び傾斜計を剛性の高い掘削管本体又は掘削機本体内に設置することを特徴とする外部情報を得られない環境における装置の方位計測方法。
【請求項１】
鉛直でない軸回りにジャイロを回転させ、地球自転軸の方向を検出する方位計測方法であって、ジャイロ感度変化及びオフセット変化の影響を受けないように装置主軸の方位角を計測することを特徴とする外部情報を得られない環境における装置の方位計測方法。
【請求項２】
請求項１記載の外部情報を得られない環境における装置の方位計測方法において、
（ａ）光ファイバージャイロを回転テーブル上に配置し、所定角度に回転して停止し、光ファイバージャイロの出力を多数回計測して平均を求め、そのときのジャイロ回転角θと光ファイバージャイロの平均出力を記録し、
（ｂ）上記（ａ）を１回転にわたって繰り返し、ジャイロ回転角度とその位置における平均ジャイロ出力を記録し、
（ｃ）計測したジャイロ出力値から一回転にわたる平均ジャイロ出力値を差し引き、該平均値を差し引いた後の（実効値×√２）で割算して振幅・オフセットを規格化し、
（ｄ）前記データの点間を補間して所要の角度ピッチで規格化信号を作成し、
（ｅ）計測ユニットの基準軸を原点とし、所要の角度ピッチで、３６０度で１周期になる余弦波を基準信号として作成し、
（ｆ）前記基準信号と前記規格化信号の誤差２乗和を規格化信号をずらしながら演算し、前記基準信号と規格化信号との位相差である、誤差２乗和が最小となるずれ量を演算して、ジャイロ感度軸が最も地軸方向に近づく角度θO とし、
（ｇ）計測ユニットに取り付けた傾斜センサでＸ，Ｙ軸方向の傾斜角度を測定し、測定位置における緯度は既知であるとして、装置主軸の方位角を求めることを特徴とする外部情報を得られない環境における装置の方位計測方法。
【請求項３】
請求項２記載の外部情報を得られない環境における装置の方位計測方法において、前記ステップ（ａ）における所定角度は５度程度の比較的荒いステップであることを特徴とする外部情報を得られない環境における装置の方位計測方法。
【請求項４】
請求項２記載の外部情報を得られない環境における装置の方位計測方法において、前記ステップ（ａ）における多数回は１０００〜１万回程度であることを特徴とする外部情報を得られない環境における装置の方位計測方法。
【請求項５】
光ファイバージャイロ及び傾斜計を２点間に渡したリンクの上に設置して、真北（方位）と重力加速度を基準とする姿勢角を直接的に計測し、方位の計測を行うことを特徴とする外部情報を得られない環境における装置の方位計測方法。
【請求項６】
請求項５記載の外部情報を得られない環境における装置の方位計測方法において、前記光ファイバージャイロ及び傾斜計を剛性の高い掘削管本体又は掘削機本体内に設置することを特徴とする外部情報を得られない環境における装置の方位計測方法。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図１２】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図１２】
【公開番号】特開２００７−２６３６８９（Ｐ２００７−２６３６８９Ａ）
【公開日】平成１９年１０月１１日（２００７．１０．１１）
【国際特許分類】
【出願番号】特願２００６−８８０９７（Ｐ２００６−８８０９７）
【出願日】平成１８年３月２８日（２００６．３．２８）
【出願人】（０００１７３７８４）財団法人鉄道総合技術研究所 (1,666)
【出願人】（５００５１９９８７）株式会社ジェイアール総研情報システム (14)
【Ｆターム（参考）】
【公開日】平成１９年１０月１１日（２００７．１０．１１）
【国際特許分類】
【出願日】平成１８年３月２８日（２００６．３．２８）
【出願人】（０００１７３７８４）財団法人鉄道総合技術研究所 (1,666)
【出願人】（５００５１９９８７）株式会社ジェイアール総研情報システム (14)
【Ｆターム（参考）】
[ Back to top ]