#ifndef VECTOR_OPERATIONS_H
#define VECTOR_OPERATIONS_H

#include <cstring>
#include <cmath>

#ifdef USE_VDT
#include "vdt/vdtMath.h"
#include "vdt/stdwrap.h"
#define hl_exp vdt::fast_exp
#define hl_log vdt::fast_log
#define hl_sin vdt::fast_sin
#define hl_cos vdt::fast_cos
#define hl_tan vdt::fast_tan
#define hl_sqrt vdt::fast_sqrt
#define hl_pow vdt::fast_pow
#define hl_round vdt::fast_round
#else
#define hl_exp std::exp
#define hl_log std::log
#define hl_sin std::sin
#define hl_cos std::cos
#define hl_tan std::tan
#define hl_sqrt std::sqrt
#define hl_pow std::pow
#define hl_round std::round
#endif

constexpr int BUFSIZE = 64;

#define FOR(i) for(int i = 0; i < BUFSIZE; ++i)

// When auto-vectorizing without __restrict,
// gcc and clang check for overlap (with a bunch of integer code)
// before running the vectorized loop

// vector - vector operations
inline void load(double* __restrict a, double* __restrict b) noexcept { std::memcpy(a, b, BUFSIZE * sizeof(double)); }
inline void add(double* __restrict a, double* __restrict b) noexcept { FOR(i) a[i] += b[i]; }
inline void sub(double* __restrict a, double* __restrict b) noexcept { FOR(i) a[i] -= b[i]; }
inline void mul(double* __restrict a, double* __restrict b) noexcept { FOR(i) a[i] *= b[i]; }
inline void div(double* __restrict a, double* __restrict b) noexcept { FOR(i) a[i] /= b[i]; }
inline void exp(double* __restrict a, double* __restrict b) noexcept { FOR(i) a[i] = hl_exp(b[i]); }
inline void log(double* __restrict a, double* __restrict b) noexcept { FOR(i) a[i] = hl_log(b[i]); }
inline void sin(double* __restrict a, double* __restrict b) noexcept { FOR(i) a[i] = hl_sin(b[i]); }
inline void cos(double* __restrict a, double* __restrict b) noexcept { FOR(i) a[i] = hl_cos(b[i]); }
inline void tan(double* __restrict a, double* __restrict b) noexcept { FOR(i) a[i] = hl_tan(b[i]); }
inline void sqrt(double* __restrict a, double* __restrict b) noexcept { FOR(i) a[i] = hl_sqrt(b[i]); }
inline void pow(double* __restrict a, double* __restrict b) noexcept { FOR(i) a[i] = hl_pow(a[i], hl_round(b[i])); };
inline void root(double* __restrict a, double* __restrict b) noexcept { FOR(i) a[i] = hl_pow(a[i], 1 / hl_round(b[i])); };
inline void square(double* __restrict a, double* __restrict b) noexcept { FOR(i) a[i] = b[i] * b[i]; };

// vector - scalar operations
inline void load(double* __restrict a, double s) noexcept { FOR(i) a[i] = s; }
inline void add(double* __restrict a, double s) noexcept { FOR(i) a[i] += s; }
inline void sub(double* __restrict a, double s) noexcept { FOR(i) a[i] -= s; }
inline void mul(double* __restrict a, double s) noexcept { FOR(i) a[i] *= s; }
inline void div(double* __restrict a, double s) noexcept { FOR(i) a[i] /= s; }

// vector operations
inline void neg(double* __restrict a) noexcept { FOR(i) a[i] = -a[i]; }
inline void inv(double* __restrict a) noexcept { FOR(i) a[i] = 1 / a[i]; }
inline void exp(double* __restrict a) noexcept { FOR(i) a[i] = hl_exp(a[i]); }
inline void log(double* __restrict a) noexcept { FOR(i) a[i] = hl_log(a[i]); }
inline void sin(double* __restrict a) noexcept { FOR(i) a[i] = hl_sin(a[i]); }
inline void cos(double* __restrict a) noexcept { FOR(i) a[i] = hl_cos(a[i]); }
inline void sqrt(double* __restrict a) noexcept { FOR(i) a[i] = hl_sqrt(a[i]); }
inline void round(double* __restrict a) noexcept { FOR(i) a[i] = hl_round(a[i]); }
inline void square(double* __restrict a) noexcept { FOR(i) a[i] = a[i] * a[i];; }

#undef FOR
#endif