started potential and force stuff

[physik/posic.git] / math / math.c

diff --git a/math/math.c b/math/math.c
index 9cfaff6..9217c88 100644 (file)
--- a/math/math.c
+++ b/math/math.c
@@ -76,3 +76,20 @@ double v3_norm(t_3dvec *a) {
        return(sqrt(v3_absolute_square(a)));
 }
 
+int v3_per_bounds(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;
+}