summaryrefslogtreecommitdiff
path: root/src/math.c
diff options
context:
space:
mode:
Diffstat (limited to 'src/math.c')
-rw-r--r--src/math.c61
1 files changed, 61 insertions, 0 deletions
diff --git a/src/math.c b/src/math.c
index 5ab69af..d05789d 100644
--- a/src/math.c
+++ b/src/math.c
@@ -1,4 +1,6 @@
+#include <stdio.h>
#include <string.h>
+
#include "common.h"
#include "math.h"
@@ -122,3 +124,62 @@ int point_inside_concave_shape(c2_t p1,c2_s_t s) {//hrm...
}
return 1;
}
+
+void print_point(c3_t p) {
+ printf("%lF %lF %lF\n",p.x,p.y,p.z);
+}
+
+c3_s_t apply_group_relative(c3_s_t s,c3_group_rot_t *group_rot) {
+ c3_s_t s2;
+ c3_group_rot_t *gr;
+ int i;
+ s2.len=s.len;
+ s2.id=s.id;
+ if(group_rot) {
+ gr=group_rot;
+ } else {
+ gr=get_group_relative(s.id);
+ }
+ if(!gr) { //shit. we have a shape but not relatives for it. oh well.
+ //printf("# no group relative.\n");
+ return s;
+ }
+ if(s.len < 1) {//wtf is wrong with this shape?
+ //printf("# wtf?\n");
+ return s;
+ }
+ if(s.len == 1) {//we're a circle. we /really/ have two points stored though.
+ real dist=distance3(s.p[0],s.p[1]);
+ s2.p[0]=s.p[0];
+ s2.p[1]=c3_add(s.p[0],(c3_t){dist,0,0});
+ }
+ if(s.len > 1) {//we're a polygon.
+ for(i=0;i<s.len+(s.len==1);i++) {//apply the group's rotation and store in s2.
+ if(!strcmp(s.id,global.user)) {//we need to rotate camera objects (an avatar maybe) only along the y axis, and in the opposite direction than everything else rotates
+ s2.p[i]=c3_add(gr->p,rotate_c3_yr(s.p[i],(c3_t){0,0,0},d2r((degrees){0-(gr->r.y.d)})));
+ } else {
+ if(gr) {
+ //s2.p[i]=c3_add(gr->p,rotate_c3_yr(s.p[i],gr->p,d2r(gr->r.y)));
+ s2.p[i]=c3_add(gr->p,rotate_c3_xr(
+ rotate_c3_yr(
+ rotate_c3_zr(s.p[i],(c3_t){0,0,0},d2r(gr->r.z)
+ ),(c3_t){0,0,0},d2r(gr->r.y)
+ ),(c3_t){0,0,0},d2r(gr->r.x)
+ )
+ );
+ } else {
+ s2.p[i]=s.p[i];
+ }
+ }
+ }
+ }
+ return s2;
+}
+
+c3_t c3_add(c3_t p1,c3_t p2) {
+ return (c3_t){p1.x+p2.x,p1.y+p2.y,p1.z+p2.z};
+}
+
+real distance3(c3_t p1,c3_t p2) {
+ return sqrt(( (p1.x-p2.x)*(p1.x-p2.x) )+( (p1.y-p2.y)*(p1.y-p2.y) )+( (p1.z-p2.z)*(p1.z-p2.z) ));
+}