Added Vector3 class ported from Java version
fixe merge
Added matrix class with some basic methods.