tug/test/TestUtils.hpp

#include <Eigen/Core>
#include <Eigen/Dense>
#include <fstream>
#include <ios>
#include <iostream>
#include <sstream>
#include <stdexcept>

inline Eigen::MatrixXd CSV2Eigen(std::string file2Convert) {

  std::vector<double> matrixEntries;

  std::ifstream matrixDataFile(file2Convert);
  if (matrixDataFile.fail()) {
    throw std::invalid_argument("File probably non-existent!");
  }

  std::string matrixRowString;
  std::string matrixEntry;
  int matrixRowNumber = 0;

  while (getline(matrixDataFile, matrixRowString)) {
    std::stringstream matrixRowStringStream(matrixRowString);
    while (getline(matrixRowStringStream, matrixEntry, ' ')) {
      matrixEntries.push_back(stod(matrixEntry));
    }
    if (matrixRowString.length() > 1) {
      matrixRowNumber++;
    }
  }

  return Eigen::Map<
      Eigen::Matrix<double, Eigen::Dynamic, Eigen::Dynamic, Eigen::RowMajor>>(
      matrixEntries.data(), matrixRowNumber,
      matrixEntries.size() / matrixRowNumber);
}

inline bool checkSimilarity(Eigen::MatrixXd a, Eigen::MatrixXd b,
                            double precision = 1e-5) {
  return a.isApprox(b, precision);
}

inline bool checkSimilarityV2(Eigen::MatrixXd a, Eigen::MatrixXd b,
                              double maxDiff) {

  Eigen::MatrixXd diff = a - b;
  double maxCoeff = diff.maxCoeff();
  return abs(maxCoeff) < maxDiff;
}