#include <math.h>

#define uge_gv_tmpl_x template<unsigned X>
#define uge_gv_tmpl_xt template<unsigned X, class T>

uge_gv_tmpl_x VectorXD<X>::MatrixMxN()
{
    this->fill(0);
}

uge_gv_tmpl_x VectorXD<X>::MatrixMxN(double k)
{
    this->fill(k);
}

uge_gv_tmpl_x VectorXD<X>::MatrixMxN(const double scalars[X])
{
    this->fill(scalars);
}

uge_gv_tmpl_x VectorXD<X>::MatrixMxN(const VectorXD<X>& other)
{
    for (unsigned i = 0; i < X; ++i) {
        _scalars[i] = other._scalars[i];
    }
}

uge_gv_tmpl_xt T& GenericVector<X, T>::setScalar(unsigned i, double value)
{
    return setScalar(i, 0,value);
}

uge_gv_tmpl_xt double GenericVector<X, T>::getScalar(unsigned i) const
{
    return getScalar(i, 0);
}

uge_gv_tmpl_xt double GenericVector<X, T>::operator[](unsigned i) const
{
    return getScalar(i);
}

uge_gv_tmpl_xt double GenericVector<X, T>::dotProduct(const T &other) const
{
    double total = 0;
    for (unsigned i = 0; i < X; ++i) {
        total += _scalars[i][0] * other._scalars[i][0];
    }
    return total;
}

uge_gv_tmpl_xt T& GenericVector<X, T>::crossProduct(const T& other)
{
    T t = *getThis();
    for (unsigned i = 0; i < X; ++i) {
        unsigned j = (i + 1) % X;
        unsigned k = (i + 2) % X;
        _scalars[i][0] = (t._scalars[j][0] * other._scalars[k][0]) - (t._scalars[k][0] * other._scalars[j][0]);
    }
    return *getThis();
}

uge_gv_tmpl_xt T GenericVector<X, T>::crossProduct(const T &v1, const T &v2)
{
    return T(v1).crossProduct(v2);
}

uge_gv_tmpl_xt double GenericVector<X, T>::norm() const
{
    double total = 0;
    for (unsigned i = 0; i < X; ++i) {
        total += _scalars[i][0] * _scalars[i][0];
    }
    return sqrt(total);
}

uge_gv_tmpl_xt T* GenericVector<X, T>::getThis() const
{
    return (T*)this;
}