inline static void STL2EIGEN(std::multimap<int, cv::Mat> &data,Eigen::MatrixXd& X,Eigen::Matrix<int, Eigen::Dynamic, 1>& y){