JP3152044B2

JP3152044B2 - ハイブリッド傾斜計

Info

Publication number: JP3152044B2
Application number: JP34226093A
Authority: JP
Inventors: 淳平宮崎
Original assignee: Hitachi Cable Ltd
Current assignee: Hitachi Cable Ltd
Priority date: 1993-12-15
Filing date: 1993-12-15
Publication date: 2001-04-03
Anticipated expiration: 2016-04-03
Also published as: JPH07167651A

Description

【発明の詳細な説明】

【０００１】

【産業上の利用分野】本発明は、２種類以上の方式のセ
ンサを組み合わせた傾斜計、特に光ファイバジャイロと
重力加速度を利用した傾斜計によって構成されたハイブ
リッド傾斜計に関するものである。

【０００２】

【従来の技術】物体の傾斜角（ロール角、ピッチ角）を
得るためには、（１）重力加速度の方向を検知すること
によって姿勢を知る方式、（２）回転角速度を積分演算
して基準姿勢からの姿勢方位を得る方式、（３）前述の
２つを組み合わせた方式の３つが知られている。１番目
の重力加速度の方向を検知する方式は、地球の重力が常
に地球中心方向、つまり地球接平面（水平面）において
鉛直下向きを指していることを利用したものであり、セ
ンサ自体は複数軸の加速度計から構成されていると考え
てよい。この方式は地球系に固定された物体の絶対傾斜
角を知る方式として広く利用されているが、重力以外の
加速度が発生する移動体の上では、センサは重力加速度
と他の加速度を区別することができず、他の加速度が加
わっている間は出力に大きな誤差を生じるという問題が
ある。２番目の回転角速度を積分演算する方式、例え
ば、レートジャイロを使用する方式は、動的特性にすぐ
れ、高い周波数成分まで追従することが可能で、移動体
の揺れ防止制御等に好適であるが、相対的な姿勢変位し
か得ることができず、また誤差が時間と共に増大する、
つまり周波数が極めて低い領域で誤差が発散してしまう
という欠点をもっている。３番目の双方を組み合わせた
方式は種々の方法が考えられるが、機械式ジャイロ（レ
ートジャイロ）と加速度計による傾斜計を組み合わせた
バーチカルジャイロの例が広く使用されている。これは
加速度が発生するとジャイロをフリー状態にするという
ことで３番目の方式の一種であると考えられる。昨今で
はこのジャイロと傾斜計とを組み合わせた方式が、移動
体でのロール角、ピッチ角測定の主流となっている。ま
た、レートジャイロ３軸による姿勢角演算と傾斜計を組
み合わせ、種々の条件判断でジャイロの出力する姿勢角
を傾斜計の姿勢角でワンショット的に補正する方法もあ
る。

【０００３】

【発明が解決しようとする課題】従来の方式のうち、最
も広く使用されているバーチカルジャイロでは、（１）
機械式ジャイロのため定期保守が必要、（２）重量寸法
が大きい、（３）衝撃、振動耐久性が低い、（４）起動
静定時間が長い、という問題点があった。またレートジ
ャイロ３軸と傾斜計を使用し、条件判断によるワンショ
ット補正を行うものでは、（１）データに不連続点が発
生する、（２）運動状態の変化に伴う精度の悪化等の問
題があった。本発明は、前記した従来技術の欠点を解消
し、長寿命で、定期保守が不要であり、小型軽量で耐久
性にすぐれ、動的、静的な運動状況の下で精度の良好な
ロール角、ピッチ角が得られるハイブリッド傾斜計を提
供することを目的とする。

【０００４】

【課題を解決するための手段】本発明は、レートジャイ
ロに光ファイバジャイロを用いたことにより、システム
の長寿命化、定期保守の不要化、小型軽量化を実現し、
さらに重力加速度を利用した傾斜計（以下重力傾斜計と
いう）とジャイロの出力の重ね合わせに際し、周波数領
域のクロスオーバー合成法を採用したことによりシステ
ム精度を大幅に改善したものである。ジャイロによる出
力は低周波領域（０Ｈｚ付近）に発散する誤差成分をも
ち、これに対して重力傾斜計は、比較的高い周波数領域
（０．１Ｈｚ程度以上）に大きな誤差成分を含むことが
分かっている。このため０．０１Ｈｚ付近を境にして、
それより低い周波数の領域は重力傾斜計が受け持ち、高
い周波数領域はジャイロが受け持つようにする。周波数
領域でのこの操作を実現するためには、カットオフ周波
数が０．０１Ｈｚ付近の高域通過フィルタ及び低域通過
フィルタを準備しなければならない。アナログ回路では
このような低いカットオフを持つ良好なフィイルタは期
待できないので、時間領域でデータを処理するソフトウ
エア数値フィルタを用いる。低域通過ソフトウエア数値
フィルタは既に一般的に知られており高域通過信号を得
るためには原信号から低域通過信号を差し引くことによ
り得られる。このフィルタ処理を用いて上記の操作を実
現する。

