implemented some of 3D vector and 3x3 matrix. Needs clean up.