1 files changed, 42 insertions, 0 deletions
diff --git a/Assets/Scripts/Utils/MatrixUtility.cs b/Assets/Scripts/Utils/MatrixUtility.cs
new file mode 100644
index 00000000..f3d865f2
--- /dev/null
+++ b/Assets/Scripts/Utils/MatrixUtility.cs
@@ -0,0 +1,42 @@
+using System.Collections;
+using System.Collections.Generic;
+using UnityEngine;
+
+public static class MatrixUtility
+{
+
+	public static void SetTR(ref this Matrix4x4 matrix, Vector3 pos, Quaternion q)
+	{
+		matrix = q.ToMatrix();
+		matrix[12] = pos[0];
+		matrix[13] = pos[1];
+		matrix[14] = pos[2];
+	}
+
+	public static void SetTRS2(ref this Matrix4x4 matrix, Vector3 pos, Quaternion q, Vector3 s)
+	{
+		matrix = q.ToMatrix();
+		
+		matrix[0] *= s[0];
+		matrix[1] *= s[0];
+		matrix[2] *= s[0];
+		matrix[4] *= s[1];
+		matrix[5] *= s[1];
+		matrix[6] *= s[1];
+		matrix[8] *= s[2];
+		matrix[9] *= s[2];
+		matrix[10] *= s[2];
+		matrix[12] = pos[0];
+		matrix[13] = pos[1];
+		matrix[14] = pos[2];
+
+	}
+
+	public static Matrix4x4 RotateAndTranslate(Vector3 pos, Quaternion q)
+	{
+		Matrix4x4 m = new Matrix4x4();
+		m.SetTR(pos, q);
+		return m;
+	}
+
+}