2つのvector3Dから3つのオイラー角を取得するにはどうすればよいですか?
ありがとう
セドレ
dim vector1 = new Vector3D(0, 0, 1);
dim vector2 = new Vector3D(0.33, 0.45, 0.49);
dim myEuler = GetEulerFrom2Vector(vector1,vector2); // ?????
私は直角座標系で作業しており、ZYXオイラー規則を使用しています
2つのベクトルが互いに垂直であると仮定できますvector1.Dot(vector2)==0
か?はいの場合、座標系を形成するための3番目のベクトルを見つけます
vector1 = vector1.Normalized();
vector2 = vector2.Normalized();
vector3 = VectorCross(vector1,vector2).Normalized();
ここVectorCross
で、は3Dベクトルの外積でありNormalized()
、単位ベクトルを返します。
E
これで、回転行列は次のようになります。
| vector1.x vector2.x vector3.x |
| vector1.y vector2.y vector3.y |
| vector1.z vector2.z vector3.z |
これで、ここの手順を使用して、回転行列からオイラー角に移動できます。
PS。vector2
垂直でない場合は、計算後vector1
に垂直にすることができます。vector2 = CrossProduct(vector3, vector1).Normalized()
vector3
これが、2つの軸から回転行列に移動するために使用するコードです。
public static mat3 AlignZX(vec3 unit_z, vec3 unit_x)
{
unit_x=unit_x.Normalized();
unit_z=unit_z.Normalized();
vec3 unit_y=unit_z.Cross(unit_x);
unit_x=unit_y.Cross(unit_z);
return mat3.Combine(unit_x, unit_y, unit_z);
}
public static mat3 AlignXY(vec3 unit_x, vec3 unit_y)
{
unit_x=unit_x.Normalized();
unit_y=unit_y.Normalized();
vec3 unit_z=unit_x.Cross(unit_y);
unit_y=unit_z.Cross(unit_x);
return mat3.Combine(unit_x, unit_y, unit_z);
}
public static mat3 AlignYZ(vec3 unit_y, vec3 unit_z)
{
unit_y=unit_y.Normalized();
unit_z=unit_z.Normalized();
vec3 unit_x=unit_y.Cross(unit_z);
unit_z=unit_x.Cross(unit_y);
return mat3.Combine(unit_x, unit_y, unit_z);
}
私は回転行列を使用します:
R11 R12 R13
R21 R22 R23
R31 R32 R33
R = RzRyRxの場合
if (R31 <> ±1)
y1 = -sin-1(R31)
y2 = pi + sin-1(R31)
x1 = atan2 (R32/cos y1,R33/cos y1)
x2 = atan2 (R32/cos y2,R33/cos y2)
z1 = atan2( R21/cos y1,R11/cos y1)
z2 = atan2( R21/cos y2,R11/cos y2)
Else
z= anything; can set to 0
if (R31 = -1)
y = -pi / 2
x = z + atan2(R12,R13)
Else
y = -pi / 2
x = -z + atan2(-R12,-R13)
End If
End If
または単純なバージョン
result.X = Math.Atan2(R32, R33) * (180.0 / Math.PI)
result.Y = Math.Atan2(-1 * R31, Math.Sqrt(R32 * R32 + R33 * R33)) * (180.0 / Math.PI)
result.Z = Math.Atan2(R21, R11) * (180.0 / Math.PI)