Add Eigen3 to CMakeLists and add find script