JP3726884B2 - 慣性計測装置を用いた姿勢推定装置及び方法並びにプログラム - Google Patents
慣性計測装置を用いた姿勢推定装置及び方法並びにプログラム Download PDFInfo
- Publication number
- JP3726884B2 JP3726884B2 JP2001128261A JP2001128261A JP3726884B2 JP 3726884 B2 JP3726884 B2 JP 3726884B2 JP 2001128261 A JP2001128261 A JP 2001128261A JP 2001128261 A JP2001128261 A JP 2001128261A JP 3726884 B2 JP3726884 B2 JP 3726884B2
- Authority
- JP
- Japan
- Prior art keywords
- estimated value
- equation
- observation
- inertial measurement
- parameter
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims description 22
- 238000005259 measurement Methods 0.000 title claims description 18
- 239000011159 matrix material Substances 0.000 claims description 44
- 238000012545 processing Methods 0.000 claims description 22
- 230000014509 gene expression Effects 0.000 claims description 21
- 238000006243 chemical reaction Methods 0.000 claims description 19
- 230000010354 integration Effects 0.000 claims description 12
- 230000009466 transformation Effects 0.000 claims description 6
- 230000035945 sensitivity Effects 0.000 claims description 3
- 230000008569 process Effects 0.000 description 10
- 239000013598 vector Substances 0.000 description 10
- 230000006870 function Effects 0.000 description 8
- 238000004891 communication Methods 0.000 description 4
- 238000011161 development Methods 0.000 description 4
- 238000004088 simulation Methods 0.000 description 4
- 238000004422 calculation algorithm Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 3
- 230000004069 differentiation Effects 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 238000007796 conventional method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- OVSKIKFHRZPJSS-UHFFFAOYSA-N 2,4-D Chemical compound OC(=O)COC1=CC=C(Cl)C=C1Cl OVSKIKFHRZPJSS-UHFFFAOYSA-N 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000000835 fiber Substances 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
-
- 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/244—Spacecraft control systems
- B64G1/245—Attitude control algorithms for spacecraft attitude control
-
- 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
-
- 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
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Chemical & Material Sciences (AREA)
- Automation & Control Theory (AREA)
- Combustion & Propulsion (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Algebra (AREA)
- Navigation (AREA)
- Gyroscopes (AREA)
Description
【０００１】
【発明の属する技術分野】
この発明は、慣性計測装置からの信号に基づき姿勢を推定するための姿勢推定装置及び方法並びにプログラムに関する。
【０００２】
【従来の技術】
近年、宇宙開発の分野において大型で多機能な人工衛星の他に、単機能ではあるが開発の容易なマイクロサット（超小型人工衛星）が注目されている。これらマイクロサットの開発が容易であることは人工衛星の単価を引き下げることと相俟って、宇宙開発をより身近なものにすると考えられる。現在、ピギーバック衛星として多くのマイクロサットが打ち上げられている。
【０００３】
単機能・安価であることを身上とするマイクロサットであるが、その高性能化には３軸制御が不可欠である。そのためには高性能な姿勢観測系が必要となるが、衛星の開発費の高騰を考えればあまり高価な機材を使用することができない。
【０００４】
従来、３軸衛星の姿勢センサとして各種センサが用いられている。例えば、慣性基準装置などのジャイロから姿勢角速度を検出し、これを積分することによりロール、ヨーを含めて正確な姿勢推定を行うことが知られている。慣性基準装置は、レートジャイロなどを３軸に搭載し、パッケージにしたものである。ジャイロの信号を直接積分して使うと、動的な応答のよい検出ができるメリットがあるが、反面、長時間ではドリフトが累積してくるという問題がある。それを補正するために、スタートラッカなどを用い、絶対基準からの誤差を検出系にフィードバックすることが行われている。しかし、この手法は高価なセンサを必要とし、単機能・安価であるマイクロサットに適用できない。
【０００５】
【発明が解決しようとする課題】
本発明は係る課題に鑑みてなされたもので、精度がよくかつ安価である姿勢推定装置及び方法、すなわち、比較的単価の低い圧電振動ジャイロやファイバージャイロ等の機材を用いて人工衛星の姿勢推定を行うことができる慣性計測装置を用いた姿勢推定装置及び方法並びにプログラムを提供することを目的とする。
【０００６】
この発明によれば、スタートラッカなどのセンサを必要とすることなく、ジャイロからの情報のみで姿勢の推定を行うことができる。このような状況は従来の人工衛星においても生じる。例えば、実際の運用下において人工衛星がマニューバ中でスタートラッカなどのセンサを使用できない状態にあるときなどに対応する。
【０００７】
【課題を解決するための手段】
この発明に係る慣性計測装置を用いた姿勢推定装置は、慣性計測装置から状態量ω（ｔ）を受けて予め定められたシステム方程式及び観測方程式に入力するとともに、これらに関して時間更新処理及び観測更新処理を行うカルマンフィルタと、前記カルマンフィルタの出力に基づき修正ロドリゲスパラメータα（ｔ）の時間微分の推定値を生成する処理部と、前記処理部の出力に基づき修正ロドリゲスパラメータの推定値を生成する積分処理部と、予め与えられた初期値及び前記積分処理部の出力に基づき観測感度行列を更新するとともに、その更新出力を前記カルマンフィルタに供給するシステム伝播行列生成部と、前記積分処理部の出力に基づき座標変換行列Ｒを生成する変換マトリクス生成部と、前記変換マトリクス生成部の出力に基づき姿勢推定を行う姿勢推定部とを備えるものである。
【０００８】
好ましくは、前記修正ロドリゲスパラメータは、ｅを回転軸の方向余弦、θを回転軸回りの回転角とするとき、後述の式(2.2.31)(2.2.32)で与えられる。
【０００９】
好ましくは、前記観測方程式は、後述の式(2.3.1)としたとき、式(2.3.2)に観測ノイズを加えることにより与えられる。
【００１０】
好ましくは、前記システム方程式は、後述の式(2.3.5)の右辺をｆ(a(t),ａドット(t)，t)とおいたときの後述の式(2.3.6)にシステムノイズを加えることにより与えられる。
【００１１】
この発明に係る慣性計測装置を用いた姿勢推定方法は、慣性計測装置から信号を受けて修正ロドリゲスパラメータα（ｔ）の時間微分の状態量と状態量ω（ｔ）を観測量とするシステム方程式及び観測方程式を生成する第１ステップと、
拡張カルマンフィルタを用いて前記パラメータα（ｔ）の時間微分の推定値を求める第２ステップと、
前記第２ステップで求められた推定値を数値積分して前記パラメータα（ｔ）の推定値を求める第３ステップと、
前記第３ステップで求められた推定値に基づき変換マトリクスＲ（ｔ）を決定する第４ステップと、
前記変換マトリクスＲ（ｔ）に基づき姿勢の推定値を求めるステップとを備えるものである。
【００１２】
この発明に係るプログラムは、コンピュータに、
慣性計測装置から信号を受けて修正ロドリゲスパラメータα（ｔ）の時間微分の状態量と状態量ω（ｔ）を観測量とするシステム方程式及び観測方程式を生成する第１ステップと、
拡張カルマンフィルタを用いて前記パラメータα（ｔ）の時間微分の推定値を求める第２ステップと、
前記第２ステップで求められた推定値を数値積分して前記パラメータα（ｔ）の推定値を求める第３ステップと、
前記第３ステップで求められた推定値に基づき変換マトリクスＲ（ｔ）を決定する第４ステップと、
前記変換マトリクスＲ（ｔ）に基づき姿勢の推定値を求めるステップとを実行させるためのものである。
【００１３】
この発明に係るプログラムは、例えば、記録媒体に記録される。
媒体には、例えば、フレキシブルディスク、ハードディスク、磁気テープ、光磁気ディスク、ＣＤ（ＣＤ−ＲＯＭ、Ｖｉｄｅｏ−ＣＤを含む）、ＤＶＤ（ＤＶＤ−Ｖｉｄｅｏ、ＤＶＤ−ＲＯＭ、ＤＶＤ−ＲＡＭを含む）、ＲＯＭカートリッジ、バッテリバックアップ付きのＲＡＭメモリカートリッジ、フラッシュメモリカートリッジ、不揮発性ＲＡＭカートリッジ等を含む。
【００１４】
また、電話回線等の有線通信媒体、マイクロ波回線等の無線通信媒体等の通信媒体を含む。インターネットもここでいう通信媒体に含まれる。
【００１５】
媒体とは、何等かの物理的手段により情報（主にデジタルデータ、プログラム）が記録されているものであって、コンピュータ、専用プロセッサ等の処理装置に所定の機能を行わせることができるものである。要するに、何等かの手段でもってコンピュータにプログラムをダウンロードし、所定の機能を実行させるものであればよい。
【００１６】
本発明は、修正ロドリゲスパラメータを拡張カルマンフィルタへ適用したものである。
姿勢の伝播式としてはクォータニオンを用いた変換式が一般に知られている。クォータニオンはオイラー角と異なり、姿勢に対して特異点が存在せず、超越関数を使用しないなどの利点が存在し、一般に衛星の姿勢の記述にはこれが用いられている。しかし、これをジャイロからのみの情報に対して推定を行うとすると、推定アルゴリズムであるカルマンフィルタに必要な観測方程式が成立しない。カルマンフィルタによる推定を行うためには必要な方程式、すなわちシステム方程式と観測方程式とを成立させる必要がある。そこで、本発明においてクォータニオンの応用である修正ロドリゲスパラメータを用いることにより、それらの式を成立させることに成功したのである。
【００１７】
【発明の実施の形態】
この発明の実施の形態に係る装置／方法について図面を参照して説明する。以下の説明は、本発明の実施の形態に係る装置／方法を人工衛星の姿勢推定に用いる場合を例にとったものである。この発明の実施の形態に係る装置／方法は、人工衛星の姿勢情報をジャイロからの出力のみにより長時間、精度良く推定するものである。人工衛星の姿勢決定方程式として、修正ロドリゲスパラメータを使用している。
【００１８】
図１はこの発明の実施の形態に係る装置のブロック図である。センサであるレートジャイロ１から状態量（角速度）ω（ｔ）を受けて、カルマンフィルタ３はシステム方程式と観測方程式を生成するとともに、次式に従い時間更新処理及び観測更新処理を行う。なお、システム方程式及び観測方程式については後述する。
【００１９】
【数６】
【００２０】
上記式において、下添字で示された＋はカルマンフィルタによる観測更新処理後の変数であることを示す。同じく、下添字で示されたｋはΔｔ時間間隔で離散的に処理される計算式の実行がｋ番目であることを示し、同様にｋ＋１はｋ＋１番目であることを示す。右肩添字の−１は逆行列を示す。右肩添字のＴは転置行列を示す。
【００２１】
時間更新及び観測更新について簡単に説明を加える。時間更新とは、線形モデル
【数７】
を積分する処理のことである。上記の場合は
【数８】
を積分する処理になる。これは計算により予測値を求めていく処理である。また、同時に誤差の共分散行列も更新する。誤差の共分散行列に関する式は
【数９】
で表され、更新処理の際はこれを積分処理することになる。その結果、Ｐバー（ｔ）が求められる。
【００２２】
観測更新とは、新しく得られた観測量と計算予測値から新しい推定値を求める処理のことである。上記の場合の式は
【数１０】
と表される。ハットの付いたものは推定値であり、バーのついたものは予測値である。この処理は観測された値と予測された観測値を比較することにより、そこに誤差に関する情報を得、それに対してあるゲインを掛けて予測値に対して付加し、それをもって推定値とするという意味である。特に
【数１１】
の部分はイノベーション過程もしくはＯ−Ｃと呼ばれ、観測値と計算予測された観測値を比較する過程である。それによりどの程度、計算予測値と観測値が異なっているか比較する。この比較により誤差情報が得られるが、その中には有益なものと意味のないものがある。それをどのように分配して予測値に付加するのかを決定するのが
【数１２】
と書かれているカルマンゲインと呼ばれるものである。
このカルマンゲインは
【数１３】
という式により求められる（この計算のために時間更新でＰバー（ｔ）を求める必要があった）。なお、Ｒ（ｔk）は観測ノイズの共分散行列と呼ばれるものである。
また、誤差の共分散行列についてもカルマンゲインを用いて
【数１４】
のように更新する。
前述のような処理を行う「時間更新」「観測更新」であるが、これらは新しい観測値により観測更新が行われた後、次の新しい観測値が得られるまでの間、時間更新により「位置」「姿勢」などの状態量を推定するために用いられる。
【００２３】
処理部４はカルマンフィルタ３の出力に基づきαドットハット（修正ロドリゲスパラメータα（ｔ）の時間微分αドット（ｔ）の推定値）を生成する。
積分処理部５は処理部４の出力に基づき修正ロドリゲスパラメータの推定値αハット、α0ハットを生成する。
【００２４】
システム伝播行列生成部６は初期値設定部２の出力及び積分処理部５の出力に基づき観測感度行列を更新して、その更新出力をカルマンフィルタ３に供給する。システム伝播行列とは線形システム
【数１５】
のＦ（ｔ）のことである。今回の場合、後述の式（２．３．５）の状態量αドットを偏微分することにより得られる（後述の式（２．３．８）から式（２．３．１６）がその成分に相当する）。これは状態量と状態量の微分値を関係を示す行列である。観測感度行列とは
【数１６】
のＨ（ｔ）のことである。観測される値と状態量の関係を示す行列である（後述の式（２．３．１）により求められる。ただし、解析的に解くことはできないので数値的に演算処理を行う）。
【００２５】
変換マトリクス生成部７は積分処理部５の出力に基づき座標変換行列Ｒを生成する。
姿勢推定部８は変換マトリクス生成部７の出力に基づき姿勢推定を行う。
【００２６】
次に動作について説明する。まず本発明の処理の概要について説明し、次に本発明の理論及びアルゴリズムの詳細について説明し、最後にシミュレーション結果について説明する。
【００２７】
本発明の実施の形態において、公知の拡張カルマンフィルタを利用する。拡張カルマンフィルタは推定したい状態量の初期値を与えておき、それと観測量の時間履歴を元に状態量の推定値を逐次計算していく手法である。
【００２８】
図２のその概略フローチャートを示す。
Ｓ１：レートジャイロ１から信号を受けて修正ロドリゲスパラメータα（ｔ）の時間微分αドット（ｔ）の状態量、ω（ｔ）を観測量とするシステム方程式と観測方程式を作成する。
Ｓ２：拡張カルマンフィルタを用いてαドット（ｔ）の推定値を求める。
Ｓ３：この推定値を数値積分することによりα（ｔ）の推定値を求める。
Ｓ４：この推定値に基づき変換マトリクスＲ（ｔ）を決定する。
Ｓ５：変換マトリクスＲ（ｔ）に基づき時刻ｔにおける姿勢の推定値を求める。
【００２９】
修正ロドリゲスパラメータを用いることにより、システム方程式と観測方程式を生成することができ、人工衛星の姿勢推定に拡張カルマンフィルタを適用することができた。これによりドリフトの影響を軽減することができ、レートジャイロのみにより高精度な姿勢推定が可能になったのである。従来の手法ではシステム方程式と観測方程式を生成することができず、人工衛星の姿勢推定に拡張カルマンフィルタを適用することができなかった。
【００３０】
次に理論について説明する。
［理論］
１．任意の軸周りのベクトルの回転
あるベクトルｘが任意の軸の周りを角度θだけ回転させた場合を考える。軸方向の単位ベクトルをｅ、回転後のベクトルをｘ'とする。ここで次の式が成立する。
【００３１】
【数１７】
ただし、Ｉは単位マトリックスを表す。また、
【００３２】
【数１８】
倍角、半角の公式より
【００３３】
【数１９】
ここで任意の軸回りθの回転をあらわすクォータニオンｑを
【００３４】
【数２０】
とすると、
【００３５】
【数２１】
となる。ただし、
【００３６】
【数２２】
【００３７】
したがって、時刻ｔ0における軸の向きと時刻ｔにおける変換マトリクスＲが分かれば、そのｔにおける軸の向き、すなわち姿勢が分かる。
【００３８】
２．システム方程式
３次元空間の基底ベクトルをｃ1，ｃ2，ｃ3とし、この３つのベクトルがある角速度ベクトル
【００３９】
【数２３】
で表される軸の周りを回転するとき、ｃ1，ｃ2，ｃ3の時間積分について
【００４０】
【数２４】
なる関係が成り立つ.
(2.2.2)式をマトリックス表現でひとつの式にまとめると
【００４１】
【数２５】
なるωハットを使って
【００４２】
【数２６】
となる。ただし、
【００４３】
【数２７】
【００４４】
３．修正ロドリゲスパラメータの利用とその一階微分方程式
以下のような修正ロドリゲスパラメータ：αとα0を定義する。
【数２８】
【００４５】
すなわち、αは３次元のベクトルである。ｅは回転軸の方向余弦、θは回転軸回りの回転角を表す。(2.2.31)式で定義した修正ロドリゲスパラメータを用いると(2.1.4)式のクォータニオンの要素をαで表現できる。αで表現されるａ、Ｖを使えば、(2.1.5)式の変換マトリクスもαを使って表すことができる。
【００４６】
さらに、αの１階微分方程式を作ることでＲの時間履歴を求められる。αの１階微分方程式は高々３本の連立方程式である。
(2.2.32)式より
【００４７】
【数２９】
よって、
【００４８】
【数３０】
次にＶについて考える。
【００４９】
【数３１】
変換マトリクスＲは(2.2.34)、(2.2.35)式より
【００５０】
【数３２】
(2.2.34)、(2.2.35)式を用いてαの一階微分方程式を求めると、次式のようになる。
【００５１】
【数３３】
【００５２】
［アルゴリズムの詳細］
４．拡張カルマンフィルタへの適用
本発明の実施の形態において、衛星の互いに直交する３軸に取りつけられたレートジャイロから計測された角速度ベクトルω（ｔ）を基に姿勢推定を行う。
具体的には、(2.2.41)式から修正ロドリゲスパラメータα（ｔ）の時間微分αドット（ｔ）の状態量、ω（ｔ）を観測量とするシステム方程式と観測方程式を作成し、拡張カルマンフィルタを用いてαドット（ｔ）の推定値を求める。これを数値積分することによりα（ｔ）の推定値を求め、(2.2.36)式に代入して変換マトリクスＲ（ｔ）を決定し、(2.1.5)式より時刻ｔにおける姿勢の推定値を求める。
【００５３】
この場合、(2.1.5)式の右辺のｘが人工衛星の任意の固定軸をあらわす方向ベクトルの初期値、左辺のｘ'がｔ秒後における固定軸の向きになる。ｘ'とｘのノルムは等しい。
はじめに観測方程式を求める。(2.2.41)式より
【００５４】
【数３４】
とおけば
【００５５】
【数３５】
これに観測ノイズを加えれば拡張カルマンフィルタにおける観測方程式となる。
次にシステム方程式を求める。(2.2.32)式より
【００５６】
【数３６】
(2.2.41)式を展開すると次のようになる。
【００５７】
【数３７】
ωの時間微分ｄω／ｄｔは数値的に意味のないものとして消去すると、(2.3.4)式の１階微分は以下のようになる。
【００５８】
【数３８】
上式の右辺をｆ(a(t),ａドット(t)，t)とおけば
【００５９】
【数３９】
となる。この式にシステムノイズを加えれば拡張カルマンフィルタにおけるシステム方程式となる。
(2.3.6)式は非線型微分方程式なので、システム伝播行列を求めるためには(2.3.5)式を状態量ベクトルで偏微分した行列Ｆを求める必要がある。
【００６０】
【数４０】
(2.3.5)式よりＦの各要素は以下の通りである。
【００６１】
【数４１】
【００６２】
［シミュレーション結果］
図３にシミュレーション結果を示す。図３は、観測ノイズ標準偏差＝３×１０−５［rad/sec］のときの機体軸の方向の推定誤差を示す。図３によれば、はじめのうち誤差は時間に比例して増加し、１．２×１０５［sec］で誤差は２．２［deg］に達する。しかし、誤差はその後静定する。本発明の実施の形態によれば、カルマンゲインは速やかなに収束しており、良好に情報の復元を行うことができる。
【００６３】
しかも、図３から明らかなように、本発明の実施の形態によればドリフトは累積せず、誤差は一定範囲内に収まる。これに対し、従来の手法ではドリフトは累積し、誤差が一定範囲内に収まることはなかった。この点で本発明の実施の形態の手法は非常に優れている。
【００６４】
本発明は、以上の実施の形態に限定されることなく、特許請求の範囲に記載された発明の範囲内で、種々の変更が可能であり、それらも本発明の範囲内に包含されるものであることは言うまでもない。
【００６５】
本発明は、人工衛星のみでなく、ジャイロを用いて姿勢を推定するもの全般、すなわち慣性計測装置を用いるものすべてに対して適用でき、精度の向上を保証するものであり、その応用分野は広範囲にわたる。例えば、本発明は、ビデオカメラの手ぶれ防止機能や、カーナビゲーションシステムなどの姿勢推定などに適用できる。
【００６６】
また、本明細書において、手段とは必ずしも物理的手段を意味するものではなく、各手段の機能が、ソフトウェアによって実現される場合も包含する。さらに、一つの手段の機能が、二つ以上の物理的手段により実現されても、若しくは、二つ以上の手段の機能が、一つの物理的手段により実現されてもよい。
【００６７】
【発明の効果】
以上のように、この発明によれば、慣性計測装置の出力のみに基づき高精度な姿勢推定を実現できる。特に、従来問題となっていたドリフトを除去することができる。
【図面の簡単な説明】
【図１】 この発明の実施の形態に係る装置のブロック図である。
【図２】 この発明の実施の形態に係る処理フローチャートである。
【図３】 シミュレーション結果の例である。
【符号の説明】
１ レートジャイロ
２ 初期値設定部
３ カルマンフィルタ
４ 修正ロドリゲスパラメータαの時間微分の推定値の生成部
５ 積分処理部
６ システム伝播行列生成部
７ 変換マトリクス生成部
８ 姿勢推定部
【発明の属する技術分野】
この発明は、慣性計測装置からの信号に基づき姿勢を推定するための姿勢推定装置及び方法並びにプログラムに関する。
【０００２】
【従来の技術】
近年、宇宙開発の分野において大型で多機能な人工衛星の他に、単機能ではあるが開発の容易なマイクロサット（超小型人工衛星）が注目されている。これらマイクロサットの開発が容易であることは人工衛星の単価を引き下げることと相俟って、宇宙開発をより身近なものにすると考えられる。現在、ピギーバック衛星として多くのマイクロサットが打ち上げられている。
【０００３】
単機能・安価であることを身上とするマイクロサットであるが、その高性能化には３軸制御が不可欠である。そのためには高性能な姿勢観測系が必要となるが、衛星の開発費の高騰を考えればあまり高価な機材を使用することができない。
【０００４】
従来、３軸衛星の姿勢センサとして各種センサが用いられている。例えば、慣性基準装置などのジャイロから姿勢角速度を検出し、これを積分することによりロール、ヨーを含めて正確な姿勢推定を行うことが知られている。慣性基準装置は、レートジャイロなどを３軸に搭載し、パッケージにしたものである。ジャイロの信号を直接積分して使うと、動的な応答のよい検出ができるメリットがあるが、反面、長時間ではドリフトが累積してくるという問題がある。それを補正するために、スタートラッカなどを用い、絶対基準からの誤差を検出系にフィードバックすることが行われている。しかし、この手法は高価なセンサを必要とし、単機能・安価であるマイクロサットに適用できない。
【０００５】
【発明が解決しようとする課題】
本発明は係る課題に鑑みてなされたもので、精度がよくかつ安価である姿勢推定装置及び方法、すなわち、比較的単価の低い圧電振動ジャイロやファイバージャイロ等の機材を用いて人工衛星の姿勢推定を行うことができる慣性計測装置を用いた姿勢推定装置及び方法並びにプログラムを提供することを目的とする。
【０００６】
この発明によれば、スタートラッカなどのセンサを必要とすることなく、ジャイロからの情報のみで姿勢の推定を行うことができる。このような状況は従来の人工衛星においても生じる。例えば、実際の運用下において人工衛星がマニューバ中でスタートラッカなどのセンサを使用できない状態にあるときなどに対応する。
【０００７】
【課題を解決するための手段】
この発明に係る慣性計測装置を用いた姿勢推定装置は、慣性計測装置から状態量ω（ｔ）を受けて予め定められたシステム方程式及び観測方程式に入力するとともに、これらに関して時間更新処理及び観測更新処理を行うカルマンフィルタと、前記カルマンフィルタの出力に基づき修正ロドリゲスパラメータα（ｔ）の時間微分の推定値を生成する処理部と、前記処理部の出力に基づき修正ロドリゲスパラメータの推定値を生成する積分処理部と、予め与えられた初期値及び前記積分処理部の出力に基づき観測感度行列を更新するとともに、その更新出力を前記カルマンフィルタに供給するシステム伝播行列生成部と、前記積分処理部の出力に基づき座標変換行列Ｒを生成する変換マトリクス生成部と、前記変換マトリクス生成部の出力に基づき姿勢推定を行う姿勢推定部とを備えるものである。
【０００８】
好ましくは、前記修正ロドリゲスパラメータは、ｅを回転軸の方向余弦、θを回転軸回りの回転角とするとき、後述の式(2.2.31)(2.2.32)で与えられる。
【０００９】
好ましくは、前記観測方程式は、後述の式(2.3.1)としたとき、式(2.3.2)に観測ノイズを加えることにより与えられる。
【００１０】
好ましくは、前記システム方程式は、後述の式(2.3.5)の右辺をｆ(a(t),ａドット(t)，t)とおいたときの後述の式(2.3.6)にシステムノイズを加えることにより与えられる。
【００１１】
この発明に係る慣性計測装置を用いた姿勢推定方法は、慣性計測装置から信号を受けて修正ロドリゲスパラメータα（ｔ）の時間微分の状態量と状態量ω（ｔ）を観測量とするシステム方程式及び観測方程式を生成する第１ステップと、
拡張カルマンフィルタを用いて前記パラメータα（ｔ）の時間微分の推定値を求める第２ステップと、
前記第２ステップで求められた推定値を数値積分して前記パラメータα（ｔ）の推定値を求める第３ステップと、
前記第３ステップで求められた推定値に基づき変換マトリクスＲ（ｔ）を決定する第４ステップと、
前記変換マトリクスＲ（ｔ）に基づき姿勢の推定値を求めるステップとを備えるものである。
【００１２】
この発明に係るプログラムは、コンピュータに、
慣性計測装置から信号を受けて修正ロドリゲスパラメータα（ｔ）の時間微分の状態量と状態量ω（ｔ）を観測量とするシステム方程式及び観測方程式を生成する第１ステップと、
拡張カルマンフィルタを用いて前記パラメータα（ｔ）の時間微分の推定値を求める第２ステップと、
前記第２ステップで求められた推定値を数値積分して前記パラメータα（ｔ）の推定値を求める第３ステップと、
前記第３ステップで求められた推定値に基づき変換マトリクスＲ（ｔ）を決定する第４ステップと、
前記変換マトリクスＲ（ｔ）に基づき姿勢の推定値を求めるステップとを実行させるためのものである。
【００１３】
この発明に係るプログラムは、例えば、記録媒体に記録される。
媒体には、例えば、フレキシブルディスク、ハードディスク、磁気テープ、光磁気ディスク、ＣＤ（ＣＤ−ＲＯＭ、Ｖｉｄｅｏ−ＣＤを含む）、ＤＶＤ（ＤＶＤ−Ｖｉｄｅｏ、ＤＶＤ−ＲＯＭ、ＤＶＤ−ＲＡＭを含む）、ＲＯＭカートリッジ、バッテリバックアップ付きのＲＡＭメモリカートリッジ、フラッシュメモリカートリッジ、不揮発性ＲＡＭカートリッジ等を含む。
【００１４】
また、電話回線等の有線通信媒体、マイクロ波回線等の無線通信媒体等の通信媒体を含む。インターネットもここでいう通信媒体に含まれる。
【００１５】
媒体とは、何等かの物理的手段により情報（主にデジタルデータ、プログラム）が記録されているものであって、コンピュータ、専用プロセッサ等の処理装置に所定の機能を行わせることができるものである。要するに、何等かの手段でもってコンピュータにプログラムをダウンロードし、所定の機能を実行させるものであればよい。
【００１６】
本発明は、修正ロドリゲスパラメータを拡張カルマンフィルタへ適用したものである。
姿勢の伝播式としてはクォータニオンを用いた変換式が一般に知られている。クォータニオンはオイラー角と異なり、姿勢に対して特異点が存在せず、超越関数を使用しないなどの利点が存在し、一般に衛星の姿勢の記述にはこれが用いられている。しかし、これをジャイロからのみの情報に対して推定を行うとすると、推定アルゴリズムであるカルマンフィルタに必要な観測方程式が成立しない。カルマンフィルタによる推定を行うためには必要な方程式、すなわちシステム方程式と観測方程式とを成立させる必要がある。そこで、本発明においてクォータニオンの応用である修正ロドリゲスパラメータを用いることにより、それらの式を成立させることに成功したのである。
【００１７】
【発明の実施の形態】
この発明の実施の形態に係る装置／方法について図面を参照して説明する。以下の説明は、本発明の実施の形態に係る装置／方法を人工衛星の姿勢推定に用いる場合を例にとったものである。この発明の実施の形態に係る装置／方法は、人工衛星の姿勢情報をジャイロからの出力のみにより長時間、精度良く推定するものである。人工衛星の姿勢決定方程式として、修正ロドリゲスパラメータを使用している。
【００１８】
図１はこの発明の実施の形態に係る装置のブロック図である。センサであるレートジャイロ１から状態量（角速度）ω（ｔ）を受けて、カルマンフィルタ３はシステム方程式と観測方程式を生成するとともに、次式に従い時間更新処理及び観測更新処理を行う。なお、システム方程式及び観測方程式については後述する。
【００１９】
【数６】
上記式において、下添字で示された＋はカルマンフィルタによる観測更新処理後の変数であることを示す。同じく、下添字で示されたｋはΔｔ時間間隔で離散的に処理される計算式の実行がｋ番目であることを示し、同様にｋ＋１はｋ＋１番目であることを示す。右肩添字の−１は逆行列を示す。右肩添字のＴは転置行列を示す。
【００２１】
時間更新及び観測更新について簡単に説明を加える。時間更新とは、線形モデル
【数７】
【数８】
【数９】
【００２２】
観測更新とは、新しく得られた観測量と計算予測値から新しい推定値を求める処理のことである。上記の場合の式は
【数１０】
【数１１】
【数１２】
このカルマンゲインは
【数１３】
また、誤差の共分散行列についてもカルマンゲインを用いて
【数１４】
前述のような処理を行う「時間更新」「観測更新」であるが、これらは新しい観測値により観測更新が行われた後、次の新しい観測値が得られるまでの間、時間更新により「位置」「姿勢」などの状態量を推定するために用いられる。
【００２３】
処理部４はカルマンフィルタ３の出力に基づきαドットハット（修正ロドリゲスパラメータα（ｔ）の時間微分αドット（ｔ）の推定値）を生成する。
積分処理部５は処理部４の出力に基づき修正ロドリゲスパラメータの推定値αハット、α0ハットを生成する。
【００２４】
システム伝播行列生成部６は初期値設定部２の出力及び積分処理部５の出力に基づき観測感度行列を更新して、その更新出力をカルマンフィルタ３に供給する。システム伝播行列とは線形システム
【数１５】
【数１６】
【００２５】
変換マトリクス生成部７は積分処理部５の出力に基づき座標変換行列Ｒを生成する。
姿勢推定部８は変換マトリクス生成部７の出力に基づき姿勢推定を行う。
【００２６】
次に動作について説明する。まず本発明の処理の概要について説明し、次に本発明の理論及びアルゴリズムの詳細について説明し、最後にシミュレーション結果について説明する。
【００２７】
本発明の実施の形態において、公知の拡張カルマンフィルタを利用する。拡張カルマンフィルタは推定したい状態量の初期値を与えておき、それと観測量の時間履歴を元に状態量の推定値を逐次計算していく手法である。
【００２８】
図２のその概略フローチャートを示す。
Ｓ１：レートジャイロ１から信号を受けて修正ロドリゲスパラメータα（ｔ）の時間微分αドット（ｔ）の状態量、ω（ｔ）を観測量とするシステム方程式と観測方程式を作成する。
Ｓ２：拡張カルマンフィルタを用いてαドット（ｔ）の推定値を求める。
Ｓ３：この推定値を数値積分することによりα（ｔ）の推定値を求める。
Ｓ４：この推定値に基づき変換マトリクスＲ（ｔ）を決定する。
Ｓ５：変換マトリクスＲ（ｔ）に基づき時刻ｔにおける姿勢の推定値を求める。
【００２９】
修正ロドリゲスパラメータを用いることにより、システム方程式と観測方程式を生成することができ、人工衛星の姿勢推定に拡張カルマンフィルタを適用することができた。これによりドリフトの影響を軽減することができ、レートジャイロのみにより高精度な姿勢推定が可能になったのである。従来の手法ではシステム方程式と観測方程式を生成することができず、人工衛星の姿勢推定に拡張カルマンフィルタを適用することができなかった。
【００３０】
次に理論について説明する。
［理論］
１．任意の軸周りのベクトルの回転
あるベクトルｘが任意の軸の周りを角度θだけ回転させた場合を考える。軸方向の単位ベクトルをｅ、回転後のベクトルをｘ'とする。ここで次の式が成立する。
【００３１】
【数１７】
【００３２】
【数１８】
【００３３】
【数１９】
【００３４】
【数２０】
【００３５】
【数２１】
【００３６】
【数２２】
したがって、時刻ｔ0における軸の向きと時刻ｔにおける変換マトリクスＲが分かれば、そのｔにおける軸の向き、すなわち姿勢が分かる。
【００３８】
２．システム方程式
３次元空間の基底ベクトルをｃ1，ｃ2，ｃ3とし、この３つのベクトルがある角速度ベクトル
【００３９】
【数２３】
【００４０】
【数２４】
(2.2.2)式をマトリックス表現でひとつの式にまとめると
【００４１】
【数２５】
【００４２】
【数２６】
【００４３】
【数２７】
３．修正ロドリゲスパラメータの利用とその一階微分方程式
以下のような修正ロドリゲスパラメータ：αとα0を定義する。
【数２８】
すなわち、αは３次元のベクトルである。ｅは回転軸の方向余弦、θは回転軸回りの回転角を表す。(2.2.31)式で定義した修正ロドリゲスパラメータを用いると(2.1.4)式のクォータニオンの要素をαで表現できる。αで表現されるａ、Ｖを使えば、(2.1.5)式の変換マトリクスもαを使って表すことができる。
【００４６】
さらに、αの１階微分方程式を作ることでＲの時間履歴を求められる。αの１階微分方程式は高々３本の連立方程式である。
(2.2.32)式より
【００４７】
【数２９】
【００４８】
【数３０】
【００４９】
【数３１】
【００５０】
【数３２】
【００５１】
【数３３】
［アルゴリズムの詳細］
４．拡張カルマンフィルタへの適用
本発明の実施の形態において、衛星の互いに直交する３軸に取りつけられたレートジャイロから計測された角速度ベクトルω（ｔ）を基に姿勢推定を行う。
具体的には、(2.2.41)式から修正ロドリゲスパラメータα（ｔ）の時間微分αドット（ｔ）の状態量、ω（ｔ）を観測量とするシステム方程式と観測方程式を作成し、拡張カルマンフィルタを用いてαドット（ｔ）の推定値を求める。これを数値積分することによりα（ｔ）の推定値を求め、(2.2.36)式に代入して変換マトリクスＲ（ｔ）を決定し、(2.1.5)式より時刻ｔにおける姿勢の推定値を求める。
【００５３】
この場合、(2.1.5)式の右辺のｘが人工衛星の任意の固定軸をあらわす方向ベクトルの初期値、左辺のｘ'がｔ秒後における固定軸の向きになる。ｘ'とｘのノルムは等しい。
はじめに観測方程式を求める。(2.2.41)式より
【００５４】
【数３４】
【００５５】
【数３５】
次にシステム方程式を求める。(2.2.32)式より
【００５６】
【数３６】
【００５７】
【数３７】
【００５８】
【数３８】
【００５９】
【数３９】
(2.3.6)式は非線型微分方程式なので、システム伝播行列を求めるためには(2.3.5)式を状態量ベクトルで偏微分した行列Ｆを求める必要がある。
【００６０】
【数４０】
【００６１】
【数４１】
［シミュレーション結果］
図３にシミュレーション結果を示す。図３は、観測ノイズ標準偏差＝３×１０−５［rad/sec］のときの機体軸の方向の推定誤差を示す。図３によれば、はじめのうち誤差は時間に比例して増加し、１．２×１０５［sec］で誤差は２．２［deg］に達する。しかし、誤差はその後静定する。本発明の実施の形態によれば、カルマンゲインは速やかなに収束しており、良好に情報の復元を行うことができる。
【００６３】
しかも、図３から明らかなように、本発明の実施の形態によればドリフトは累積せず、誤差は一定範囲内に収まる。これに対し、従来の手法ではドリフトは累積し、誤差が一定範囲内に収まることはなかった。この点で本発明の実施の形態の手法は非常に優れている。
【００６４】
本発明は、以上の実施の形態に限定されることなく、特許請求の範囲に記載された発明の範囲内で、種々の変更が可能であり、それらも本発明の範囲内に包含されるものであることは言うまでもない。
【００６５】
本発明は、人工衛星のみでなく、ジャイロを用いて姿勢を推定するもの全般、すなわち慣性計測装置を用いるものすべてに対して適用でき、精度の向上を保証するものであり、その応用分野は広範囲にわたる。例えば、本発明は、ビデオカメラの手ぶれ防止機能や、カーナビゲーションシステムなどの姿勢推定などに適用できる。
【００６６】
また、本明細書において、手段とは必ずしも物理的手段を意味するものではなく、各手段の機能が、ソフトウェアによって実現される場合も包含する。さらに、一つの手段の機能が、二つ以上の物理的手段により実現されても、若しくは、二つ以上の手段の機能が、一つの物理的手段により実現されてもよい。
【００６７】
【発明の効果】
以上のように、この発明によれば、慣性計測装置の出力のみに基づき高精度な姿勢推定を実現できる。特に、従来問題となっていたドリフトを除去することができる。
【図面の簡単な説明】
【図１】 この発明の実施の形態に係る装置のブロック図である。
【図２】 この発明の実施の形態に係る処理フローチャートである。
【図３】 シミュレーション結果の例である。
【符号の説明】
１ レートジャイロ
２ 初期値設定部
３ カルマンフィルタ
４ 修正ロドリゲスパラメータαの時間微分の推定値の生成部
５ 積分処理部
６ システム伝播行列生成部
７ 変換マトリクス生成部
８ 姿勢推定部
Claims (6)
- 慣性計測装置から状態量ω（ｔ）を受けて予め定められたシステム方程式及び観測方程式に入力するとともに、これらに関して時間更新処理及び観測更新処理を行うカルマンフィルタと、前記カルマンフィルタの出力に基づき修正ロドリゲスパラメータα（ｔ）の時間微分の推定値を生成する処理部と、前記処理部の出力に基づき修正ロドリゲスパラメータの推定値を生成する積分処理部と、予め与えられた初期値及び前記積分処理部の出力に基づき観測感度行列を更新するとともに、その更新出力を前記カルマンフィルタに供給するシステム伝播行列生成部と、前記積分処理部の出力に基づき座標変換行列Ｒを生成する変換マトリクス生成部と、前記変換マトリクス生成部の出力に基づき姿勢推定を行う姿勢推定部とを備える慣性計測装置を用いた姿勢推定装置。
- 前記修正ロドリゲスパラメータは、ｅを回転軸の方向余弦、θを回転軸回りの回転角とするとき、
- 前記観測方程式は、
- 前記システム方程式は，
- 慣性計測装置から信号を受けて修正ロドリゲスパラメータα（ｔ）の時間微分の状態量と状態量ω（ｔ）を観測量とするシステム方程式及び観測方程式を生成する第１ステップと、
拡張カルマンフィルタを用いて前記パラメータα（ｔ）の時間微分の推定値を求める第２ステップと、
前記第２ステップで求められた推定値を数値積分して前記パラメータα（ｔ）の推定値を求める第３ステップと、
前記第３ステップで求められた推定値に基づき変換マトリクスＲ（ｔ）を決定する第４ステップと、
前記変換マトリクスＲ（ｔ）に基づき姿勢の推定値を求めるステップとを備える慣性計測装置を用いた姿勢推定方法。 - コンピュータに、
慣性計測装置から信号を受けて修正ロドリゲスパラメータα（ｔ）の時間微分の状態量と状態量ω（ｔ）を観測量とするシステム方程式及び観測方程式を生成する第１ステップと、
拡張カルマンフィルタを用いて前記パラメータα（ｔ）の時間微分の推定値を求める第２ステップと、
前記第２ステップで求められた推定値を数値積分して前記パラメータα（ｔ）の推定値を求める第３ステップと、
前記第３ステップで求められた推定値に基づき変換マトリクスＲ（ｔ）を決定する第４ステップと、
前記変換マトリクスＲ（ｔ）に基づき姿勢の推定値を求めるステップとを実行させるためのプログラム。
Priority Applications (4)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2001128261A JP3726884B2 (ja) | 2001-04-25 | 2001-04-25 | 慣性計測装置を用いた姿勢推定装置及び方法並びにプログラム |
| US10/476,402 US7248948B2 (en) | 2001-04-25 | 2002-04-24 | Apparatus and method for estimating attitude using inertial measurement equipment |
| EP02724638A EP1382936A4 (en) | 2001-04-25 | 2002-04-24 | DEVICE AND METHOD FOR LAYING ESTIMATION USING VULNERABILITY MEASURING DEVICES AND PROGRAM |
| PCT/JP2002/004103 WO2002088633A1 (fr) | 2001-04-25 | 2002-04-24 | Appareil et procede d'estimation d'attitude utilisant un materiel et un programme de mesure inertielle |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2001128261A JP3726884B2 (ja) | 2001-04-25 | 2001-04-25 | 慣性計測装置を用いた姿勢推定装置及び方法並びにプログラム |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2002323322A JP2002323322A (ja) | 2002-11-08 |
| JP3726884B2 true JP3726884B2 (ja) | 2005-12-14 |
Family
ID=18976988
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2001128261A Expired - Fee Related JP3726884B2 (ja) | 2001-04-25 | 2001-04-25 | 慣性計測装置を用いた姿勢推定装置及び方法並びにプログラム |
Country Status (4)
| Country | Link |
|---|---|
| US (1) | US7248948B2 (ja) |
| EP (1) | EP1382936A4 (ja) |
| JP (1) | JP3726884B2 (ja) |
| WO (1) | WO2002088633A1 (ja) |
Families Citing this family (20)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US7454290B2 (en) * | 2003-09-18 | 2008-11-18 | The Board Of Trustees Of The Leland Stanford Junior University | GPS/INS vehicle attitude system |
| CN101074881B (zh) * | 2007-07-24 | 2011-04-27 | 北京控制工程研究所 | 一种月球探测器软着陆阶段惯性导航方法 |
| TWI384198B (zh) * | 2009-07-09 | 2013-02-01 | Univ Nat Chiao Tung | Angle measurement gyroscope system and angle estimation method |
| US8321076B2 (en) * | 2009-12-18 | 2012-11-27 | The Boeing Company | On-line inertia estimation for use in controlling an aerospace vehicle |
| JP2013064695A (ja) * | 2011-09-20 | 2013-04-11 | Yamaha Corp | 状態推定装置、オフセット更新方法およびオフセット更新プログラム |
| CN103884340B (zh) * | 2014-03-31 | 2016-08-17 | 北京控制工程研究所 | 一种深空探测定点软着陆过程的信息融合导航方法 |
| CN105300379B (zh) * | 2015-10-13 | 2017-12-12 | 上海新纪元机器人有限公司 | 一种基于加速度的卡尔曼滤波姿态估计方法及系统 |
| CN105253330B (zh) * | 2015-10-30 | 2017-04-05 | 中国空间技术研究院 | 一种基于优化的信息融合geo卫星控制系统菜单式设计方法 |
| CN106014570A (zh) * | 2016-05-09 | 2016-10-12 | 黄安武 | 处理汽车尾气中一氧化碳的方法及系统 |
| CN106527457B (zh) * | 2016-11-17 | 2019-04-19 | 天津津航技术物理研究所 | 航空扫描仪扫描控制指令规划方法 |
| US20210404811A1 (en) * | 2017-04-21 | 2021-12-30 | Shanghai Jiao Tong University | Method for solving attitude of rigid body based on function iterative integration |
| CN107738254B (zh) * | 2017-08-25 | 2019-12-24 | 中国科学院光电研究院 | 一种机械臂坐标系的转换标定方法与系统 |
| CN107831775B (zh) * | 2017-11-14 | 2021-06-08 | 哈尔滨工业大学深圳研究生院 | 基于挠性航天器无角速度测量的姿态控制方法 |
| US20220282974A1 (en) * | 2018-03-21 | 2022-09-08 | Shanghai Jiao Tong University | Method and system for solving rigid body attitude based on functional iterative integration |
| CN108536164B (zh) * | 2018-03-23 | 2021-10-08 | 哈尔滨工业大学深圳研究生院 | 挠性航天器无角速度测量的姿态控制方法 |
| CN110598370B (zh) * | 2019-10-18 | 2023-04-14 | 太原理工大学 | 基于sip和ekf融合的多旋翼无人机鲁棒姿态估计 |
| CN112527119B (zh) * | 2020-12-22 | 2022-05-27 | 南京航空航天大学 | 一种手势位姿数据处理方法及存储介质 |
| CN113029138B (zh) * | 2021-04-02 | 2022-09-06 | 扬州大学 | 一种基于多传感器数据融合的小车实时姿态检测方法 |
| CN115307642A (zh) * | 2022-08-04 | 2022-11-08 | 北京百度网讯科技有限公司 | 车辆位置姿态数据的确定方法、装置及电子设备 |
| CN115507845B (zh) * | 2022-10-18 | 2023-07-25 | 闽江学院 | 一种顾及虚拟观测值的卫星姿态融合估计方法 |
Family Cites Families (15)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH06229722A (ja) * | 1993-02-01 | 1994-08-19 | Kinoshita Denshi Kogyo Kk | 光学的測長法及び光学的測長器 |
| JPH06229772A (ja) | 1993-02-04 | 1994-08-19 | Hitachi Ltd | 積分型センシング装置 |
| US5543804A (en) * | 1994-09-13 | 1996-08-06 | Litton Systems, Inc. | Navagation apparatus with improved attitude determination |
| JPH0914962A (ja) | 1995-06-28 | 1997-01-17 | Komatsu Ltd | 建設車両の位置計測装置 |
| US5757316A (en) * | 1997-02-01 | 1998-05-26 | Litton Systems, Inc. | Attitude determination utilizing an inertial measurement unit and a plurality of satellite transmitters |
| JPH11129997A (ja) | 1997-11-04 | 1999-05-18 | Mitsubishi Electric Corp | 人工衛星の姿勢制御装置 |
| US6205400B1 (en) * | 1998-11-27 | 2001-03-20 | Ching-Fang Lin | Vehicle positioning and data integrating method and system thereof |
| US6298288B1 (en) * | 1998-12-16 | 2001-10-02 | Hughes Electronics Corp. | Autonomous gyro scale factor and misalignment calibration |
| US6272432B1 (en) * | 1999-05-10 | 2001-08-07 | Hughes Electronics Corporation | System and method for correcting star tracker low spatial frequency error in stellar-inertial attitude determination systems |
| GB2368218B (en) * | 2000-06-01 | 2004-04-28 | Furuno Electric Co | System for determining the heading and/or attitude of a body |
| US6496778B1 (en) * | 2000-09-14 | 2002-12-17 | American Gnc Corporation | Real-time integrated vehicle positioning method and system with differential GPS |
| US6427122B1 (en) * | 2000-12-23 | 2002-07-30 | American Gnc Corporation | Positioning and data integrating method and system thereof |
| US6424914B1 (en) * | 2000-12-26 | 2002-07-23 | American Gnc Corporation | Fully-coupled vehicle positioning method and system thereof |
| GB2391732B (en) * | 2002-05-16 | 2005-09-07 | Furuno Electric Co | Attitude sensing apparatus for determining the attitude of a mobile unit |
| US7193559B2 (en) * | 2003-01-21 | 2007-03-20 | Novatel, Inc. | Inertial GPS navigation system with modified kalman filter |
-
2001
- 2001-04-25 JP JP2001128261A patent/JP3726884B2/ja not_active Expired - Fee Related
-
2002
- 2002-04-24 WO PCT/JP2002/004103 patent/WO2002088633A1/ja not_active Application Discontinuation
- 2002-04-24 US US10/476,402 patent/US7248948B2/en not_active Expired - Fee Related
- 2002-04-24 EP EP02724638A patent/EP1382936A4/en not_active Withdrawn
Also Published As
| Publication number | Publication date |
|---|---|
| EP1382936A1 (en) | 2004-01-21 |
| US20040176881A1 (en) | 2004-09-09 |
| WO2002088633A1 (fr) | 2002-11-07 |
| JP2002323322A (ja) | 2002-11-08 |
| US7248948B2 (en) | 2007-07-24 |
| EP1382936A4 (en) | 2005-11-02 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3726884B2 (ja) | 慣性計測装置を用いた姿勢推定装置及び方法並びにプログラム | |
| JP3947531B2 (ja) | 加速度誤差の補正方法及び装置、並びにそれを利用した慣性航法システム | |
| EP1585939B1 (en) | Attitude change kalman filter measurement apparatus and method | |
| CN105300379B (zh) | 一种基于加速度的卡尔曼滤波姿态估计方法及系统 | |
| CN107618678B (zh) | 卫星姿态角度偏差下的姿控信息联合估计方法 | |
| JP6255924B2 (ja) | センサー用ｉｃ、センサーデバイス、電子機器及び移動体 | |
| US20100114517A1 (en) | Method and system for orientation sensing | |
| JP2012173190A (ja) | 測位システム、測位方法 | |
| CA2477677C (en) | Autonomous velocity estimation and navigation | |
| JP7025215B2 (ja) | 測位システム及び測位方法 | |
| CN110887480A (zh) | 基于mems传感器的飞行姿态估计方法及系统 | |
| US20230366680A1 (en) | Initialization method, device, medium and electronic equipment of integrated navigation system | |
| CN106370178A (zh) | 移动终端设备的姿态测量方法及装置 | |
| US11150090B2 (en) | Machine learning zero-rate level calibration | |
| US20240159539A1 (en) | Method for assisting with the navigation of a vehicle | |
| JP2015094631A (ja) | 位置算出装置及び位置算出方法 | |
| CN115033844A (zh) | 一种无人机状态估计方法、系统、设备及可读存储介质 | |
| CN114323007A (zh) | 一种载体运动状态估计方法及装置 | |
| JP2006038650A (ja) | 姿勢計測方法、姿勢制御装置、方位計及びコンピュータプログラム | |
| CN113432612A (zh) | 飞行体的导航方法、装置及系统 | |
| CN115839726B (zh) | 磁传感器和角速度传感器联合标定的方法、系统及介质 | |
| KR20060030188A (ko) | 동적 장치 제어 방법 및 그 장치 | |
| CN107228672B (zh) | 一种适用于姿态机动工况下的星敏和陀螺数据融合方法 | |
| US20200400704A1 (en) | Method and apparatus with posture estimation | |
| CN113049005A (zh) | Gnss位置法辅助dvl误差标定方法及系统 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| 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: 20050908 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20050920 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20081007 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091007 Year of fee payment: 4 |
|
| LAPS | Cancellation because of no payment of annual fees |