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

Custom Variable Mass 6DOF (Euler Angles)

カスタム可変質量の6自由度運動方程式のオイラー角表現を実装する

• 

×

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

説明

Custom Variable Mass 6DOF (Euler Angles) ブロックは、カスタム可変質量の 6 自由度の運動方程式のオイラー角表現を実装します。これは、平面地球基準フレーム (X_e, Y_e, Z_e) を中心とした物体固定座標フレーム (X_b, Y_b, Z_b) の回転を考慮します。オイラー角の詳細については、アルゴリズム を参照してください。

制限

ブロックは、加えられた力が体の重心に作用することを前提としています。

端子

入力

F_xyz — 適用される力

3 要素ベクトル

適用される力。3 要素ベクトルとして指定されます。

データ型: double

M_xyz — 応用モーメント

3 要素ベクトル

適用されたモーメント。3 要素ベクトルとして指定されます。

データ型: double

dm/dt — 質量の変化率

3 要素ベクトル

3 要素ベクトルとして指定された、1 つ以上の質量変化率 (集積の場合は正、アブレーションの場合は負)。

依存関係

このポートを有効にするには、Include mass flow relative velocity を選択します。

データ型: double

m — 質量

スカラー

スカラーとして指定された質量。

データ型: double

dI/dt — 慣性テンソル行列の変化率

3 行 3 列の行列

慣性テンソル行列の変化率。3 行 3 列の行列として指定されます。

データ型: double

I — 慣性テンソル行列

3 行 3 列の行列

慣性テンソル行列。3 行 3 列の行列として指定されます。

データ型: double

V_re — 相対速度

3 要素ベクトル

物体固定軸において物体に質量が付加されるか物体から質量が除去される 1 つ以上の相対速度。3 要素ベクトルとして指定されます。

依存関係

このポートを有効にするには、Include mass flow relative velocity を選択します。

データ型: double

出力

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

3 要素ベクトル

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

データ型: double

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

3 要素ベクトル

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

データ型: double

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

3 要素ベクトル

オイラー回転角度 [ロール、ピッチ、ヨー] は、ラジアン単位の 3 要素ベクトルとして返されます。

データ型: 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 — 質量タイプ

Custom Variable (既定値) | Simple 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)

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

プログラムでの使用

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

型: 文字ベクトル

値: Fixed | Simple Variable | Custom Variable

既定値: 'Custom Variable'

表現 — 運動方程式の表現

Euler Angles (既定値) | Quaternion

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

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

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

プログラムでの使用

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

型: 文字ベクトル

値: Euler Angles | Quaternion

既定値: 'Euler Angles'

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]'

Include mass flow relative velocity — 質量流量相対速度ポート

off (既定値) | on

質量流量相対速度ポートを追加するには、このチェックボックスをオンにします。これは、質量が増加または減少する相対速度です。

プログラムでの使用

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

型: 文字ベクトル

値: off | on

既定値: off

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

型: 文字ベクトル

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

既定値: ''

Euler rotation angles: e.g., {'phi', 'theta', 'psi'} — オイラー回転状態名

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

オイラー回転角度の状態名。中括弧で囲まれたコンマ区切りのリストとして指定されます。

プログラムでの使用

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

型: 文字ベクトル

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

既定値: ''

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

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

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

プログラムでの使用

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

型: 文字ベクトル

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

既定値: ''

アルゴリズム

物体固定座標系の原点は物体の重心です。物体は剛体であると想定されるため、個々の質量要素間に作用する力を考慮する必要がありません。平面地球の基準フレームは慣性であると考えられており、これは「恒星」に対する地球の運動による力を無視できる優れた近似です。

ボディ固定座標系の並進運動は以下のように表されます。ここで、適用された力 [F_x F_y F_z]^T はボディ固定座標系内にあります。Vre_b は、質量流量 ($$\dot{m}$$) がボディ固定軸から排出または追加されるボディ軸内の相対速度です。

