Cleaning and remove Eigen dependency (useless)