#include <cmath>
#include <array>
#include <algorithm>
template <typename T, size_t M, size_t N>
class Matrix
{
public:
static const size_t ROWS = M;
static const size_t COLS = N;
typedef T SCALAR;
SCALAR operator[](const size_t index) const
{
static_assert((COLS == 1 || ROWS == 1), "operator[] is only for vectors (single row or column).");
return m_elements.at(index);
}
SCALAR& operator[](const size_t index)
{
static_assert((COLS == 1 || ROWS == 1), "operator[] is only for vectors (single row or column).");
return m_elements.at(index);
}
std::array<T, M * N> m_elements;
};
template <typename T, size_t N, size_t M, typename std::enable_if<(M == 1 || N == 1), int>::type = 0>
static inline T Length(
const Matrix<T, N, M> & input)
{
T value = 0;
for (size_t i = 0; i < std::max(N, M); ++i)
{
value += (input[i] * input[i]);
}
return std::sqrt(value);
}
template <typename T, size_t M, size_t N, typename std::enable_if<(M == 3 && N == 1) || (M == 1 && N == 3), int>::type = 0>
static inline Matrix<T, M, N>
CrossProduct(const Matrix<T, M, N> & a, const Matrix<T, M, N> & b)
{
Matrix<T, M, N> result;
result[0] = a[1] * b[2] - a[2] * b[1];
result[1] = a[2] * b[0] - a[0] * b[2];
result[2] = a[0] * b[1] - a[1] * b[0];
return result;
}
int main()
{
Matrix<double, 1, 1> m11;
Matrix<double, 3, 1> m31;
Matrix<double, 1, 3> m13;
Matrix<double, 3, 3> m33;
auto l0 = Length(m11); // Should work, but doesn't: no matching function for call to 'Length(Matrix<double, 1, 1>&)'
auto l1 = Length(m31); // Should work, but doesn't: no matching function for call to 'Length(Matrix<double, 3, 1>&)'
auto l2 = Length(m13); // Should work, but doesn't: no matching function for call to 'Length(Matrix<double, 1, 3>&)'
//auto l3 = Length(m33); // Shouldn't work, and doesn't: no matching function for call to 'Length(Matrix<double, 3, 3>&)'
auto v1 = CrossProduct(m13, m13); //Works, as expected
//auto v2 = CrossProduct(m11, m11); // As expected: enable_if.cpp:71:32: error: no matching function for
// call to 'CrossProduct(Matrix<double, 1, 1>&, Matrix<double, 1, 1>&)'
return 0;
}
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