dvec3.h

Go to the documentation of this file.

 
#ifndef DVEC3_H
#define DVEC3_H
 
#include <math.h>
 
typedef double dvec3[3];
 
/* ── Element access ─────────────────────────────────────────────────── */
 
static inline void dvec3_zero(dvec3 dest)
{
    dest[0] = 0.0;
    dest[1] = 0.0;
    dest[2] = 0.0;
}
 
static inline void dvec3_copy(const dvec3 src, dvec3 dest)
{
    dest[0] = src[0];
    dest[1] = src[1];
    dest[2] = src[2];
}
 
static inline void dvec3_set(dvec3 dest, double x_val, double y_val,
                             double z_val)
{
    dest[0] = x_val;
    dest[1] = y_val;
    dest[2] = z_val;
}
 
/* ── Arithmetic ─────────────────────────────────────────────────────── */
 
static inline void dvec3_add(const dvec3 a_vec, const dvec3 b_vec, dvec3 dest)
{
    dest[0] = a_vec[0] + b_vec[0];
    dest[1] = a_vec[1] + b_vec[1];
    dest[2] = a_vec[2] + b_vec[2];
}
 
static inline void dvec3_addto(dvec3 dest, const dvec3 b_vec)
{
    dest[0] += b_vec[0];
    dest[1] += b_vec[1];
    dest[2] += b_vec[2];
}
 
static inline void dvec3_sub(const dvec3 a_vec, const dvec3 b_vec, dvec3 dest)
{
    dest[0] = a_vec[0] - b_vec[0];
    dest[1] = a_vec[1] - b_vec[1];
    dest[2] = a_vec[2] - b_vec[2];
}
 
static inline void dvec3_subfrom(dvec3 dest, const dvec3 b_vec)
{
    dest[0] -= b_vec[0];
    dest[1] -= b_vec[1];
    dest[2] -= b_vec[2];
}
 
static inline void dvec3_scale(const dvec3 v_vec, double scalar, dvec3 dest)
{
    dest[0] = v_vec[0] * scalar;
    dest[1] = v_vec[1] * scalar;
    dest[2] = v_vec[2] * scalar;
}
 
static inline void dvec3_muladds(dvec3 dest, const dvec3 v_vec, double scalar)
{
    dest[0] += v_vec[0] * scalar;
    dest[1] += v_vec[1] * scalar;
    dest[2] += v_vec[2] * scalar;
}
 
/* ── Products ───────────────────────────────────────────────────────── */
 
static inline double dvec3_dot(const dvec3 a_vec, const dvec3 b_vec)
{
    return (a_vec[0] * b_vec[0]) + (a_vec[1] * b_vec[1]) +
           (a_vec[2] * b_vec[2]);
}
 
/* ── Length / Normalize ──────────────────────────────────────────────── */
 
static inline double dvec3_norm2(const dvec3 v_vec)
{
    return dvec3_dot(v_vec, v_vec);
}
 
static inline double dvec3_norm(const dvec3 v_vec)
{
    return sqrt(dvec3_norm2(v_vec));
}
 
static inline void dvec3_normalize(dvec3 v_vec)
{
    double len = dvec3_norm(v_vec);
    if (len > 0.0) {
        double inv = 1.0 / len;
        v_vec[0] *= inv;
        v_vec[1] *= inv;
        v_vec[2] *= inv;
    }
}
 
#endif /* DVEC3_H */