このページは機械翻訳を使用して翻訳されました。最新版の英語を参照するには、ここをクリックします。

6DOF (Quaternion)

体軸に関する6自由度の運動方程式の四元数表現を実装する

• 

×

ライブラリ:
Aerospace Blockset / Equations of Motion / 6DOF

説明

6DOF (Quaternion) ブロックは、ボディ軸に関する 6 自由度の運動方程式の四元数表現を実装します。座標系と並進ダイナミクスの説明については、6DOF (Euler Angles) ブロックのブロック説明を参照してください。

四元数ベクトルの変化率の積分の詳細については、アルゴリズム を参照してください。

制限

ブロックは、加えられた力が物体の重心に作用し、質量と慣性が一定であると仮定します。

端子

入力

F_xyz(N) — 適用される力

3 要素ベクトル

適用された力。ボディ固定軸の 3 要素ベクトルとして指定されます。フレームの詳細については、ボディ座標 を参照してください。

データ型: double

M_xyz(N-m) — 応用モーメント

3 要素ベクトル

適用されたモーメント。ボディ固定軸の 3 要素ベクトルとして指定されます。フレームの詳細については、ボディ座標 を参照してください。

データ型: double

出力

V_e — 平面地球基準系における速度

3 要素ベクトル

平面地球基準フレームにおける速度。3 要素ベクトルとして返されます。

データ型: double

X_e — 平面地球基準系における位置

3 要素ベクトル

平面地球基準フレーム内の位置。3 要素のベクトルとして返されます。

データ型: double

φ θ ψ (rad) — オイラー回転角

3 要素ベクトル

固有の x-y-z 回転を定義するオイラー回転角度 [ロール、ピッチ、ヨー] を、ラジアン単位の 3 要素ベクトルとして表します。ヨー、ピッチ、ロール角度は、angle2dcm(yaw,pitch,roll,"ZYX") などの z-y-x 回転シーケンスを使用して適用されます。

データ型: double

DCM_be — 座標の変換

3 行 3 列の行列

平面地球軸から物体固定軸への座標変換。3 行 3 列の行列として返されます。

データ型: double

V_b — 物体固定系における速度

3 要素ベクトル

ボディ固定フレーム内の速度。3 要素ベクトルとして返されます。

データ型: double

ω_b (rad/s) — 物体固定軸の角速度

3 要素ベクトル

ボディ固定軸の角速度。ラジアン/秒単位で 3 要素ベクトルとして返されます。

データ型: double

dω_b/dt — 角加速度

3 要素ベクトル

ボディ固定軸の角加速度。ラジアン/秒の二乗で、3 要素ベクトルとして返されます。

データ型: double

A_bb — ボディ固定軸の加速度

3 要素ベクトル

ボディ座標系に対するボディ固定軸の加速度が 3 要素ベクトルとして返されます。

データ型: double

A_be — 慣性系に対する加速度

3 要素ベクトル

慣性フレーム (平面地球) に対するボディ固定軸の加速度が、3 要素ベクトルとして返されます。通常、この信号を加速度計に接続します。

依存関係

このポートは、Include inertial acceleration チェックボックスが選択されている場合にのみ表示されます。

データ型: double

パラメーター

メイン

単位 — 入力および出力ユニット

Metric (MKS) (既定値) | English (Velocity in ft/s) | English (Velocity in kts)

入力および出力単位。Metric (MKS)、English (Velocity in ft/s)、または English (Velocity in kts) として指定されます。

単位	力	一瞬	加速度	速度	位置	質量	慣性
Metric (MKS)	ニュートン	ニュートンメートル	メートル毎秒	メートル/秒	メートル	キログラム	キログラムメートルの2乗
English (Velocity in ft/s)	ポンド	フットポンド	フィート毎秒平方	フィート/秒	足	スラッグ	スラッグフィートの平方
English (Velocity in kts)	ポンド	フットポンド	フィート毎秒平方	節点	足	スラッグ	スラッグフィートの平方

プログラムでの使用

ブロック パラメーター: units

型: 文字ベクトル

値: Metric (MKS) | English (Velocity in ft/s) | English (Velocity in kts)

既定値: Metric (MKS)

Mass Type — 質量タイプ

固定 (既定値) | Simple Variable | Custom Variable

質量の種類は、次の表に従って指定されます。

質量タイプ	説明	デフォルト
Fixed	質量はシミュレーション全体を通じて一定です。	6DOF (Euler Angles) 6DOF (Quaternion) 6DOF Wind (Wind Angles) 6DOF Wind (Quaternion) 6DOF ECEF (Quaternion)
Simple Variable	質量と慣性は質量速度の関数として直線的に変化します。	Simple Variable Mass 6DOF (Euler Angles) Simple Variable Mass 6DOF (Quaternion) Simple Variable Mass 6DOF Wind (Wind Angles) Simple Variable Mass 6DOF Wind (Quaternion) Simple Variable Mass 6DOF ECEF (Quaternion)
Custom Variable	質量と慣性のバリエーションはカスタマイズ可能です。	Custom Variable Mass 6DOF (Euler Angles) Custom Variable Mass 6DOF (Quaternion) Custom Variable Mass 6DOF Wind (Wind Angles) Custom Variable Mass 6DOF Wind (Quaternion) Custom Variable Mass 6DOF ECEF (Quaternion)

