Revert "Added more code to Matrix4"

This reverts commit 7391e798feae333a0cd64309b70c95eab72b195c.
Revert "Revert "Added more code to Matrix4""

This reverts commit dadb154740c6f8111c6eb86c84f0971329f8268b.