【０００５】

【実施例】本発明の実施例の構成を図１に示す。３軸光
ファイバジャイロ１は慣性系における物体の角速度を検
出する。重力傾斜計２は物体に作用している加速度を重
力加速度とみなして水平面からのロール角、ピッチ角を
検出する。これらの検出された値は信号処理部３に送ら
れ、ジャイロよりの情報は必要に応じて姿勢角演算が行
われ、ジャイロによる姿勢角が算出される。次に重力傾
斜計による姿勢角、ジャイロによる姿勢角のデータはそ
れぞれ高域通過処理、低域通過処理が施された上で合成
され、システムのロール角、ピッチ角として出力され
る。信号処理部における信号処理の原理を図２により説
明する。先ず、センサへの入力が周波数分布図ａに示す
ようにあらゆる周波数帯域にわたって平坦な信号つまり
白色雑音的なものであったとする。このとき、ジャイロ
より得られる姿勢角は出力周波数分布図ｂのように低域
の０Ｈｚ付近に無限大に発散する誤差を持っている。ま
た重力傾斜計により得られる姿勢角は、出力周波数分布
図ｃのように高い周波数領域で大きな誤差が発生する。
そこでジャイロの出力を、カットオフ周波数ｆcr［Ｈ
ｚ］で高域通過処理すると濾波後の出力周波数分布図ｄ
に示すように低周波領域の誤差成分が除去される。また
重力傾斜計の出力を同一のカットオフ周波数ｆcr［Ｈ
ｚ］で低域通過処理すると濾波後の重力傾斜計出力の周
波数分布図ｅに示すような出力が得られる。濾波によっ
て得られたこの２つの出力を合成すると出力周波数分布
図ｆに示すような、システムの応答周波数限界をカット
オフとするフラットな周波数特性が得られる。なお、こ
のときのフィルタ処理は、サンプルされたデータをソフ
トウエアで数値的に処理する。使用する光ファイバジャ
イロは３軸のみならず１軸あるいは２軸のものであって
もよい。重力傾斜計についても１軸、２軸あるいは３軸
のものでもよい。

【０００６】ここで、本発明に使用されるソフトウエア
数値フィルタについてより詳細に説明する。クロスオー
バ周波数（ローパスフィルタとハイパスフィルタの出力
を合成するときの境目となる周波数であり、前記説明で
使用したカットオフ周波数と等しい。）をｆcr［Ｈｚ］
とし、サンプリングインターバルをＴs ［ｓ］とする。
さらに、データ系列：Ｘi （ｉ＝１，２，・・・，
ｎ，・・＜∞）を仮定する。また、時間軸ローパスフィルタ処理関数をＬＰi （（Ｘ₁ ，Ｘ₂ ，・・Ｘi ），ｆcr, Ｔs ）時間軸ハイパスフィルタ処理関数をＨＰi （（Ｘ₁ ，Ｘ₂ ，・・Ｘi ），ｆcr, Ｔs ）と定義すると、実時間での原信号Ｘｉは以下のように表
される。Ｘｉ＝ＬＰi （（Ｘ₁ ，Ｘ₂ ，・・Ｘi ），ｆcr, Ｔs ）＋ＨＰi （（Ｘ₁ ，Ｘ₂ ，・・Ｘi ），ｆcr, Ｔs ） …（１）なお、ローパスフィルタの処理方法としては、（１）移
動加算平均、（２）１次フィルタ、（３）２次フィルタ
などの方法が知られている。具体的なアルゴリズムにつ
いては後述する。（１）式より、ソフトウエア上でハイ
パスフィルタ処理を行うためには、以下のような処理を
行えば良い。ＨＰi （（Ｘ₁ ，Ｘ₂ ，・・Ｘi ），ｆcr, Ｔs ）＝ＬＰi （（Ｘ₁ ，Ｘ₂ ，・・Ｘi ），ｆcr, Ｔs ）−Ｘi …（２）ここで２つのデータ系列のクロスオーバ合成を考える。傾斜計データ系列：ａi （ｉ＝１，２，・・，ｎ，・
・＜∞）ジャイロデータ系列：ｂi （ｉ＝１，２，・・，ｎ，・
・＜∞）合成データ系列：ｃi （ｉ＝１，２，・・，ｎ，・
・＜∞）を仮定する。この時、合成データ系列は、以下の式で与
えられる。ｃi ＝ＬＰi （（ａ₁ ，ａ₂ ，・・ａｉ），ｆcr, Ｔs ）＋ｂi −ＬＰi （（ｂ₁ ，ｂ₂ ，・・ｂi ），ｆcr, Ｔs ）…（３）次に、各ローパスフィルタの処理方法に応じた具体的な
アルゴリズムを示す。（１）移動算術平均フィルタを使用する場合、一般に、

【０００７】

