graphmath.c

#include "graphmath.h"

#include <math.h>

vec2 point_projection(vec3 v3){
	return (vec2){v3.x, v3.y};
}

vec3 translate(vec3 v3, vec3 o){
	return (vec3){
		v3.x + o.x,
		v3.y + o.y,
		v3.z + o.z
	};
}

vec3 scale(vec3 v3, vec3 s){
	return (vec3){
		v3.x * s.x,
		v3.y * s.y,
		v3.z * s.z
	};
}

vec3 rotate(vec3 v3, vec3 theta){
	vec3 vp = (vec3){
		v3.x*cosf(theta.z)*cosf(theta.y) + v3.y*cosf(theta.z)*sinf(theta.y)*sinf(theta.x) - v3.y*sinf(theta.z)*cosf(theta.x) + v3.z*cosf(theta.z)*sinf(theta.y)*cosf(theta.x) + v3.z*sinf(theta.z)*sinf(theta.x),
		v3.x*sinf(theta.z)*cosf(theta.y) + v3.y*sinf(theta.z)*sinf(theta.y)*sinf(theta.x) + v3.y*cosf(theta.z)*cosf(theta.x) + v3.z*sinf(theta.z)*sinf(theta.y)*cosf(theta.x) - v3.z*cosf(theta.z)*sinf(theta.x),
		-v3.x*sinf(theta.y) + v3.y*cosf(theta.y)*sinf(theta.x) + v3.z*cosf(theta.y)*cosf(theta.x)
	};
	return vp;
}