/*
 *  Copyright (C) 2018  Vito Caputo - <vcaputo@pengaru.com>
 *
 *  This program is free software: you can redistribute it and/or modify it
 *  under the terms of the GNU General Public License version 3 as published
 *  by the Free Software Foundation.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program.  If not, see <http://www.gnu.org/licenses/>.
 */

#ifndef _V3F_H
#define _V3F_H

#include <math.h>

typedef struct v3f_t {
	float	x, y, z;
} v3f_t;


static inline v3f_t v3f_add(const v3f_t *a, const v3f_t *b)
{
	return (v3f_t){a->x + b->x, a->y + b->y, a->z + b->z};
}


static inline v3f_t * pv3f_add(const v3f_t *a, const v3f_t *b, v3f_t *res)
{
	*res = v3f_add(a, b);

	return res;
}


static inline v3f_t v3f_sub(const v3f_t *a, const v3f_t *b)
{
	return (v3f_t){a->x - b->x, a->y - b->y, a->z - b->z};
}


static inline v3f_t * pv3f_sub(const v3f_t *a, const v3f_t *b, v3f_t *res)
{
	*res = v3f_sub(a, b);

	return res;
}


static inline v3f_t v3f_mult(const v3f_t *a, const v3f_t *b)
{
	return (v3f_t){a->x * b->x, a->y * b->y, a->z * b->z};
}


static inline v3f_t * pv3f_mult(const v3f_t *a, const v3f_t *b, v3f_t *res)
{
	*res = v3f_mult(a, b);

	return res;
}


static inline v3f_t v3f_mult_scalar(const v3f_t *v, float scalar)
{
	return (v3f_t){v->x * scalar, v->y * scalar, v->z * scalar};
}


static inline v3f_t * pv3f_mult_scalar(const v3f_t *v, float scalar, v3f_t *res)
{
	*res = v3f_mult_scalar(v, scalar);

	return res;
}


static inline v3f_t v3f_div_scalar(const v3f_t *v, float scalar)
{
	return v3f_mult_scalar(v, 1.f / scalar);
}


static inline v3f_t * pv3f_div_scalar(const v3f_t *v, float scalar, v3f_t *res)
{
	*res = v3f_div_scalar(v, scalar);

	return res;
}


static inline float v3f_dot(const v3f_t *a, const v3f_t *b)
{
	return a->x * b->x + a->y * b->y + a->z * b->z;
}


static inline float v3f_length(const v3f_t *v)
{
	return sqrtf(v3f_dot(v, v));
}


static inline v3f_t v3f_normalize(const v3f_t *v)
{
	return v3f_mult_scalar(v, 1.0f / v3f_length(v));
}


static inline v3f_t * pv3f_normalize(const v3f_t *v, v3f_t *res)
{
	*res = v3f_normalize(v);

	return res;
}


static inline v3f_t v3f_lerp(const v3f_t *a, const v3f_t *b, float t)
{
	v3f_t	lerp_a, lerp_b;

	lerp_a = v3f_mult_scalar(a, 1.0f - t);
	lerp_b = v3f_mult_scalar(b, t);

	return v3f_add(&lerp_a, &lerp_b);
}


static inline v3f_t * pv3f_lerp(const v3f_t *a, const v3f_t *b, float t, v3f_t *res)
{
	*res = v3f_lerp(a, b, t);

	return res;
}


static inline v3f_t v3f_nlerp(const v3f_t *a, const v3f_t *b, float t)
{
	v3f_t	lerp = v3f_lerp(a, b, t);

	return v3f_normalize(&lerp);
}


static inline v3f_t * pv3f_nlerp(const v3f_t *a, const v3f_t *b, float t, v3f_t *res)
{
	*res = v3f_nlerp(a, b, t);

	return res;
}

#endif