source: libcfa/src/vec/vec2.hfa @ 1dd929e

#pragma once
#include <math.hfa>
#include <iostream.hfa>

trait zeroassn(otype T) {
    T ?=?(T&, zero_t);
};
trait fromint(otype T) {
    void ?{}(T&, int);
};
trait zero_assign(otype T) {
    T ?=?(T&, zero_t);
};
trait subtract(otype T) {
    T ?-?(T, T);
    T -?(T);
};
trait add(otype T) {
    T ?+?(T, T);
};
trait multiply(otype T) {
    T ?*?(T, T);
};
trait divide(otype T) {
    T ?/?(T, T);
};
trait lessthan(otype T) {
    int ?<?(T, T);
};
trait equality(otype T) {
    int ?==?(T, T);
};
trait sqrt(otype T) {
    T sqrt(T);
};

static inline {
// int
int ?=?(int& n, zero_t) { return n = 0.f; }
int sqrt(int a) { return sqrt((float)a); }
/* float */
void ?{}(float& a, int b) { a = b; }
float ?=?(float& n, zero_t) { return n = 0.f; }
/* double */
void ?{}(double& a, int b) { a = b; }
double ?=?(double& n, zero_t) { return n = 0L; }
// long double
void ?{}(long double& a, int b) { a = b; }
long double ?=?(long double& n, zero_t) { return n = 0L; }
}

forall(otype T) {
    struct vec2 {
        T x, y;
    };
}

forall(otype T) {
    static inline {

    // Constructors

    void ?{}(vec2(T)& v, T x, T y) {
        v.[x, y] = [x, y];
    }

    forall(| zero_assign(T))
    void ?{}(vec2(T)& vec, zero_t) with (vec) {
        x = y = 0;
    }

    void ?{}(vec2(T)& vec, T val) with (vec) {
        x = y = val;
    }

    void ?{}(vec2(T)& vec, vec2(T) other) with (vec) {
        [x,y] = other.[x,y];
    }

    // Assignment
    void ?=?(vec2(T)& vec, vec2(T) other) with (vec) {
        [x,y] = other.[x,y];
    }
    forall(| zero_assign(T))
    void ?=?(vec2(T)& vec, zero_t) with (vec) {
        x = y = 0;
    }

    // Primitive mathematical operations

    // Subtraction

    forall(| subtract(T)) {
    vec2(T) ?-?(vec2(T) u, vec2(T) v) { // TODO( can't make this const ref )
        return [u.x - v.x, u.y - v.y];
    }
    vec2(T)& ?-=?(vec2(T)& u, vec2(T) v) {
        u = u - v;
        return u;
    }
    vec2(T) -?(vec2(T)& v) with (v) {
        return [-x, -y];
    }
    }

    // Addition
    forall(| add(T)) {
    vec2(T) ?+?(vec2(T) u, vec2(T) v) { // TODO( can't make this const ref )
        return [u.x + v.x, u.y + v.y];
    }
    vec2(T)& ?+=?(vec2(T)& u, vec2(T) v) {
        u = u + v;
        return u;
    }
    }

    // Scalar Multiplication
    forall(| multiply(T)) {
    vec2(T) ?*?(vec2(T) v, T scalar) with (v) { // TODO (can't make this const ref)
        return [x * scalar, y * scalar];
    }
    vec2(T) ?*?(T scalar, vec2(T) v) { // TODO (can't make this const ref)
        return v * scalar;
    }
    vec2(T)& ?*=?(vec2(T)& v, T scalar) {
        v = v * scalar;
        return v;
    }
    }

    // Scalar Division
    forall(| divide(T)) {
    vec2(T) ?/?(vec2(T) v, T scalar) with (v) {
        return [x / scalar, y / scalar];
    }
    vec2(T)& ?/=?(vec2(T)& v, T scalar) with (v) {
        v = v / scalar;
        return v;
    }
    }

    // Relational Operators
    forall(| equality(T)) {
    bool ?==?(vec2(T) u, vec2(T) v) with (u) {
        return x == v.x && y == v.y;
    }
    bool ?!=?(vec2(T) u, vec2(T) v) {
        return !(u == v);
    }
    }

    forall(| add(T) | multiply(T))
    T dot(vec2(T) u, vec2(T) v) {
        return u.x * v.x + u.y * v.y;
    }

    forall(| sqrt(T) | add(T) | multiply(T))
    T length(vec2(T) v) {
       return sqrt(dot(v, v));
    }

    forall(| add(T) | multiply(T))
    T length_squared(vec2(T) v) {
       return dot(v, v);
    }

    forall(| subtract(T) | sqrt(T) | add(T) | multiply(T))
    T distance(vec2(T) v1, vec2(T) v2) {
        return length(v1 - v2);
    }

    forall(| sqrt(T) | divide(T) | add(T) | multiply(T))
    vec2(T) normalize(vec2(T) v) {
        return v / sqrt(dot(v, v));
    }

    // Project vector u onto vector v
    forall(| sqrt(T) | divide(T) | add(T) | multiply(T))
    vec2(T) project(vec2(T) u, vec2(T) v) {
        vec2(T) v_norm = normalize(v);
        return v_norm * dot(u, v_norm);
    }

    // Reflect incident vector v with respect to surface with normal n
    forall(| sqrt(T) | divide(T) | add(T) | multiply(T) | subtract(T) | fromint(T))
    vec2(T) reflect(vec2(T) v, vec2(T) n) {
        return v - (T){2} * project(v, n);
    }

    // Refract incident vector v with respect to surface with normal n
    // eta is the ratio of indices of refraction between starting material and
    // entering material (i.e., from air to water, eta = 1/1.33)
    // v and n must already be normalized
    forall(| sqrt(T) | add(T) | multiply(T) | subtract(T) | fromint(T) | lessthan(T) | zeroassn(T))
    vec2(T) refract(vec2(T) v, vec2(T) n, T eta) {
        T dotValue = dot(n, v);
        T k = (T){1} - eta * eta * ((T){1} - dotValue * dotValue);
        if (k < (T){0}) {
            return 0;
        }
        return eta * v - (eta * dotValue + sqrt(k)) * n;
    }

    // Given a perturbed normal and a geometric normal,
    // flip the perturbed normal if the geometric normal is pointing away
    // from the observer.
    // n is the perturbed vector that we want to align
    // i is the incident vector
    // ng is the geometric normal of the surface
    forall(| add(T) | multiply(T) | lessthan(T) | fromint(T) | subtract(T))
    vec2(T) faceforward(vec2(T) n, vec2(T) i, vec2(T) ng) {
        return dot(ng, i) < (T){0} ? n : -n;
    }

    }
}

forall(dtype ostype, otype T | writeable(T, ostype) | vec2_t(T)) {
    ostype & ?|?( ostype & os, vec2(T) v) with (v) {
        return os | '<' | x | ',' | y | '>';
    }
    void ?|?( ostype & os, vec2(T) v ) with (v) {
        (ostype &)(os | v); ends(os);
    }
}