public void SetPos(float X, float Y, float Z)
{
CurrentPos.Set(X, Y, Z);
TMat4x4 TransMat = TMat4x4.ZeroMat();
TransMat.SetTrans(X, Y, Z);
SetMatrix(TransMat);
}
public void SetPosAndAngle(float X, float Y, float Z, float A, float B, float C)
{
TMat4x4 TransMat = TMat4x4.ZeroMat();
TMat4x4 RotMatX = TMat4x4.ZeroMat();
TMat4x4 RotMatY = TMat4x4.ZeroMat();
TMat4x4 RotMatZ = TMat4x4.ZeroMat();
CurrentPos.Set(X, Y, Z);
CurrentRot.Set(A, B, C);
TransMat.SetTrans(X, Y, Z);
RotMatX.SetRotateX(A);
RotMatY.SetRotateY(B);
RotMatZ.SetRotateZ(C);
SetMatrix(RotMatX.MulMat(RotMatY).MulMat(RotMatZ).MulMat(TransMat));
}