start refactor Point, improve cov calc by mat multi
merge Vector3D and cov calculation