//==================================================================================================
/*
  ROTGEN - Runtime Overlay for Eigen
  Copyright : CODE RECKONS
  SPDX-License-Identifier: BSL-1.0
*/
//==================================================================================================
#include "unit/tests.hpp"
#include <rotgen/rotgen.hpp>

TTS_CASE_TPL("System solver using QR",
             rotgen::tests::types)<typename T, typename O>(
  tts::type<tts::types<T, O>>)
{
  rotgen::matrix<T, rotgen::Dynamic, rotgen::Dynamic> a{{2.3, -1, 0.1},
                                                        {-1.6, 2.6, -1},
                                                        {0.3, -1, 2}};

  rotgen::matrix<T, rotgen::Dynamic, 1> b(3, 1);
  b(0) = b(2) = 1;
  b(1) = 0;

  rotgen::matrix<T, rotgen::Dynamic, rotgen::Dynamic> r(3, 1), error;

  auto x = rotgen::extract(r, 0, 0, 3, 1);
  rotgen::solver::qr(x, a, b);

  error = a * r - b;
  auto eps = std::numeric_limits<T>::epsilon();

  TTS_LESS(rotgen::maxCoeff(rotgen::abs(error)) / eps, 5) << "Result:\n"
                                                          << r << "\n"
                                                          << "Residuals:\n"
                                                          << error << "\n";
};