$$\begin{array}{l}{\overline{F}}_b=\left[\begin{array}{c}{F}_x\\ F_y\\ F_z\end{array}\right]=m({\dot{\overline{V}}}_b+\overline{\omega }\times {\overline{V}}_b)-\dot{m}\overline{V}r{e}_b\\ A_{be}=\frac{{\overline{F}}_b+\dot{m}{\overline{V}}_{r{e}_b}}{m}\\ A_{bb}=\left[\begin{array}{c}{\dot{u}}_b\\ {\dot{v}}_b\\ {\dot{w}}_b\end{array}\right]=\frac{{\overline{F}}_b+\dot{m}{\overline{V}}_{r{e}_b}}{m}-\overline{\omega }\times {\overline{V}}_b\\ {\overline{V}}_b=\left[\begin{array}{c}{u}_b\\ v_b\\ w_b\end{array}\right],\overline{\omega }=\left[\begin{array}{c}p\\ q\\ r\end{array}\right]\end{array}$$

物体固定フレームの回転ダイナミクスは以下のように示され、適用されるモーメントは[L M N]^Tであり、慣性テンソルIは原点Oに対してである。

$$\begin{array}{l}{\overline{M}}_B=\left[\begin{array}{c}L\\ M\\ N\end{array}\right]=I\dot{\overline{\omega }}+\overline{\omega }\times (I\overline{\omega })+\dot{I}\overline{\omega }\\ \\ I=\left[\begin{array}{ccc}{I}_{xx}& -I_{xy}& -I_{xz}\\ -I_{yx}& I_{yy}& -I_{yz}\\ -I_{zx}& -I_{zy}& I_{zz}\end{array}\right]\\ \\ \dot{I}=\left[\begin{array}{ccc}{\dot{I}}_{xx}& -{\dot{I}}_{xy}& -{\dot{I}}_{xz}\\ -{\dot{I}}_{yx}& {\dot{I}}_{yy}& -{\dot{I}}_{yz}\\ -{\dot{I}}_{zx}& -{\dot{I}}_{zy}& {\dot{I}}_{zz}\end{array}\right]\end{array}$$

物体固定角速度ベクトル [p q r]^T とオイラー角の変化率 $${[\dot{\varphi }\dot{\theta }\dot{\psi }]}^{\text{T}}$$ の関係は、オイラー角の速度を物体固定座標系に分解することで決定できます。

$$\left[\begin{array}{c}p\\ q\\ r\end{array}\right]=\left[\begin{array}{c}\dot{\varphi }\\ 0\\ 0\end{array}\right]+\left[\begin{array}{ccc}1& 0& 0\\ 0& \cos \varphi & \sin \varphi \\ 0& -\sin \varphi & \cos \varphi \end{array}\right]\left[\begin{array}{c}0\\ \dot{\theta }\\ 0\end{array}\right]+\left[\begin{array}{ccc}1& 0& 0\\ 0& \cos \varphi & \sin \varphi \\ 0& -\sin \varphi & \cos \varphi \end{array}\right]\left[\begin{array}{ccc}\cos \theta & 0& -\sin \theta \\ 0& 1& 0\\ \sin \theta & 0& \cos \theta \end{array}\right]\left[\begin{array}{c}0\\ 0\\ \dot{\psi }\end{array}\right]=J^{-1}\left[\begin{array}{c}\dot{\varphi }\\ \dot{\theta }\\ \dot{\psi }\end{array}\right]$$

J を反転すると、オイラー速度ベクトルを決定するために必要な関係が得られます。

$$\left[\begin{array}{c}\dot{\varphi }\\ \dot{\theta }\\ \dot{\psi }\end{array}\right]=J\left[\begin{array}{c}p\\ q\\ r\end{array}\right]=\left[\begin{array}{ccc}1& (\sin \varphi \tan \theta )& (\cos \varphi \tan \theta )\\ 0& \cos \varphi & -\sin \varphi \\ 0& \frac{\sin \varphi }{\cos \theta }& \frac{\cos \varphi }{\cos \theta }\end{array}\right]\left[\begin{array}{c}p\\ q\\ r\end{array}\right]$$

航空宇宙座標系の詳細については、航空宇宙座標系について を参照してください。

参照

[1] Stevens, Brian, and Frank Lewis. Aircraft Control and Simulation, 2nd ed. Hoboken, NJ: John Wiley & Sons, 2003.

[2] Zipfel, Peter H. Modeling and Simulation of Aerospace Vehicle Dynamics. 2nd ed. Reston, VA: AIAA Education Series, 2007.

拡張機能

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

バージョン履歴

R2006a で導入

参考

6DOF (Euler Angles) | 6DOF (Quaternion) | 6DOF ECEF (Quaternion) | 6DOF Wind (Quaternion) | 6DOF Wind (Wind 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)

トピック

• 航空宇宙座標系について