/// <summary>
/// Construct the transform from a binary source
/// </summary>
/// <param name="readBuffer"></param>
/// <param name="index"></param>
public Transform(byte[] readBuffer, ref int index)
{
#if XBOX360
this = new Transform();
#endif
BitCast cast = new BitCast();
cast.Byte0 = readBuffer[index++]; cast.Byte1 = readBuffer[index++]; cast.Byte2 = readBuffer[index++]; cast.Byte3 = readBuffer[index++];
this.Rotation.X = cast.Single;
cast.Byte0 = readBuffer[index++]; cast.Byte1 = readBuffer[index++]; cast.Byte2 = readBuffer[index++]; cast.Byte3 = readBuffer[index++];
this.Rotation.Y = cast.Single;
cast.Byte0 = readBuffer[index++]; cast.Byte1 = readBuffer[index++]; cast.Byte2 = readBuffer[index++]; cast.Byte3 = readBuffer[index++];
this.Rotation.Z = cast.Single;
cast.Byte0 = readBuffer[index++]; cast.Byte1 = readBuffer[index++]; cast.Byte2 = readBuffer[index++]; cast.Byte3 = readBuffer[index++];
this.Rotation.W = cast.Single;
cast.Byte0 = readBuffer[index++]; cast.Byte1 = readBuffer[index++]; cast.Byte2 = readBuffer[index++]; cast.Byte3 = readBuffer[index++];
this.Translation.X = cast.Single;
cast.Byte0 = readBuffer[index++]; cast.Byte1 = readBuffer[index++]; cast.Byte2 = readBuffer[index++]; cast.Byte3 = readBuffer[index++];
this.Translation.Y = cast.Single;
cast.Byte0 = readBuffer[index++]; cast.Byte1 = readBuffer[index++]; cast.Byte2 = readBuffer[index++]; cast.Byte3 = readBuffer[index++];
this.Translation.Z = cast.Single;
cast.Byte0 = readBuffer[index++]; cast.Byte1 = readBuffer[index++]; cast.Byte2 = readBuffer[index++]; cast.Byte3 = readBuffer[index++];
this.Scale = cast.Single;
}
/// <summary>
/// Multiply two transforms
/// </summary>
/// <param name="transform1"></param>
/// <param name="transform2"></param>
/// <param name="result"></param>
public static void Multiply(ref Transform transform1, ref Transform transform2, out Transform result)
{
Quaternion q;
Vector3 t;
float s = transform2.Scale * transform1.Scale;;
if (transform2.Rotation.W == 1 &&
(transform2.Rotation.X == 0 && transform2.Rotation.Y == 0 && transform2.Rotation.Z == 0))
{
q.X = transform1.Rotation.X;
q.Y = transform1.Rotation.Y;
q.Z = transform1.Rotation.Z;
q.W = transform1.Rotation.W;
t.X = transform1.Translation.X;
t.Y = transform1.Translation.Y;
t.Z = transform1.Translation.Z;
}
else
{
float num12 = transform2.Rotation.X + transform2.Rotation.X;
float num2 = transform2.Rotation.Y + transform2.Rotation.Y;
float num = transform2.Rotation.Z + transform2.Rotation.Z;
float num11 = transform2.Rotation.W * num12;
float num10 = transform2.Rotation.W * num2;
float num9 = transform2.Rotation.W * num;
float num8 = transform2.Rotation.X * num12;
float num7 = transform2.Rotation.X * num2;
float num6 = transform2.Rotation.X * num;
float num5 = transform2.Rotation.Y * num2;
float num4 = transform2.Rotation.Y * num;
float num3 = transform2.Rotation.Z * num;
t.X = ((transform1.Translation.X * ((1f - num5) - num3)) + (transform1.Translation.Y * (num7 - num9))) + (transform1.Translation.Z * (num6 + num10));
t.Y = ((transform1.Translation.X * (num7 + num9)) + (transform1.Translation.Y * ((1f - num8) - num3))) + (transform1.Translation.Z * (num4 - num11));
t.Z = ((transform1.Translation.X * (num6 - num10)) + (transform1.Translation.Y * (num4 + num11))) + (transform1.Translation.Z * ((1f - num8) - num5));
num12 = (transform2.Rotation.Y * transform1.Rotation.Z) - (transform2.Rotation.Z * transform1.Rotation.Y);
num11 = (transform2.Rotation.Z * transform1.Rotation.X) - (transform2.Rotation.X * transform1.Rotation.Z);
num10 = (transform2.Rotation.X * transform1.Rotation.Y) - (transform2.Rotation.Y * transform1.Rotation.X);
num9 = ((transform2.Rotation.X * transform1.Rotation.X) + (transform2.Rotation.Y * transform1.Rotation.Y)) + (transform2.Rotation.Z * transform1.Rotation.Z);
q.X = ((transform2.Rotation.X * transform1.Rotation.W) + (transform1.Rotation.X * transform2.Rotation.W)) + num12;
q.Y = ((transform2.Rotation.Y * transform1.Rotation.W) + (transform1.Rotation.Y * transform2.Rotation.W)) + num11;
q.Z = ((transform2.Rotation.Z * transform1.Rotation.W) + (transform1.Rotation.Z * transform2.Rotation.W)) + num10;
q.W = (transform2.Rotation.W * transform1.Rotation.W) - num9;
}
t.X = t.X * transform2.Scale + transform2.Translation.X;
t.Y = t.Y * transform2.Scale + transform2.Translation.Y;
t.Z = t.Z * transform2.Scale + transform2.Translation.Z;
#if XBOX360
result = new Transform();
#endif
result.Rotation.X = q.X;
result.Rotation.Y = q.Y;
result.Rotation.Z = q.Z;
result.Rotation.W = q.W;
result.Translation.X = t.X;
result.Translation.Y = t.Y;
result.Translation.Z = t.Z;
result.Scale = s;
}
/// <summary>
/// Interpolate to another transform
/// </summary>
/// <param name="to"></param>
/// <param name="amount"></param>
/// <returns></returns>
public Transform Interpolate(Transform to, float amount)
{
Transform result;
Interpolate(ref this, ref to, amount, out result);
return result;
}
/// <summary>
/// Construct the transform from a binary source
/// </summary>
/// <param name="reader"></param>
public Transform(BinaryReader reader)
{
#if XBOX360
this = new Transform();
#endif
Rotation.X = reader.ReadSingle();
Rotation.Y = reader.ReadSingle();
Rotation.Z = reader.ReadSingle();
Rotation.W = reader.ReadSingle();
Translation.X = reader.ReadSingle();
Translation.Y = reader.ReadSingle();
Translation.Z = reader.ReadSingle();
Scale = reader.ReadSingle();
}
/// <summary>
/// Interpolate between two transforms
/// </summary>
/// <param name="from"></param>
/// <param name="to"></param>
/// <param name="amount"></param>
/// <param name="result"></param>
public static void Interpolate(ref Transform from, ref Transform to, float amount, out Transform result)
{
result = new Transform();
Quaternion.Lerp(ref from.Rotation, ref to.Rotation, amount, out result.Rotation);
Vector3.Lerp(ref from.Translation, ref to.Translation, amount, out result.Translation);
result.Scale = from.Scale + ((to.Scale - from.Scale) * amount);
}
