Fix Vector3d Matrix3d Matrix3dUtils

had 4 years since not used c++. forget something…stupid…