【数１】本発明では、以下のようにアルゴリズムを使用する。

【０００８】

【数２】（２）一次フィルタを使用する場合、一般に

【０００９】

【数３】とすると、ＬＰi （（Ｘ₁ ，Ｘ₂ ，・・Ｘi ），ｆcr, Ｔs ）＝ＰＸi ＋ＬＰi_-1 （（Ｘ₁ ，Ｘ₂ ，・・Ｘi-₁ ），ｆcr, Ｔs ） …（８）ｃi ＝Ｐａi ＋ＱＬＰi_-1 （（ａ₁ ，ａ₂ ，・・，ａi_-1 ），ｆcr，Ｔs ）＋ｂi −｛Ｐｂi ＋ＱＬＰi_-1 （（ａ₁ ，ａ₂ ，・・，ａi_-1 ），ｆcr，Ｔs ｝ …（９）本発明では以下のアルゴリズムを使用する。ｉ＝１のときａi ´＝ａi ，ｂi ´＝ｂi ，ｃi ＝ａi ´＋（ｂi −ｂi ´） …(10) ｉ＞１のときａi ´＝Ｐａi ＋Ｑａi_-1 ´，ｂi ´＝Ｐｂi ＋Ｑｂi_-1 ´，ｃi ＝ａi ´＋（ｂi −ｂi ´） …(11) （３）二次フィルタを使用する場合

【００１０】

【数４】とすると、ＬＰi （（Ｘ₁ ，Ｘ₂ ，・・Ｘi ），ｆcr, Ｔs ）＝Ｐ｛ＬＰi-₁ （（Ｘ₁ ，Ｘ₂ ，・・Ｘi-₁ ），ｆcr, Ｔs ） −ＬＰi-₂ （（Ｘ₁ ，Ｘ₂ ，・・Ｘi-₂ ），ｆcr, Ｔs ）｝＋Ｑ｛Ｘi −ＬＰi-₂ （（Ｘ₁ ，Ｘ₂ ，・・Ｘi-₂ ），ｆcr, Ｔs ）｝＋ＬＰi-₂ （（Ｘ₁ ，Ｘ₂ ，・・Ｘi-₂ ），ｆcr, Ｔs ） …(12) 本発明では以下のアルゴリズムを使用する。ｉ＝１のときａi ´＝ａi ，ｂi ´＝ｂi ，ｃi ＝ａi ´＋（ｂi −ｂi ´） …(13) ｉ＝２のときａi ´＝Ｐａi ＋Ｑａi_-1 ´，ｂi ´＝Ｐｂi ＋Ｑｂi_-1 ´，ｃi ＝ａi ´＋（ｂi −ｂi ´） …(14) ｉ＞２のときａi ´＝Ｐ（ａi_-1 ´−ａi_-2 ´）＋Ｑ（ａi −ａi_-2 ´）＋ａi_-2 ´ ｂi ´＝Ｐ（ｂi_-1 ´−ｂi_-2 ´）＋Ｑ（ｂi −ｂi_-2 ´）＋ｂi_-2 ´ ｃi ＝ａi ´＋（ｂi −ｂi ´） …(15)

【００１１】

【発明の効果】本発明はレートジャイロに光ファイバジ
ャイロを使用するため、耐久性に優れ、メンテナンスが
不要、センサ部の重量寸法が小さい、電源投入後すぐに
使用開始ができるという利点を持つ。また、動的、静的
な運動状況の下で精度の良いロール角、ピッチ角が得ら
れると共に、信号処理部で使用するフィルタがソフトウ
エアで行われるため、カットオフ周波数やゲインの変
動、フィルタ特性のばらつきがない安定な動作が得ら
れ、結果としてシステムの安定度が高められる。

【図面の簡単な説明】

【図１】本発明の一実施例のハイブリッド傾斜計の構成
図。

【図２】本発明による検出信号処理の原理を説明する
図。（ａ）入力信号の周波数分布図（ｂ）ジャイロ出力信号の周波数分布図（ｃ）重力傾斜計出力信号の周波数分布図（ｄ）濾波後のジャイロ出力信号の周波数分布図（ｅ）濾波後の重力傾斜計出力信号の周波数分布図（ｆ）濾波後に合成した出力信号の周波数分布図

【符号の説明】

１３軸光ファイバジャイロ２重力傾斜計３信号処理部

Claims

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

【請求項１】光ファイバジャイロと重力加速度を利用
した傾斜計とを備え、地球接平面に対するロール角また
はピッチ角あるいは両方の傾斜角を測定するハイブリッ
ド傾斜計において、ソフトウエア数値フィルタによっ
て、光ファイバジャイロより得られる角度データについ
ては高域周波数のデータのみ通過処理し、前記傾斜計よ
り得られる角度データについては低域周波数のデータの
み通過処理し、実時間領域で双方のデータを合成し角度
出力とする信号処理部を接続したことを特徴とするハイ
ブリッド傾斜計。