#pragma once

#include <cstdint> //uint64_t
//#include <stdexcept> // std::runtime_error

#include "utils/vector.h"
#include "utils/matrix.h"
#include <cmath> // std::abs


namespace numerics::detail{
	
	// ---------------- Matrix ----------------
	template <typename T>
	inline bool isclose_serial(const utils::Matrix<T>& A, const utils::Matrix<T> & B, const T tol = T{1e-5}) {
	    const uint64_t rows = A.rows();
	    const uint64_t cols = A.cols();

	    if ((rows != B.rows()) || (cols != B.cols())){
	    	return false;
	    }

		for (uint64_t i = 0; i < rows; ++i){
			for (uint64_t j = 0; j < cols; ++j){
				if (static_cast<T>(std::abs(A(i,j)-B(i,j))) > tol){
					return false;
				}
			}
		}
		return true;
	}

	// ---------------- Vector ----------------
	template <typename T>
	inline bool isclose_serial(const utils::Vector<T>& v, const utils::Vector<T>& p, const T tol = T{1e-5}) {
		const uint64_t N = v.size();
		if (N != p.size()){
			return false;
		}
		for (uint64_t i = 0; i < N; ++i){
			if (static_cast<T>(std::abs((v[i]-p[i]))) > tol){
				return false;
			}
		}
		return true;
	}

} // namespace numerics