JP6613236B2 - 高精度な光ファイバジャイロ慣性測量装置の標定方法 - Google Patents
高精度な光ファイバジャイロ慣性測量装置の標定方法 Download PDFInfo
- Publication number
- JP6613236B2 JP6613236B2 JP2016542745A JP2016542745A JP6613236B2 JP 6613236 B2 JP6613236 B2 JP 6613236B2 JP 2016542745 A JP2016542745 A JP 2016542745A JP 2016542745 A JP2016542745 A JP 2016542745A JP 6613236 B2 JP6613236 B2 JP 6613236B2
- Authority
- JP
- Japan
- Prior art keywords
- error
- optical fiber
- navigation
- accelerometer
- coordinate system
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims description 59
- 239000013307 optical fiber Substances 0.000 title claims description 24
- 230000008569 process Effects 0.000 claims description 33
- 230000003068 static effect Effects 0.000 claims description 17
- 230000008878 coupling Effects 0.000 claims description 8
- 238000010168 coupling process Methods 0.000 claims description 8
- 238000005859 coupling reaction Methods 0.000 claims description 8
- 230000000694 effects Effects 0.000 claims description 5
- 238000004364 calculation method Methods 0.000 claims description 4
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims description 3
- 239000000835 fiber Substances 0.000 description 10
- 230000008901 benefit Effects 0.000 description 4
- 238000012360 testing method Methods 0.000 description 4
- 239000007787 solid Substances 0.000 description 3
- 238000010998 test method Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 238000010276 construction Methods 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000035939 shock Effects 0.000 description 1
- 238000011425 standardization method Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/183—Compensation of inertial measurements, e.g. for temperature effects
- G01C21/188—Compensation of inertial measurements, e.g. for temperature effects for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/36—Guiding or controlling apparatus, e.g. for attitude control using sensors, e.g. sun-sensors, horizon sensors
- B64G1/369—Guiding or controlling apparatus, e.g. for attitude control using sensors, e.g. sun-sensors, horizon sensors using gyroscopes as attitude sensors
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Aviation & Aerospace Engineering (AREA)
- Gyroscopes (AREA)
- Navigation (AREA)
Description
本発明は、光ファイバジャイロ慣性測量装置分野に関し、特に、高精度な光ファイバジャイロ慣性測量装置の標定方法に関する。
衛星は、先端技術発展の代表として、我が国の国防と経済建設において極めて重要な役割を果たしている。姿勢を決める精度は、衛星が情報を安定で有効的に取得する前提であり、衛星姿勢制御システムは、衛星姿勢精度を保障するための重要なシステムの一つであり、そして、慣性素子は、衛星姿勢制御システム中の極めて重要なセンサーであり、直接に姿勢制御システムの精度と性能に影響する。
光ファイバジャイロスコープは、全固体の慣性メーターであり、伝統電気機械メーターが持たない利点を有する。光ファイバジャイロスコープは、光学素子と電子素子で構成される閉ループシステムであり、二束の光の位相差を検出することで、自身の角速度を確定し、そのため、構造的には、光ファイバジャイロスコープは、完全に固体化のジャイロスコープであり、運動部品が全然ない。光ファイバジャイロスコープは、その原理と構造での利点を持つので、多くの応用分野において明確な優位性があり、特に、製品の信頼性と寿命の要求が厳しい宇宙機に対して、その主な特徴は、次にいくつの場面に表現される。（１）全固体：光ファイバジャイロスコープの部品は、すべて固体であり、抗真空、防振、及び耐衝撃の特性があり、（２）長寿命：光ファイバジャイロスコープに用いられる重要な光学素子は、全て１５年宇宙応用の長寿命要求を満足することができ、（３）高信頼性：光ファイバジャイロスコープは、構造設計が自由であり、生産プロセスが比較的に簡単であり、回路の冗長設計を便宜に行い、又は、冗長ジャイロスコープを用いて慣性測量システムを構成し、それによりシステムの信頼性を向上する。
従来、光ファイバジャイロ慣性測量装置に対する標定技術において、異なる試験項目を通して単独に取得し、その中に、零バイアスは、複数の位置で平均値を求めることで得られるものであり、スケール因数は、正負方向に複数の角速度で回転してフィッティングして得られるものであり、取付誤差は、正負方向にフルサークルに大きな角速度で回転して得られるものである。このような標定過程は、複数回の通電/停電操作が不可避的に生じ、且つ基準が一致しない問題が存在し、大量なヒューマンエラーが標定結果に導入されてしまう。また、上記の標定過程にかかる時間は、長く、標定時間は、数時間続く。従来の標定方法は、いずれもスタティック（スタティック位置とターンテーブルの等速運動を含み）な作業環境においてパラメータを計算するものであり、ダイナミック過程中メーターの誤差を考えていない。
本発明の解決しようとする技術問題は、快速で精確な高精度光ファイバジャイロ慣性測量装置の標定方法を提供し、従来技術に存在する問題としての、ヒューマンエラーが大きい問題と、過程時間が長い問題とを克服する。
本発明の技術方案は、
高精度光ファイバジャイロ慣性測量装置の標定方法であり、
光ファイバジャイロ慣性測量装置を、oi軸(i=X,Y,Z)の三つの軸のそれぞれに、正方向に９０°、１８０°、２７０°三回回転し、再び逆方向に９０°、１８０°、２７０°三回回転して初期位置に戻し、まとめて１８回の位置回転を行うステップＳ1と、
１８回の位置回転に初期位置を加えてまとめて１９つの位置になり、前記光ファイバジャイロ慣性測量装置本体座標系をｂとし、ジャイロスコープと加速度計の誤差モデル関係は、
であり、
その中に、
は、三つのジャイロスコープの測量誤差であり、
は、ジャイロスコープの零バイアスであり、
は、ジャイロスコープの結合係数であり、
は、ジャイロスコープの出力値であり、
は、三つの加速度計の測量誤差であり、
は、加速度計の零バイアスであり、
は、加速度計の結合係数であり、
は、加速度計の出力値であるステップＳ２と、
を含む。
高精度光ファイバジャイロ慣性測量装置の標定方法であり、
光ファイバジャイロ慣性測量装置を、oi軸(i=X,Y,Z)の三つの軸のそれぞれに、正方向に９０°、１８０°、２７０°三回回転し、再び逆方向に９０°、１８０°、２７０°三回回転して初期位置に戻し、まとめて１８回の位置回転を行うステップＳ1と、
１８回の位置回転に初期位置を加えてまとめて１９つの位置になり、前記光ファイバジャイロ慣性測量装置本体座標系をｂとし、ジャイロスコープと加速度計の誤差モデル関係は、
その中に、
を含む。
さらに、
ナビゲーション座標系をｎとし、簡略化した速度誤差方程式と姿勢誤差方程式は、
であり、
は、三つの軸の加速度誤差であり、
は、三つの軸の姿勢角速度誤差であり、
は、三つの軸の姿勢誤差であり、
は、ナビゲーション座標系ｎにおける加速度計の出力であり、
は、ナビゲーション座標系での対地速度成分であり、
は、ナビゲーション座標系ｎにおける加速度計の測量誤差であり、
は、ナビゲーション座標系ｎにおけるジャイロスコープの測量誤差であるステップＳ３と、
を含む。
ナビゲーション座標系をｎとし、簡略化した速度誤差方程式と姿勢誤差方程式は、
を含む。
さらに、初期アライメント過程と、位置回転過程と、スタティックナビゲーション過程との、三つの過程計算を含み、なお、
初期アライメント過程：前記光ファイバジャイロ慣性測量装置が第０の位置（初期位置）において初期アライメントを行って得られる姿勢変換
は、
であり、
第ｍの位置で、ナビゲーション座標系における加速度計の測量誤差は、
であれば、速度誤差は、
のように計算され、
初期アライメント過程に、
であり、つまり、
であれば、
第ｍの位置でφの誤差角初値φｘ０、φｙ０、及びφｚ０を計算することができ、
位置回転過程：前記光ファイバジャイロ慣性測量装置が第ｍの位置で初期アライメント完成時点をｔ０と表記し、ある軸oi軸(i=X,Y,Z)に回って第（ｍ+１）位置まで回転し、回転角速度は、
であり、回転の角度は、９０°であり、回転完成時点は、ｔｂであり、ジャイロスコープの定値ドリフトと
による影響を無視すれば、生じた姿勢誤差角
は、
に近似され、その中に、
の結果は、
のように示され、（ｔ０，ｔｂ）時間内に、生じた姿勢角度誤差は、
であり、
スタティックナビゲーション過程：位置回転過程において第（ｍ+１）位置まで回転した後に、回転完成時点は、ｔｂであり、スタティックナビゲーションが開始し、ナビゲーション終了時点は、ｔｅであり、
システム標定誤差方程式に対して、（ｔｂ，ｔｅ）時間帯を積分して、この時間帯内の速度誤差δＶｎと姿勢角φは、
のように取得され、
スタティックナビゲーション過程中速度誤差方程式を、
のような形に書き、その中に、
は、ｔｂ時点速度誤差値であり、
は、三軸速度積分後の誤差量を示し、
は、それぞれ三つの方向速度誤差一次項係数と二次項係数であり、
スタティックナビゲーション過程中姿勢誤差方程式を、
のような形に書き、その中に、
であり、
uは、姿勢誤差方程式一次項係数を示す。
初期アライメント過程：前記光ファイバジャイロ慣性測量装置が第０の位置（初期位置）において初期アライメントを行って得られる姿勢変換
第ｍの位置で、ナビゲーション座標系における加速度計の測量誤差は、
初期アライメント過程に、
第ｍの位置でφの誤差角初値φｘ０、φｙ０、及びφｚ０を計算することができ、
位置回転過程：前記光ファイバジャイロ慣性測量装置が第ｍの位置で初期アライメント完成時点をｔ０と表記し、ある軸oi軸(i=X,Y,Z)に回って第（ｍ+１）位置まで回転し、回転角速度は、
スタティックナビゲーション過程：位置回転過程において第（ｍ+１）位置まで回転した後に、回転完成時点は、ｔｂであり、スタティックナビゲーションが開始し、ナビゲーション終了時点は、ｔｅであり、
システム標定誤差方程式に対して、（ｔｂ，ｔｅ）時間帯を積分して、この時間帯内の速度誤差δＶｎと姿勢角φは、
スタティックナビゲーション過程中速度誤差方程式を、
スタティックナビゲーション過程中姿勢誤差方程式を、
uは、姿勢誤差方程式一次項係数を示す。
さらに、最小二乗法を用いて、Mxx、Myy、Mzz、Mxy、Mxz、Myx、Myz、Mzx、Mzy、Dx、Dy、Dz、Kxx、Kyy、Kzz、Kyx、Kzx、Kzy、Bx、By、Bzの総計２１つのパラメータを識別する。
さらに、
の測量方程式は、
のように建立され、その中に、
状態ベクトルＸｉは、最小二乗法を用いて推定され、
のように計算される。
本発明は、従来技術と比べて、次の利点を有する。
（１）同じ基準条件において、通電/停電を繰り返す必要がなく、ただ光ファイバジャイロ慣性測量装置を一定の順序に従って回転すれば、パラメータの識別が完成することができ、通電を繰り返すことと、標定過程基準の不一致による影響とを避ける。
（２）本方法は、スタティックとダイナミック作業環境におけるメーターの誤差を十分に引き出し、且つパラメータ推定方法を用いて最適推定を行って、システムレベルの最適を実現する。
（３）他種の光ファイバジャイロ慣性測量装置の試験方法と比べて、この方法は、快速な標定方法であり、簡単で実行し易く、全標定過程は、半時間に過ぎなく、標定効率を向上し、人的・物的資源を節約する。
（４）他種の光ファイバジャイロ慣性測量装置の試験方法と比べて、この方法は、スケール因数と取付誤差を区別する必要がなく、取付誤差の計算による少量の計算誤差を避ける。
（１）同じ基準条件において、通電/停電を繰り返す必要がなく、ただ光ファイバジャイロ慣性測量装置を一定の順序に従って回転すれば、パラメータの識別が完成することができ、通電を繰り返すことと、標定過程基準の不一致による影響とを避ける。
（２）本方法は、スタティックとダイナミック作業環境におけるメーターの誤差を十分に引き出し、且つパラメータ推定方法を用いて最適推定を行って、システムレベルの最適を実現する。
（３）他種の光ファイバジャイロ慣性測量装置の試験方法と比べて、この方法は、快速な標定方法であり、簡単で実行し易く、全標定過程は、半時間に過ぎなく、標定効率を向上し、人的・物的資源を節約する。
（４）他種の光ファイバジャイロ慣性測量装置の試験方法と比べて、この方法は、スケール因数と取付誤差を区別する必要がなく、取付誤差の計算による少量の計算誤差を避ける。
従来技術の問題に対して、本発明は、高精度光ファイバジャイロ慣性測量装置の標定方法を提供し、この方法は、プロセス用機器を交換する必要がなく、且つ、同一作業環境において行われ、基準面の一致性を保障し、一つのみの試験項目を完成し、試験操作が簡単であり、この標定方法の試験時間は、短くてただ半時間程度がかかる。この方法は、スタティックとダイナミック作業環境におけるメーターの誤差を十分に引き出し、且つパラメータ推定方法を用いて最適推定を行い、他種の光ファイバジャイロ慣性測量装置の試験方法と比べて、この方法は、簡単で実行し易く、標定効率を向上し、人的・物的資源を節約する。
本発明の技術方案では、
高精度光ファイバジャイロ慣性測量装置を六面体プロセス用機器に入れ、その中に、Ｘ軸、Ｙ軸、Ｚ軸を、oi軸(i=X,Y,Z)の三つの軸のそれぞれに、正方向に９０°、１８０°、２７０°三回回転し、再び逆方向に９０°、１８０°、２７０°三回回転して初期位置に戻し、まとめて１８回の位置回転を行い、初期位置を加えて１９つの位置を含む。例えば、北天東、天南東、南地東、地北東、南地東、天南東、北天東、北西天、天西南、南西地、地西北、南西地、天西南、北西天、北地西、北東地、北地西、北西天、北天東の総計１９つの位置を取って、標定を行う。
高精度光ファイバジャイロ慣性測量装置を六面体プロセス用機器に入れ、その中に、Ｘ軸、Ｙ軸、Ｚ軸を、oi軸(i=X,Y,Z)の三つの軸のそれぞれに、正方向に９０°、１８０°、２７０°三回回転し、再び逆方向に９０°、１８０°、２７０°三回回転して初期位置に戻し、まとめて１８回の位置回転を行い、初期位置を加えて１９つの位置を含む。例えば、北天東、天南東、南地東、地北東、南地東、天南東、北天東、北西天、天西南、南西地、地西北、南西地、天西南、北西天、北地西、北東地、北地西、北西天、北天東の総計１９つの位置を取って、標定を行う。
上記の１９つの位置の間の関係に従って、各位置でのナビゲーション誤差方程式を使えば、ジャイロスコープと加速度計のスケール因数、結合誤差、及び零位などのパラメータを取得することができる。
具体的な実施の形態の一つは、次のように示される。
図１に示すように、光ファイバジャイロ慣性測量装置（慣性測量装置）標定方法は、次のステップを含む。
（１）高精度光ファイバジャイロ慣性測量装置のＸ軸、Ｙ軸、Ｚ軸を、oi軸(i=X,Y,Z)の三つの軸のそれぞれに、正方向に９０°、１８０°、２７０°回転し、再び逆方向に９０°、１８０°、２７０°回転して初期位置に戻し、１８回の位置回転を行い、まとめて１９つの位置を含む。例えば、北天東、天南東、南地東、地北東、南地東、天南東、北天東、北西天、天西南、南西地、地西北、南西地、天西南、北西天、北地西、北東地、北地西、北西天、北天東の総計１９つの位置を取って、標定を行う。
（２）高精度光ファイバジャイロ慣性測量装置の本体座標系をbとし、ジャイロスコープと加速度計の誤差モデル関係は、
のように建立され、
その中に、
は、三つのジャイロスコープの測量誤差であり、
は、ジャイロスコープの零バイアスであり、
は、ジャイロスコープの結合係数であり、
は、ジャイロスコープの出力値であり、
は、三つの加速度計の測量誤差であり、
は、加速度計の零バイアスであり、
は、加速度計の結合係数であり、
は、加速度計の出力値である。
ナビゲーション座標系をｎとし、速度誤差方程式と姿勢誤差方程式は、
のように建立され、標定過程において
であることを考えると、
であることが分かり、関連加速度
の影響を無視して、上記の方程式は、
のように簡略化され、
その中に、
は、三つの軸の速度誤差であり、
は、三つの軸の姿勢誤差であり、
は、ナビゲーション座標系ｎにおける加速度計の出力であり、
は、ナビゲーション座標系での対地速度成分の投影値であり、
は、ナビゲーション座標系ｎにおける加速度計の測量誤差であり、
は、ナビゲーション座標系ｎにおけるジャイロスコープの測量誤差である。
その中に、
ナビゲーション座標系をｎとし、速度誤差方程式と姿勢誤差方程式は、
その中に、
（３）光ファイバジャイロ慣性測量装置が第０の位置（初期位置）で初期アライメントを行って得られる姿勢変換
は、
であり、第ｍの位置で、ナビゲーション座標系での加速度計の測量誤差は、
であり、
上記の式において
は、第ｍの相対初期位置の姿勢変換行列を示し、
速度誤差は、
のように計算され、初期アライメント過程に、
であれば、第ｍの位置での水平姿勢誤差角初値φｘ０とφｚ０を計算することができる。
上記の式において
速度誤差は、
（４）高精度光ファイバジャイロ慣性測量装置が第ｍ（１≦ｍ≦１８）の位置で初期アライメント完成時点をｔ０と表記し、あるoi軸(i=X,Y,Z)に回って第（ｍ+１）位置まで回転し、回転角速度は、
であり、回転の角度は、９０°であり、回転完成時点は、ｔｂであり、回転過程時間が短くて高精度ジャイロスコープの定値ドリフトが小さい（一般、１０-３°/ｈのレベル）ことを考えて、ジャイロスコープの定値ドリフトと
による影響を無視すれば、生じた姿勢誤差角
は、
に近似され、上記の式において、
は、慣性座標系に対する地球自転角速度の成分を示すものであり、
は、慣性座標系に対して、ナビゲーション座標系におけるジャイロスコープ本体座標系の測量誤差であり、
は、第ｍの位置でのジャイロスコープの測量誤差を示すものである。その中に、
の結果は、
のように示され、
（ｔ０，ｔｂ）時間内に、生じた姿勢角度誤差は、
である。
（ｔ０，ｔｂ）時間内に、生じた姿勢角度誤差は、
（５）ステップ（４）において第（ｍ＋１）位置に回転した後に、回転完成時点は、ｔｂであり、スタティックナビゲーションが開始し、ナビゲーション終了時点は、ｔｅであり、システム標定誤差方程式に対して、（ｔｂ，ｔｅ）時間帯を積分して、この時間帯内の速度誤差
と姿勢誤差
は、
のように得られ、スタティックナビゲーション過程中速度誤差方程式を
のような形に書き、
その中に、
は、ｔｂ時点速度誤差値であり、
は、三軸速度積分後の誤差量を示し、
は、それぞれ三つの方向速度誤差一次項係数と二次項係数である。
スタティックナビゲーション過程中姿勢誤差方程式を、
のような形に書き、その中に、
であり、
ｕは、上記の方程式一次項誤差パラメータのみを示すものである。
の測量方程式は、
のように建立され、その中に、
状態ベクトルＸｉは、最小二乗法を用いて推定され、
のように計算される。
その中に、
スタティックナビゲーション過程中姿勢誤差方程式を、
ｕは、上記の方程式一次項誤差パラメータのみを示すものである。
（６）１８回の位置回転過程において、ステップ（５）で
相関方程式が得られ、まとめて１８つの方程式のセット、９０つの方程式が得られ、メーターに関する誤差パラメータのすべての測量方程式は、次のように建立される。
、状態ベクトルＸは、最小二乗法を利用して推定され、
のように計算される。
次に、表１は、本発明１９つの位置の詳細を示す。
次に、表１は、本発明１９つの位置の詳細を示す。
Claims (1)
- 高精度光ファイバジャイロ慣性測量装置の標定方法であり、
光ファイバジャイロ慣性測量装置を、oi軸(i=X,Y,Z)の三つの軸のそれぞれに、正方向に９０°、１８０°、２７０°三回回転して、再び逆方向に９０°、１８０°、２７０°三回回転して初期位置に戻し、まとめて１８回の位置回転を行うステップＳ１と、
１８回の位置回転に初期位置を加えて１９つの位置から得られたパラメータを、前記光ファイバジャイロ慣性測量装置本体座標系をｂとし、ジャイロスコープと加速度計の誤差モデル関係式が、
のように立てられ、
その中に、
は、三つのジャイロスコープの測量誤差であり、
は、ジャイロスコープの零バイアスであり、
は、ジャイロスコープの結合係数であり、
は、ジャイロスコープの出力値であり、
は、三つの加速度計の測量誤差であり、
は、加速度計の零バイアスであり、
は、加速度計の結合係数であり、
は、加速度計の出力値である、ステップＳ２と、
ナビゲーション座標系をｎとし、簡略化した速度誤差方程式と姿勢誤差方程式が、
のように立てられ、
その中に、
は、三つの軸の速度誤差であり、
は、三つの軸の姿勢誤差角であり、
は、三つの軸の姿勢誤差であり、
は、ナビゲーション座標系ｎにおける加速度計の出力であり、
は、ナビゲーション座標系における対地速度成分の投影値であり、
は、ナビゲーション座標系ｎにおける加速度計の測量誤差であり、
は、ナビゲーション座標系ｎにおけるジャイロスコープの測量誤差であるステップＳ３と、
初期アライメント過程と、位置回転過程と、スタティックナビゲーション過程との、三つの過程計算を含み、なお、
初期アライメント過程：前記光ファイバジャイロ慣性測量装置が第０の位置（初期位置）において初期アライメントを行って得られる姿勢変換
は、
であり、
第ｍの位置で、ナビゲーション座標系における加速度計の測量誤差は、
であれば、
速度誤差は、
のように計算され、
初期アライメント過程に、
であり、つまり、
であれば、
第ｍの位置でφの誤差角初値φｘ０、φｙ０、及びφｚ０を計算することができ、
位置回転過程：前記光ファイバジャイロ慣性測量装置が第ｍの位置で初期アライメント完成時点をｔ０と表記し、ある軸oi(i=X,Y,Z)を回って第（ｍ＋１）位置まで回転し、回転角速度は、
であり、回転の角度は、９０°であり、回転完成時点は、ｔｂであり、ジャイロスコープの定値ドリフトと
による影響を無視すれば、生じた姿勢誤差角
は、
に近似され、その中に、
の結果は、
のように示され、
（ｔ０，ｔｂ）時間内に、生じた姿勢角度誤差は、
であり、
スタティックナビゲーション過程：位置回転過程において第（ｍ＋１）位置まで回転した後に、回転完成時点は、ｔｂであり、スタティックナビゲーションが開始し、ナビゲーション終了時点は、ｔｅであり、
システム標定誤差方程式に対して、（ｔｂ，ｔｅ）時間帯を積分して、この時間帯内の速度誤差δＶｎと姿勢角φは、
のように取得され、スタティックナビゲーション過程中速度誤差方程式を、
のような形に書き、その中に、
は、ｔｂ時点速度誤差値であり、
は、三軸速度積分後の誤差量を示し、
は、それぞれ三つの方向速度誤差一次項係数と二次項係数であり、
スタティックナビゲーション過程中姿勢誤差方程式を、
のような形に書き、その中に、
、ｕは、姿勢誤差方程式一次項係数を示され、
最小二乗法を用いて、Mxx、Myy、Mzz、Mxy、Mxz、Myx、Myz、Mzx、Mzy、Dx、Dy、Dz、Kxx、Kyy、Kzz、Kyx、Kzx、Kzy、Bx、By、Bzの総計２１つのパラメータを識別し、
の測量方程式は、
のように立てられ、その中に、
状態ベクトルＸｉは、最小二乗法を用いて推定され、
のように計算され、
スケール因子、結合係数、零バイアスが出力されることを特徴とする高精度光ファイバジャイロ慣性測量装置の標定方法。
Applications Claiming Priority (3)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510024279.1 | 2015-01-16 | ||
| CN201510024279.1A CN104567932A (zh) | 2015-01-16 | 2015-01-16 | 一种高精度光纤陀螺惯测装置标定方法 |
| PCT/CN2015/072134 WO2016112571A1 (zh) | 2015-01-16 | 2015-02-03 | 一种高精度光纤陀螺惯测装置标定方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2018508007A JP2018508007A (ja) | 2018-03-22 |
| JP6613236B2 true JP6613236B2 (ja) | 2019-12-04 |
Family
ID=53084537
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2016542745A Active JP6613236B2 (ja) | 2015-01-16 | 2015-02-03 | 高精度な光ファイバジャイロ慣性測量装置の標定方法 |
Country Status (4)
| Country | Link |
|---|---|
| JP (1) | JP6613236B2 (ja) |
| CN (1) | CN104567932A (ja) |
| DE (1) | DE102016100618A1 (ja) |
| WO (1) | WO2016112571A1 (ja) |
Families Citing this family (51)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN105157723A (zh) * | 2015-07-14 | 2015-12-16 | 北京理工大学 | 一种基于光纤陀螺的捷联惯导系统的标定方法 |
| CN106017507B (zh) * | 2016-05-13 | 2019-01-08 | 北京航空航天大学 | 一种用于中低精度的光纤惯组快速标定方法 |
| CN107270903B (zh) * | 2017-06-21 | 2023-10-20 | 湖南云箭格纳微信息科技有限公司 | 组合式旋转调制微惯性导航方法、系统和存储介质 |
| CN109084806B (zh) * | 2018-09-21 | 2020-07-14 | 苏州大学 | 标量域mems惯性系统标定方法 |
| CN109470273B (zh) * | 2018-12-14 | 2022-07-26 | 中国船舶重工集团公司第七0七研究所 | 捷联惯性导航系统惯性元件拆装免标定方法 |
| CN109696183B (zh) * | 2019-01-28 | 2021-04-16 | 北京华捷艾米科技有限公司 | 惯性测量单元的标定方法及装置 |
| CN109974747A (zh) * | 2019-03-21 | 2019-07-05 | 中国船舶重工集团公司第七0七研究所 | 一种多路高速光纤陀螺数据采集及测试系统 |
| CN110006454B (zh) * | 2019-04-23 | 2021-07-06 | 哈尔滨工业大学 | 一种imu标定三轴转台垂直度和初始姿态的方法 |
| DK201970509A1 (en) | 2019-05-06 | 2021-01-15 | Apple Inc | Spoken notifications |
| CN110702109B (zh) * | 2019-06-05 | 2023-02-28 | 西京学院 | 一种采煤机惯性导航/无线传感器网络组合定位方法 |
| CN112643665B (zh) * | 2019-10-10 | 2023-04-07 | 北京京东乾石科技有限公司 | 一种绝对位姿传感器安装误差的标定方法和装置 |
| CN111044038B (zh) * | 2019-12-05 | 2023-04-07 | 河北汉光重工有限责任公司 | 一种基于坐标变换的捷联惯导艏向变换方法 |
| CN110987008B (zh) * | 2019-12-10 | 2023-08-11 | 上海航天控制技术研究所 | 一种低精度mems陀螺组合零位偏置快速标定方法 |
| CN110954137B (zh) * | 2019-12-13 | 2023-03-24 | 陕西瑞特测控技术有限公司 | 一种惯导加速度计装配误差标量修正的方法 |
| CN111089606B (zh) * | 2019-12-20 | 2023-11-14 | 湖南航天机电设备与特种材料研究所 | 一种三自激光惯组关键参数快速自标定方法 |
| CN111412930B (zh) * | 2020-04-30 | 2023-01-17 | 中国船舶重工集团公司第七0七研究所 | 一种联合测姿装置安装误差的标定运算方法 |
| CN113670330B (zh) * | 2020-05-14 | 2024-05-31 | 北京机械设备研究所 | 一种基于递推最小二乘法的mems陀螺仪快速标定方法 |
| CN111982151B (zh) * | 2020-07-17 | 2022-07-22 | 中科长城海洋信息系统有限公司 | 一种光纤捷联惯导系统的自标定方法 |
| CN111678538B (zh) * | 2020-07-29 | 2023-06-09 | 中国电子科技集团公司第二十六研究所 | 一种基于速度匹配的动态水平仪误差补偿方法 |
| CN112146642A (zh) * | 2020-09-25 | 2020-12-29 | 上海航天控制技术研究所 | 一种卫星用三轴高精度光纤陀螺组合 |
| CN112710328B (zh) * | 2020-12-09 | 2024-04-16 | 中船航海科技有限责任公司 | 一种四轴冗余惯导系统的误差标定方法 |
| CN112697173B (zh) * | 2021-01-31 | 2024-09-10 | 南京理工大学 | Mems惯性器件自动化标定测试系统及方法 |
| CN113029192B (zh) * | 2021-02-19 | 2023-11-10 | 北京航天时代光电科技有限公司 | 一种获取光纤惯性测量装置陀螺仪参数的方法 |
| CN114459465B (zh) * | 2021-03-02 | 2023-08-22 | 北京天兵科技有限公司 | 一种mems惯组方位的在线补偿方法 |
| CN113175941B (zh) * | 2021-03-31 | 2023-09-22 | 西安理工大学 | 基于双轴转台的激光陀螺寻北仪参数辨识方法 |
| CN113252071B (zh) * | 2021-04-20 | 2023-04-14 | 北京航天时代光电科技有限公司 | 一种基于双光纤陀螺的临界角加速度测试系统及测试方法 |
| CN113155114B (zh) * | 2021-04-23 | 2023-11-17 | 三一重型装备有限公司 | Mems惯性测量单元陀螺零位的温度补偿方法及装置 |
| CN113247310B (zh) * | 2021-05-20 | 2022-07-29 | 上海卫星工程研究所 | 一种适用于卫星可连续姿态机动次数的估算方法及系统 |
| CN113433600B (zh) * | 2021-06-23 | 2022-04-12 | 中国船舶重工集团公司第七0七研究所 | 一种重力仪安装误差角标定方法 |
| CN113701747B (zh) * | 2021-07-20 | 2024-06-11 | 北京航天控制仪器研究所 | 一种基于离心机激励的惯性测量系统姿态角误差分离方法 |
| CN113624259B (zh) * | 2021-08-23 | 2023-08-08 | 湖南科众兄弟科技有限公司 | 一种mems惯组的标定方法 |
| CN113720328B (zh) * | 2021-09-10 | 2023-07-14 | 北京控制工程研究所 | 一种惯性测量单元中加速度计组件的安装装置及方法 |
| CN113945227B (zh) * | 2021-09-13 | 2024-04-23 | 西安航天三沃机电设备有限责任公司 | 一种基于离心台的惯性测量单元全量程加速度标校方法 |
| CN113776560B (zh) * | 2021-09-17 | 2023-07-14 | 北京控制工程研究所 | 一种基于高精度三轴转台的陀螺标度因数测试方法 |
| CN113804221B (zh) * | 2021-10-14 | 2023-10-03 | 天津科技大学 | 一种基于模观测法的离心机加速度计组合标定方法 |
| CN113916263B (zh) * | 2021-10-28 | 2023-08-15 | 西北工业大学 | 基于rtx实时系统和反射内存的三轴惯组远程自动标定系统及方法 |
| CN113899324B (zh) * | 2021-11-08 | 2023-09-05 | 中国计量科学研究院 | 基于单轴激光陀螺测角仪的多轴转台垂直度误差检测方法 |
| CN114415541A (zh) * | 2021-12-23 | 2022-04-29 | 江南机电设计研究所 | 一种线性惯测组合模拟器通道标定方法 |
| CN114353828B (zh) * | 2021-12-23 | 2024-01-16 | 湖南航天机电设备与特种材料研究所 | 一种激光捷联惯组标定测试装置及测试方法 |
| CN114608573B (zh) * | 2022-04-02 | 2024-04-16 | 北京航空航天大学 | 一种基于双轴旋转惯导系统的温度误差模型系数快速辨识方法 |
| CN114705177B (zh) * | 2022-06-07 | 2022-08-30 | 西安晟昕科技发展有限公司 | 一种基于误差分析的光纤陀螺测姿数据处理方法 |
| CN115267256B (zh) * | 2022-07-15 | 2024-04-30 | 北京航空航天大学 | 一种加速度计组件的模观测标定方法 |
| CN115265512B (zh) * | 2022-07-28 | 2024-04-09 | 北京航空航天大学 | 一种用于serf原子自旋陀螺仪的旋转调制方法 |
| CN116223849B (zh) * | 2022-12-02 | 2023-10-20 | 廊坊市北斗神舟测控仪器有限公司 | 一种石英挠性加速度传感器标度因数测试工装 |
| CN116242397B (zh) * | 2023-03-11 | 2024-01-30 | 中国人民解放军国防科技大学 | 一种速度误差修正模型下的双惯导协同标定方法 |
| CN116007604A (zh) * | 2023-03-24 | 2023-04-25 | 中国船舶集团有限公司第七〇七研究所 | 一种提高光纤陀螺仪测量精度的方法及装置 |
| CN116839634B (zh) * | 2023-08-29 | 2023-11-21 | 北京信普尼科技有限公司 | 一种用机械臂标定陀螺仪的方法与机械臂 |
| CN116989826B (zh) * | 2023-09-27 | 2023-12-08 | 中国船舶集团有限公司第七〇七研究所 | 一种光纤陀螺小转速标度因数非线性度测试方法 |
| CN117577339B (zh) * | 2024-01-17 | 2024-03-15 | 徐州医科大学 | 基于微惯性导航的下肢力线精准建模与定位方法和系统 |
| CN117589203B (zh) * | 2024-01-18 | 2024-05-10 | 陕西太合智能钻探有限公司 | 一种陀螺仪标定方法 |
| CN118274884B (zh) * | 2024-05-31 | 2024-08-02 | 火丰科技(深圳)有限公司 | 惯性测量单元的误差补偿方法 |
Family Cites Families (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2770077B2 (ja) * | 1990-10-02 | 1998-06-25 | 株式会社トキメック | キャリブレーション装置を内蔵するリングレーザジャイロ装置 |
| US6904377B2 (en) * | 2003-03-17 | 2005-06-07 | Northrop Grumman Corporation | Method for measuring force-dependent gyroscope sensitivity |
| CN100559189C (zh) * | 2007-03-26 | 2009-11-11 | 北京航空航天大学 | 一种惯性测量单元的无定向多位置高精度标定方法 |
| CN101221046B (zh) * | 2008-01-22 | 2010-12-08 | 南京航空航天大学 | 光纤陀螺组件输出信号的误差处理方法 |
| CN101701825A (zh) * | 2009-09-28 | 2010-05-05 | 龙兴武 | 高精度激光陀螺单轴旋转惯性导航系统 |
| CN102506871B (zh) * | 2011-11-28 | 2014-01-22 | 北京航空航天大学 | 一种机载双光纤imu/dgps组合相对形变姿态测量装置 |
| CN102853850B (zh) * | 2012-09-11 | 2015-07-01 | 中国兵器工业集团第二一四研究所苏州研发中心 | 基于单轴转台的三轴mems陀螺旋转积分标定方法 |
| US8915116B2 (en) * | 2013-01-23 | 2014-12-23 | Freescale Semiconductor, Inc. | Systems and method for gyroscope calibration |
| CN103453917A (zh) * | 2013-09-04 | 2013-12-18 | 哈尔滨工程大学 | 一种双轴旋转式捷联惯导系统初始对准与自标校方法 |
| CN104165638B (zh) * | 2014-08-07 | 2017-02-08 | 北京理工大学 | 一种双轴旋转惯导系统多位置自主标定方法 |
-
2015
- 2015-01-16 CN CN201510024279.1A patent/CN104567932A/zh active Pending
- 2015-02-03 JP JP2016542745A patent/JP6613236B2/ja active Active
- 2015-02-03 WO PCT/CN2015/072134 patent/WO2016112571A1/zh active Application Filing
-
2016
- 2016-01-15 DE DE102016100618.1A patent/DE102016100618A1/de active Pending
Also Published As
| Publication number | Publication date |
|---|---|
| DE102016100618A1 (de) | 2016-07-21 |
| CN104567932A (zh) | 2015-04-29 |
| WO2016112571A1 (zh) | 2016-07-21 |
| JP2018508007A (ja) | 2018-03-22 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP6613236B2 (ja) | 高精度な光ファイバジャイロ慣性測量装置の標定方法 | |
| CN106969783B (zh) | 一种基于光纤陀螺惯性导航的单轴旋转快速标定技术 | |
| CN102252673B (zh) | 一种星敏感器在轨光行差的修正方法 | |
| CN108759798B (zh) | 一种高精度航天器精度测量的实现方法 | |
| CN106017507B (zh) | 一种用于中低精度的光纤惯组快速标定方法 | |
| CN103852085B (zh) | 一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法 | |
| CN110672131B (zh) | 一种大失准角下惯性/偏振光组合导航系统ukf对准方法 | |
| CN103697918B (zh) | 一种三轴正交一轴斜置构型光纤陀螺惯测装置的标定方法 | |
| CN104374388A (zh) | 一种基于偏振光传感器的航姿测定方法 | |
| CN104764463B (zh) | 一种惯性平台调平瞄准误差的自检测方法 | |
| CN101608920A (zh) | 一种组合式空间位姿精密动态测量装置及方法 | |
| CN104266649A (zh) | 基于陀螺经纬仪测量基准立方镜姿态角度的方法 | |
| CN105737848B (zh) | 一种系统级星敏感器观星系统及观星方法 | |
| CN103591949A (zh) | 三轴姿态测量系统非正交性误差的正交补偿方法 | |
| CN104457688B (zh) | 卫星上批量设备姿态角度矩阵的高精度自动化测量装置 | |
| CN110887507A (zh) | 一种快速估计惯性测量单元全部零偏的方法 | |
| CN110095659B (zh) | 深空探测巡视器通讯天线指向精度动态测试方法 | |
| CN110849294B (zh) | 一种基于光纤陀螺的转台非正交度测试方法 | |
| Bhatia et al. | Development of an analytical method for IMU calibration | |
| CN102748010B (zh) | 姿态测量系统和方法以及油井井眼轨迹测量系统和方法 | |
| Wu et al. | The asynchronous gimbal-rotation-based calibration method for lever-arm errors of two rotational inertial navigation systems | |
| CN105371852B (zh) | 一种基于残差生成器的最优陀螺组合选取方法 | |
| Lu et al. | Calibration, alignment, and dynamic tilt maintenance method based on vehicular hybrid measurement unit | |
| Shun-qing et al. | Impacts of installation errors on the calibration accuracy of gyro accelerometer tested on centrifuge | |
| CN105841700B (zh) | 一种面向不动产实地测量的定位方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20180124 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20181227 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20190109 |
|
| A601 | Written request for extension of time |
Free format text: JAPANESE INTERMEDIATE CODE: A601 Effective date: 20190408 |
|
| A601 | Written request for extension of time |
Free format text: JAPANESE INTERMEDIATE CODE: A601 Effective date: 20190610 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20190709 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20191002 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20191101 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 6613236 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |