6自由度シミュレーションの式

モーメント方程式（回転運動方程式）

f:id:seinzumtode:20210518235307p:plain
f:id:seinzumtode:20210518235231p:plain
f:id:seinzumtode:20210519123340p:plain
f:id:seinzumtode:20210519123747p:plain

航法方程式（地球座標上の移動速度）

f:id:seinzumtode:20210518235208p:plain
f:id:seinzumtode:20210519123834p:plain
f:id:seinzumtode:20210519123802p:plain

力の方程式（並進運動方程式）

f:id:seinzumtode:20210518235224p:plain
f:id:seinzumtode:20210519123406p:plain
f:id:seinzumtode:20210519123741p:plain

運動学方程式（姿勢角速度）

f:id:seinzumtode:20210518235217p:plain
f:id:seinzumtode:20210519123438p:plain
f:id:seinzumtode:20210519123756p:plain

関係図
f:id:seinzumtode:20210518235559p:plain