Skip to content
検索結果に戻る

クォータニオン姿勢

提唱者
William Hamilton (quaternions), aerospace engineers
年
1843
種類
Mathematical framework
系統
Representation

この文章は機械翻訳で、まだ確認されていません。 英語の原文を読む

文字サイズ

何をする手法か?

クォータニオン姿勢表現は、4次元ベクトル(クォータニオン)を用いて3次元回転を記述するための数学的枠組みである。特異点(ジンバルロック)が存在しない点でオイラー角よりも優れており、現代の姿勢推定、宇宙船制御、3Dコンピュータグラフィックスにおける標準的な表現となっている。クォータニオン運動学は、ジャイロスコープからの角速度測定下で姿勢がどのように進化するかをエレガントに表現する。

手法の背後にある直感

クォータニオンは、回転軸周りの回転を表す4要素ベクトル q = [q0, q1, q2, q3] または q = [q_スカラー, q_ベクトル] である。オイラー角(ロール、ピッチ、ヨー)とは異なり、特定の角度で特異または曖昧になる可能性があるクォータニオンは、どこでも滑らかである。クォータニオンは、回転軸と角度を自然に組み合わせ、クォータニオンの乗算は回転の合成に対応する。

歴史学

クォータニオンは1843年にウィリアム・ハミルトンによって複素数の一般化として発明された。レオンハルト・オイラーはそれ以前にクォータニオン様の表現を使用していた。クォータニオンは20世紀に再発見され、剛体ダイナミクスに応用された。航空宇宙分野では、宇宙船の姿勢決定がグローバルで特異点のない表現を必要としたアポロ計画以降、クォータニオンが標準となった。現代のIMU、ゲームエンジン、ロボット工学はすべてクォータニオンを使用している。

使うべき場面

連続的で特異点のない姿勢表現が必要な場合は常にクォータニオン表現を使用する。航空機制御システム、IMU処理、宇宙船姿勢決定には必須である。すべての最新のナビゲーションおよび制御システムに展開する。リアルタイム姿勢伝播およびセンサー融合に使用する。ジンバルロックのリスクがあるため、制御ループでのオイラー角の使用は避ける。

限界と注意点

  • 二重被覆。2つのクォータニオン(q と -q)が同じ回転を表す。符号の連続性を追跡する必要がある。
  • 直感的でない。クォータニオンは抽象的であり、エンジニアは視覚化と直感のためにオイラー角に変換する必要がある。
  • 積分における運動学的特異点。dq/dt = 0.5 q ⊗ ω による伝播は、単位ノルムを維持するために注意深い数値積分を必要とする。
  • 軸角解釈における曖昧さ。角度が 0 または 2π に近い場合、回転軸が一意ではない。

出典に示された条件は、独立した科学的レビューや分析エンジンによる検証の代わりにはなりません。

強み

  • 特異点がない。クォータニオンはジンバルロックを回避し、数学的な破綻なしにあらゆる向きの姿勢を表現できる。
  • 効率的な計算。クォータニオンの乗算は行列演算よりも高速であり、リアルタイム制御に適している。
  • 正規化された表現。単位クォータニオンの制約は自然であり、回転行列のようなユークリッド正規化の必要がない。
  • 滑らかな補間。クォータニオンの球面線形補間(SLERP)は、キーフレーム間の滑らかな姿勢補間を提供する。

応用

  • 宇宙船姿勢決定:ジンバルロックなしでの衛星および宇宙船の向きの表現。
  • 航空機オートパイロットおよび飛行制御:航空機姿勢調整および経路追跡のためのクォータニオンベースの制御則。
  • 慣性計測ユニット(IMU)処理:ジャイロスコープ測定値のクォータニオン姿勢推定値への積分。
  • 3Dコンピュータグラフィックスおよびゲームエンジン:アニメーションのための滑らかな回転表現と補間。
  • ロボット工学および自律走行車:ナビゲーションおよび運動計画のための向き追跡。

使い方

使い方

1

