Change matrix lib for Eigen