Reorganize methods in Vector3D and Matrix4.

Eliminating the need of a seperated Matrix4.cpp.