Я не знаю, как рассчитать матрицу вращения из кватерниона в Unity.
Общая матрица вращения рассчитывается следующим образом:
http://www.utdallas.edu/~sxb027100/dock/quaternion.html
Ниже приведен код wxmaxima.
l: matrix([w, z, -y, x], [-z, w, x, y], [y, -x, w, z], [-x, -y, -z, w]);
r: matrix([w, z, -y, -x], [-z, w, x, -y], [y, -x, w, -z], [x, y, z, w]);
lr: l . r;
Фокусируясь на оси z (0, 0, 1) в общей матрице вращения, это следующая формула.
2xz-2wy
2yz+2wx
w^2-x^2-y^2+z^2=1-2x^2-2y^2
В Unity это следующая формула.
2xz+2wy
2yz-2wx
1-2x^2+2y^2
Какая разница выше?
Ниже приведен код ссылки в Unity.
public static Vector3 operator *(Quaternion rotation, Vector3 point)
{
float num1 = rotation.x * 2f;
float num2 = rotation.y * 2f;
float num3 = rotation.z * 2f;
float num4 = rotation.x * num1;
float num5 = rotation.y * num2;
float num6 = rotation.z * num3;
float num7 = rotation.x * num2;
float num8 = rotation.x * num3;
float num9 = rotation.y * num3;
float num10 = rotation.w * num1;
float num11 = rotation.w * num2;
float num12 = rotation.w * num3;
Vector3 vector3;
vector3.x = (float) ((1.0 - ((double) num5 + (double) num6)) * (double) point.x + ((double) num7 - (double) num12) * (double) point.y + ((double) num8 + (double) num11) * (double) point.z);
vector3.y = (float) (((double) num7 + (double) num12) * (double) point.x + (1.0 - ((double) num4 + (double) num6)) * (double) point.y + ((double) num9 - (double) num10) * (double) point.z);
vector3.z = (float) (((double) num8 - (double) num11) * (double) point.x + ((double) num9 + (double) num10) * (double) point.y + (1.0 - ((double) num4 + (double) num5)) * (double) point.z);
return vector3;
}
https://github.com/jamesjlinden/unity-decompiled/blob/96fb16e2eb6fff1acf3d4e25fa713defb3d17999/UnityEngine/UnityEngine/Quaternion.cs