Add a Matrix4x4 and Vector4

Signed-off-by: Aleksi Sapon <QcTechs@gmail.com>