X-Git-Url: https://hackdaworld.org/gitweb/?a=blobdiff_plain;f=math%2Fmath.c;h=6f4345e0124460ebbcb63a0482df9e367e592629;hb=e6f456c0fa807b86e1b25996e70efcdcfe390ea5;hp=6d707e93bd7c23b355d8292273349fb37c004d30;hpb=710717c4033bc5b8eb34644914e762a2834ae345;p=physik%2Fposic.git

diff --git a/math/math.c b/math/math.c
index 6d707e9..6f4345e 100644
--- a/math/math.c
+++ b/math/math.c
@@ -7,6 +7,8 @@
 
 
 #include <string.h>
+#include <math.h>
+
 #include "math.h"
 
 int v3_add(t_3dvec *sum,t_3dvec *a,t_3dvec *b) {
@@ -64,3 +66,30 @@ int v3_cmp(t_3dvec *a,t_3dvec *b) {
 	return(memcmp(a,b,sizeof(t_3dvec)));
 }
 
+double v3_absolute_square(t_3dvec *a) {
+
+	return(a->x*a->x+a->y*a->y+a->z*a->z);
+}
+
+double v3_norm(t_3dvec *a) {
+
+	return(sqrt(v3_absolute_square(a)));
+}
+
+int v3_per_bound(t_3dvec *a,t_3dvec *dim) {
+
+	double x,y,z;
+
+	x=0.5*dim->x;
+	y=0.5*dim->y;
+	z=0.5*dim->z;
+
+	if(a->x>=x) a->x-=dim->x;
+	else if(-a->x>x) a->x+=dim->x;
+	if(a->y>=y) a->y-=dim->y;
+	else if(-a->y>y) a->y+=dim->y;
+	if(a->z>=z) a->z-=dim->z;
+	else if(-a->z>z) a->z+=dim->z;
+
+	return 0;
+}