姿勢をクォータニオン q = [q0, q1, q2, q3] として指定する。ここで、q0 はスカラー成分、[q1, q2, q3] はベクトル部分である。単位ノルム(q0^2 + q1^2 + q2^2 + q3^2 = 1)を保証すること。

2

必要に応じてクォータニオンを正規化し、表示に必要な表現(オイラー角、回転行列)間で変換する。

3

運動学方程式 dq/dt = 0.5 * q ⊗ ω を用いてクォータニオンを時間方向に伝播させる。ここで ω は角速度であり、数値積分を行う。

数式
\dot{\vec{q}} = \frac{1}{2}\vec{q} \otimes \vec{\omega}
4

ジャイロスコープからの新しい角速度測定値を用いてクォータニオンを更新する。他のセンサーを融合する場合は、フィルター(カルマン、相補フィルター)を適用する。

5

パイロットディスプレイのためにクォータニオンをオイラー角(ロール、ピッチ、ヨー)に変換する。制御則とダイナミクスにはクォータニオンを直接使用する。姿勢の信頼性を評価する。

よくある落とし穴

  • クォータニオンの正規化を忘れる。数値ドリフトが誤差の蓄積を引き起こすため、定期的な正規化が不可欠である。
  • クォータニオン乗算の順序誤り。q1 ⊗ q2 ≠ q2 ⊗ q1 (非可換)であり、合成において順序が重要である。
  • クォータニオン共役と逆元の混同。単位クォータニオンの場合、逆元 = 共役であるが、これは非単位クォータニオンには当てはまらない。
  • フィルタリングにおける二重被覆(q vs. -q)の処理漏れ。フィルタが符号を追跡しない場合、不連続性が発生するため、連続的なクォータニオンパスを保証する必要がある。

よくある質問

クォータニオンと回転行列の違いは何ですか?

クォータニオン q = [q0, q1, q2, q3] は4要素表現であり、回転行列 R は3x3直交行列である。どちらも同じ回転を表す。クォータニオンの乗算は高速(16演算 vs. 行列乗算の27演算)であり、クォータニオンはよりコンパクト(4要素 vs. 9要素)である。それらの間の変換は容易である。

なぜ q と -q は同じ回転を表すのですか?

単位クォータニオン q = [cos(θ/2), sin(θ/2) * n] は、軸 n 周りの角度 θ の回転を表す。クォータニオン -q = [-cos(θ/2), -sin(θ/2) * n] も同じ回転を表す(どちらも同じ回転行列を生成する)。この二重被覆は、フィルタリングにおいて連続性を維持すること(符号の反転を避けること)によって処理される。

クォータニオン運動学をどのように積分しますか?

dq/dt = 0.5 * q ⊗ ω_body を使用する。ここで ω_body は機体座標系での角速度である。オイラー法、RK4、または他の積分器を用いて数値積分を行う。重要なのは、各ステップ後にクォータニオンを再正規化して単位ノルム(||q|| = 1)を維持することである。あるいは、より高精度な指数写像積分を使用する。

クォータニオンからオイラー角へはどうやって変換しますか?

クォータニオン q = [q0, q1, q2, q3] からオイラー角(ロール φ、ピッチ θ、ヨー ψ)への変換には、アークタンジェント関数が含まれる。公式は角度の規約(ZYX、XYZなど)によって異なる。変換においてジンバルロック特異点(θ = ±90°)に注意すること。特異点付近では、制御のためにクォータニオンを直接使用する。

関連する手法

参考文献

  1. Shuster, M. D. (1993). A survey of attitude representations. Journal of the Astronautical Sciences, 41(4), 439–517.

    出版物の文献を開く
    コピーしました。
  2. Titterton, D. H., & Weston, J. L. (2004). Strapdown Inertial Navigation Technology (2nd ed.). Institution of Engineering and Technology.

    DOI 文献を開く
    コピーしました。
  3. Savage, P. G. (2000). Strapdown inertial navigation integration algorithm design. Part 1: Attitude algorithms. Journal of Guidance, Control, and Dynamics, 21(1), 19–28.

    DOI 文献を開く
    コピーしました。