vec.h

#pragma once
 
#include <kiba/core/types.h>
#include <kiba/math/math.h>
 
typedef union {
    struct {
        f32 x, y, z;
    };
 
    struct {
        f32 r, g, b;
    };
 
    struct {
        f32 _v0, _v1, _v2;
    };
 
    f32 raw[3];
} vec3;
 
STATIC_ASSERT(sizeof(vec3) == sizeof(float[3]), "vec3's general layout must be identical to its raw format");
 
static inline vec3 vec3_create(f32 x, f32 y, f32 z) {
    return (vec3){
        .x = x,
        .y = y,
        .z = z,
    };
}
 
static inline vec3 vec3_add(vec3 v1, vec3 v2) {
    v1.x += v2.x;
    v1.y += v2.y;
    v1.z += v2.z;
    return v1;
}
 
static inline vec3 vec3_sub(vec3 v1, vec3 v2) {
    v1.x -= v2.x;
    v1.y -= v2.y;
    v1.z -= v2.z;
    return v1;
}
 
static inline vec3 vec3_mul(vec3 v1, vec3 v2) {
    v1.x *= v2.x;
    v1.y *= v2.y;
    v1.z *= v2.z;
    return v1;
}
 
static inline vec3 vec3_div(vec3 v1, vec3 v2) {
    v1.x /= v2.x;
    v1.y /= v2.y;
    v1.z /= v2.z;
    return v1;
}
 
static inline vec3 vec3_cross_product(vec3 v1, vec3 v2) {
    // TODO check created assembly
    return vec3_sub(vec3_create(v1.y * v2.z, v1.z * v2.x, v1.x * v2.y),
                    vec3_create(v1.z * v2.y, v1.x * v2.z, v1.y * v2.x));
    /*return (vec3){
        .x = v1.y * v2.z - v1.z * v2.y,
        .y = v1.z * v2.x - v1.x * v2.z,
        .z = v1.x * v2.y - v1.y * v2.x,
    };*/
}
 
static inline f32 vec3_dot(vec3 v1, vec3 v2) { return v1.x * v2.x + v1.y * v2.y + v1.z * v2.z; }
 
static inline vec3 vec3_add_scalar(vec3 v, f32 s) {
    v.x += s;
    v.y += s;
    v.z += s;
    return v;
}
 
static inline vec3 vec3_sub_scalar(vec3 v, f32 s) {
    v.x -= s;
    v.y -= s;
    v.z -= s;
    return v;
}
 
static inline vec3 vec3_mul_scalar(vec3 v, f32 s) {
    v.x *= s;
    v.y *= s;
    v.z *= s;
    return v;
}
 
static inline vec3 vec3_div_scalar(vec3 v, f32 s) {
    v.x /= s;
    v.y /= s;
    v.z /= s;
    return v;
}
 
static inline f32 vec3_length(vec3 v) { return f32_sqrt(v.x * v.x + v.y * v.y + v.z * v.z); }
 
// TODO add fast normalization using fast inverse of length
static inline vec3 vec3_normalize(vec3 v) { return vec3_div_scalar(v, vec3_length(v)); }
 
typedef union {
    struct {
        f32 x, y, z, w;
    };
 
    struct {
        f32 r, g, b, a;
    };
 
    struct {
        f32 _v0, _v1, _v2, _v3;
    };
} vec4;
 
static inline vec4 vec4_create(f32 x, f32 y, f32 z, f32 w) {
    return (vec4){
        .x = x,
        .y = y,
        .z = z,
        .w = w,
    };
}
 
static inline vec4 vec4_from_vec3(vec3 v, f32 w) { return vec4_create(v.x, v.y, v.z, w); }