Fix up busted tet and add interpolate to Vector3d