Added Matrix3d class