Simple Variable の選択は、前述の運動方程式に準拠します。

プログラムでの使用

ブロック パラメーター: mtype

型: 文字ベクトル

値: Fixed | Simple Variable | Custom Variable

既定値: Simple Variable

表現 — 運動方程式の表現

Quaternion (既定値) | Euler Angles

運動方程式の表現。次の表に従って指定します。

表現	説明
Euler Angles	運動方程式内でオイラー角を使用します。
Quaternion	運動方程式内で四元数を使用します。

Quaternion の選択は、 アルゴリズム の運動方程式に準拠します。

プログラムでの使用

ブロック パラメーター: rep

型: 文字ベクトル

値: Euler Angles | Quaternion

既定値: 'Quaternion'

Initial position in inertial axes [Xe,Ye,Ze] — 慣性軸の位置

[0 0 0] (既定値) | 3 要素ベクトル

平面地球基準フレームにおける物体の初期位置。3 要素ベクトルとして指定されます。

プログラムでの使用

ブロック パラメーター: xme_0

型: 文字ベクトル

値: '[0 0 0]' | 3 要素ベクトル

既定値: '[0 0 0]'

Initial velocity in body axes [U,v,w] — 体軸の速度

[0 0 0] (既定値) | 3 要素ベクトル

ボディ固定座標フレーム内の 3 要素ベクトルとして指定されたボディ軸の初期速度。

プログラムでの使用

ブロック パラメーター: Vm_0

型: 文字ベクトル

値: '[0 0 0]' | 3 要素ベクトル

既定値: '[0 0 0]'

Initial Euler orientation [roll, pitch, yaw] — 初期オイラー方向

[0 0 0] (既定値) | 3 要素ベクトル

初期のオイラー方向角度 [ロール、ピッチ、ヨー]。ラジアン単位で 3 要素ベクトルとして指定されます。オイラー回転角は、物体座標系と北東下 (NED) 座標系間の回転角です。

プログラムでの使用

ブロック パラメーター: eul_0

型: 文字ベクトル

値: '[0 0 0]' | 3 要素ベクトル

既定値: '[0 0 0]'

Initial body rotation rates [p,q,r] — 初期の体の回転

[0 0 0] (既定値) | 3 要素ベクトル

NED フレームに対する初期のボディ固定角速度。ラジアン/秒単位で 3 要素ベクトルとして指定されます。

プログラムでの使用

ブロック パラメーター: pm_0

型: 文字ベクトル

値: '[0 0 0]' | 3 要素ベクトル

既定値: '[0 0 0]'

Initial mass — 初期質量

1.0 (既定値) | スカラー

剛体の初期質量。double スカラーとして指定されます。

プログラムでの使用

ブロック パラメーター: mass_0

型: 文字ベクトル

値: '1.0' | ダブルスカラー

既定値: '1.0'

Inertia — 慣性

eye(3) (既定値) | スカラー

物体の慣性。二重スカラーとして指定されます。

依存関係

このパラメータを有効にするには、Mass type を Fixed に設定します。

プログラムでの使用

ブロック パラメーター: inertia

型: 文字ベクトル

値: eye(3) | ダブルスカラー

既定値: eye(3)

Gain for quaternion normalization — Gain

1.0 (既定値) | スカラー

四元数ベクトルのノルムを 1.0 に維持するためのゲイン。double スカラーとして指定されます。

プログラムでの使用

ブロック パラメーター: k_quat

型: 文字ベクトル

値: 1.0 | ダブルスカラー

既定値: 1.0

Include inertial acceleration — 慣性加速ポートを含む

off (既定値) | on

慣性加速ポートを追加するには、このチェックボックスをオンにします。

依存関係

A_{b ff} ポートを有効にするには、このパラメータを選択します。

プログラムでの使用

ブロック パラメーター: abi_flag

型: 文字ベクトル

値: 'off' | 'on'

既定値: off

状態属性

各状態に固有名を割り当てます。線形化中にブロック パスの代わりに状態名を使用できます。

• 単一の状態に名前を割り当てるには、引用符で囲んだ一意の名前を入力します (例: 'velocity')。

• 複数の状態に名前を割り当てるには、中括弧で囲んだコンマ区切りのリストを入力します (例: {'a', 'b', 'c'})。各名前は固有でなければなりません。

