Implemented Matrix4f

And its basic math algorithms... almost pulled my hair out