• パラメータが空の場合 (' ')、名前は割り当てられません。

• 状態名は、名前パラメータで選択されたブロックにのみ適用されます。

• 状態の数は状態名の数で割り切れなければなりません。

• 指定する名前の数は状態の数より少なくできますが、その逆はできません。

  たとえば、4 つの状態を含むシステムで 2 つの名前を指定することは可能です。最初の名前は最初の 2 つの状態に適用され、2 番目の名前は最後の 2 つの状態に適用されます。

• MATLAB^® ワークスペース内の変数を状態名に割り当てる場合は、引用符なしで変数を入力します。変数には文字ベクトル、cell 配列、構造体が使用できます。

Position: e.g., {'Xe', 'Ye', 'Ze'} — ポジション状態名

'' (既定値) | 中括弧で囲まれたカンマ区切りのリスト

位置状態名。中括弧で囲まれたコンマ区切りのリストとして指定されます。

プログラムでの使用

ブロック パラメーター: xme_statename

型: 文字ベクトル

値: '' | 中括弧で囲まれたコンマ区切りのリスト

既定値: ''

Velocity: e.g., {'U', 'v', 'w'} — 速度状態名

'' (既定値) | 中括弧で囲まれたカンマ区切りのリスト

速度状態名。中括弧で囲まれたコンマ区切りのリストとして指定されます。

プログラムでの使用

ブロック パラメーター: Vm_statename

型: 文字ベクトル

値: '' | 中括弧で囲まれたコンマ区切りのリスト

既定値: ''

Quaternion vector: e.g., {'qr', 'qi', 'qj', 'qk'} — クォータニオンベクトル状態名

'' (既定値) | 中括弧で囲まれたカンマ区切りのリスト

四元数ベクトルの状態名。中括弧で囲まれたコンマ区切りのリストとして指定されます。

プログラムでの使用

ブロック パラメーター: quat_statename

型: 文字ベクトル

値: '' | 中括弧で囲まれたコンマ区切りのリスト

既定値: ''

Body rotation rates: e.g., {'p', 'q', 'r'} — 体の回転状態名

'' (既定値) | 中括弧で囲まれたカンマ区切りのリスト

ボディの回転速度の状態名。中括弧で囲まれたコンマ区切りのリストで指定します。

プログラムでの使用

ブロック パラメーター: pm_statename

型: 文字ベクトル

値: '' | 中括弧で囲まれたコンマ区切りのリスト

既定値: ''

アルゴリズム

四元数ベクトルの変化率の積分は以下のように示されます。ゲイン K は、$$\epsilon$$ がゼロ以外になった場合に、四元数状態ベクトルのノルムを 1.0 にします。このゲインの値は慎重に選択する必要があります。値が大きいと、ノルムのエラーの減衰率が向上しますが、高速ダイナミクスが導入されるため、シミュレーションが遅くなります。四元数ベクトルの 1 つの要素の大きさの誤差はすべての要素に均等に分散され、状態ベクトルの誤差が増加する可能性があります。

$$\begin{array}{l}\left[\begin{array}{c}{\dot{q}}_0\\ {\dot{q}}_1\\ {\dot{q}}_2\\ {\dot{q}}_3\end{array}\right]=\raisebox{1ex}{$1$}\!\left/ \!\raisebox{-1ex}{$2$}\right.\left[\begin{array}{cccc}0& -p& -q& -r\\ p& 0& r& -q\\ q& -r& 0& p\\ r& q& -p& 0\end{array}\right]\left[\begin{array}{c}{q}_0\\ q_1\\ q_2\\ q_3\end{array}\right]+K\epsilon \left[\begin{array}{c}{q}_0\\ q_1\\ q_2\\ q_3\end{array}\right]\\ \epsilon =1-\left(q_0^2+q_1^2+q_2^2+q_3^2\right)\end{array}$$

Aerospace Blockset™ は、スカラー優先規則を使用して定義された四元数を使用します。

拡張機能

C/C++ コード生成
Simulink® Coder™ を使用して C および C++ コードを生成します。

バージョン履歴

R2006a で導入

参考

6DOF (Euler Angles) | 6DOF ECEF (Quaternion) | 6DOF Wind (Quaternion) | 6DOF Wind (Wind Angles) | Custom Variable Mass 6DOF (Euler Angles) | Custom Variable Mass 6DOF (Quaternion) | Custom Variable Mass 6DOF ECEF (Quaternion) | Custom Variable Mass 6DOF Wind (Quaternion) | Custom Variable Mass 6DOF Wind (Wind Angles) | Simple Variable Mass 6DOF (Euler Angles) | Simple Variable Mass 6DOF (Quaternion) | Simple Variable Mass 6DOF ECEF (Quaternion) | Simple Variable Mass 6DOF Wind (Quaternion) | Simple Variable Mass 6DOF Wind (Wind Angles)