]> Pileus Git - grits/blobdiff - src/roam.c
Remove legacy WMS and disable wms_test
[grits] / src / roam.c
index a95c69705f738ac66f94a39a77878403966fc828..54ae2c6b641ca445c328c42cce5239c70a80c5cd 100644 (file)
@@ -1,16 +1,16 @@
 /*
  * Copyright (C) 2009 Andy Spencer <spenceal@rose-hulman.edu>
- * 
+ *
  * This program is free software: you can redistribute it and/or modify
  * it under the terms of the GNU General Public License as published by
  * the Free Software Foundation, either version 3 of the License, or
  * (at your option) any later version.
- * 
+ *
  * 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/>.
  */
 #include <GL/gl.h>
 #include <GL/glu.h>
 
+#include "gis-world.h"
+
 #include "roam.h"
 
+
 /**
  * TODO:
  *   - Optimize for memory consumption
  */
 
 /* Misc */
-RoamView *roam_view_get()
+RoamView *roam_view_new()
 {
-       RoamView *view = g_new0(RoamView, 1);
-       glGetDoublev (GL_MODELVIEW_MATRIX,  view->model); 
-       glGetDoublev (GL_PROJECTION_MATRIX, view->proj); 
-       glGetIntegerv(GL_VIEWPORT,          view->view);          
-       return view;
+       return g_new0(RoamView, 1);
+}
+void roam_view_update(RoamView *view)
+{
+       glGetDoublev (GL_MODELVIEW_MATRIX,  view->model);
+       glGetDoublev (GL_PROJECTION_MATRIX, view->proj);
+       glGetIntegerv(GL_VIEWPORT,          view->view);
+       view->version++;
 }
 
 /* For GPQueue comparators */
@@ -58,12 +64,14 @@ static gint dia_cmp(RoamDiamond *a, RoamDiamond *b, gpointer data)
 /*************
  * RoamPoint *
  *************/
-RoamPoint *roam_point_new(double x, double y, double z)
+RoamPoint *roam_point_new(gdouble x, gdouble y, gdouble z)
 {
        RoamPoint *self = g_new0(RoamPoint, 1);
        self->x = x;
        self->y = y;
        self->z = z;
+       /* For get_intersect */
+       xyz2ll(x, y, z, &self->lat, &self->lon);
        return self;
 }
 RoamPoint *roam_point_dup(RoamPoint *self)
@@ -89,28 +97,45 @@ void roam_point_remove_triangle(RoamPoint *self, RoamTriangle *triangle)
                self->norm[i] -= triangle->norm[i];
        }
        self->tris--;
-       for (int i = 0; i < 3; i++)
-               self->norm[i] /= self->tris;
+       if (self->tris)
+               for (int i = 0; i < 3; i++)
+                       self->norm[i] /= self->tris;
 }
-void roam_point_update(RoamPoint *self, RoamSphere *sphere, gboolean do_height)
+void roam_point_update_height(RoamPoint *self)
 {
-       if (!self->cached) {
-               /* Cache height */
-               if (do_height)
-                       sphere->height_func(self, sphere->user_data);
+       if (self->height_func) {
+               gdouble elev = self->height_func(
+                               self->lat, self->lon, self->height_data);
+               lle2xyz(self->lat, self->lon, elev,
+                               &self->x, &self->y, &self->z);
+       } else {
+               gdouble dist = sqrt(self->x * self->x +
+                                   self->y * self->y +
+                                   self->z * self->z);
+               self->x = self->x/dist * EARTH_R;
+               self->y = self->y/dist * EARTH_R;
+               self->z = self->z/dist * EARTH_R;
+       }
+}
+void roam_point_update_projection(RoamPoint *self, RoamSphere *sphere)
+{
+       static int count   = 0;
+       static int version = 0;
+       if (version != sphere->view->version) {
+               g_debug("Projected %d points", count);
+               count   = 0;
+               version = sphere->view->version;
+       }
 
+       if (self->pversion != sphere->view->version) {
                /* Cache projection */
                gluProject(self->x, self->y, self->z,
                        sphere->view->model, sphere->view->proj, sphere->view->view,
                        &self->px, &self->py, &self->pz);
-
-               self->cached = TRUE;
+               self->pversion = sphere->view->version;
+               count++;
        }
 }
-void roam_point_clear(RoamPoint *self)
-{
-       self->cached = FALSE;
-}
 
 /****************
  * RoamTriangle *
@@ -119,11 +144,18 @@ RoamTriangle *roam_triangle_new(RoamPoint *l, RoamPoint *m, RoamPoint *r)
 {
        RoamTriangle *self = g_new0(RoamTriangle, 1);
 
+       self->error = 0;
        self->p.l = l;
        self->p.m = m;
        self->p.r = r;
-
-       self->error = 0;
+       self->split = roam_point_new(
+               (l->x + r->x)/2,
+               (l->y + r->y)/2,
+               (l->z + r->z)/2);
+       /* TODO: Move this back to sphere, or actually use the nesting */
+       self->split->height_func = m->height_func;
+       self->split->height_data = m->height_data;
+       roam_point_update_height(self->split);
 
        /* Update normal */
        double pa[3];
@@ -147,11 +179,17 @@ RoamTriangle *roam_triangle_new(RoamPoint *l, RoamPoint *m, RoamPoint *r)
        self->norm[0] /= total;
        self->norm[1] /= total;
        self->norm[2] /= total;
-       
+
        //g_message("roam_triangle_new: %p", self);
        return self;
 }
 
+void roam_triangle_free(RoamTriangle *self)
+{
+       g_free(self->split);
+       g_free(self);
+}
+
 void roam_triangle_add(RoamTriangle *self,
                RoamTriangle *left, RoamTriangle *base, RoamTriangle *right,
                RoamSphere *sphere)
@@ -165,7 +203,7 @@ void roam_triangle_add(RoamTriangle *self,
        roam_point_add_triangle(self->p.r, self);
 
        if (sphere->view)
-               roam_triangle_update(self, sphere);
+               roam_triangle_update_errors(self, sphere);
 
        self->handle = g_pqueue_push(sphere->triangles, self);
 }
@@ -194,14 +232,6 @@ gboolean roam_point_visible(RoamPoint *self, RoamSphere *sphere)
        return self->px > view[0] && self->px < view[2] &&
               self->py > view[1] && self->py < view[3] &&
               self->pz > 0       && self->pz < 1;
-       //double x, y, z;
-       //int view[4] = {0,0,1,1};
-       //gluProject(self->x, self->y, self->z,
-       //              sphere->view->model, sphere->view->proj, view,
-       //              &x, &y, &z);
-       //return !(x < 0 || x > 1 ||
-       //         y < 0 || y > 1 ||
-       //         z < 0 || z > 1);
 }
 gboolean roam_triangle_visible(RoamTriangle *self, RoamSphere *sphere)
 {
@@ -211,31 +241,28 @@ gboolean roam_triangle_visible(RoamTriangle *self, RoamSphere *sphere)
               roam_point_visible(self->p.r, sphere);
 }
 
-void roam_triangle_update(RoamTriangle *self, RoamSphere *sphere)
+void roam_triangle_update_errors(RoamTriangle *self, RoamSphere *sphere)
 {
        /* Update points */
-       roam_point_update(self->p.l, sphere, TRUE);
-       roam_point_update(self->p.m, sphere, TRUE);
-       roam_point_update(self->p.r, sphere, TRUE);
+       roam_point_update_projection(self->p.l, sphere);
+       roam_point_update_projection(self->p.m, sphere);
+       roam_point_update_projection(self->p.r, sphere);
 
        /* Not exactly correct, could be out on both sides (middle in) */
        if (!roam_triangle_visible(self, sphere)) {
                self->error = -1;
        } else {
+               roam_point_update_projection(self->split, sphere);
                RoamPoint *l = self->p.l;
                RoamPoint *m = self->p.m;
                RoamPoint *r = self->p.r;
+               RoamPoint *split = self->split;
 
-               /* TODO: share this with the base */
-               RoamPoint base = { (l->x + r->x)/2,
-                                  (l->y + r->y)/2,
-                                  (l->z + r->z)/2 };
-               RoamPoint good = base;
-               roam_point_update(&base, sphere, FALSE);
-               roam_point_update(&good, sphere, TRUE);
+               /*               l-r midpoint        projected l-r midpoint */
+               gdouble pxdist = (l->px + r->px)/2 - split->px;
+               gdouble pydist = (l->py + r->py)/2 - split->py;
 
-               self->error = sqrt((base.px - good.px) * (base.px - good.px) +
-                                  (base.py - good.py) * (base.py - good.py));
+               self->error = sqrt(pxdist*pxdist + pydist*pydist);
 
                /* Multiply by size of triangle */
                double size = -( l->px * (m->py - r->py) +
@@ -243,18 +270,12 @@ void roam_triangle_update(RoamTriangle *self, RoamSphere *sphere)
                                 r->px * (l->py - m->py) ) / 2.0;
 
                /* Size < 0 == backface */
+               //if (size < 0)
+               //      self->error *= -1;
                self->error *= size;
        }
 }
 
-void roam_triangle_clear(RoamTriangle *self)
-{
-       /* Clear points */
-       roam_point_clear(self->p.l);
-       roam_point_clear(self->p.m);
-       roam_point_clear(self->p.r);
-}
-
 void roam_triangle_split(RoamTriangle *self, RoamSphere *sphere)
 {
        //g_message("roam_triangle_split: %p, e=%f\n", self, self->error);
@@ -266,14 +287,8 @@ void roam_triangle_split(RoamTriangle *self, RoamSphere *sphere)
 
        RoamTriangle *base = self->t.b;
 
-       /* Duplicate midpoint */
-       RoamPoint *mid = roam_point_new(
-                       (self->p.l->x + self->p.r->x)/2,
-                       (self->p.l->y + self->p.r->y)/2,
-                       (self->p.l->z + self->p.r->z)/2);
-       roam_point_update(mid, sphere, TRUE);
-
        /* Add new triangles */
+       RoamPoint *mid = self->split;
        RoamTriangle *sl = roam_triangle_new(self->p.m, mid, self->p.l); // Self Left
        RoamTriangle *sr = roam_triangle_new(self->p.r, mid, self->p.m); // Self Right
        RoamTriangle *bl = roam_triangle_new(base->p.m, mid, base->p.l); // Base Left
@@ -296,12 +311,22 @@ void roam_triangle_split(RoamTriangle *self, RoamSphere *sphere)
 
        /* Add/Remove diamonds */
        RoamDiamond *diamond = roam_diamond_new(self, base, sl, sr, bl, br);
-       roam_diamond_update(diamond, sphere);
+       roam_diamond_update_errors(diamond, sphere);
        roam_diamond_add(diamond, sphere);
        roam_diamond_remove(self->parent, sphere);
        roam_diamond_remove(base->parent, sphere);
 }
 
+void roam_triangle_draw(RoamTriangle *self)
+{
+       glBegin(GL_TRIANGLES);
+       glNormal3dv(self->p.r->norm); glVertex3dv((double*)self->p.r);
+       glNormal3dv(self->p.m->norm); glVertex3dv((double*)self->p.m);
+       glNormal3dv(self->p.l->norm); glVertex3dv((double*)self->p.l);
+       glEnd();
+       return;
+}
+
 void roam_triangle_draw_normal(RoamTriangle *self)
 {
        double center[] = {
@@ -310,9 +335,9 @@ void roam_triangle_draw_normal(RoamTriangle *self)
                (self->p.l->z + self->p.m->z + self->p.r->z)/3.0,
        };
        double end[] = {
-               center[0]+self->norm[0]/2,
-               center[1]+self->norm[1]/2,
-               center[2]+self->norm[2]/2,
+               center[0]+self->norm[0]*2000000,
+               center[1]+self->norm[1]*2000000,
+               center[2]+self->norm[2]*2000000,
        };
        glBegin(GL_LINES);
        glVertex3dv(center);
@@ -335,10 +360,10 @@ RoamDiamond *roam_diamond_new(
        self->kids[2] = kid2;
        self->kids[3] = kid3;
 
-       kid0->parent = self; 
-       kid1->parent = self; 
-       kid2->parent = self; 
-       kid3->parent = self; 
+       kid0->parent = self;
+       kid1->parent = self;
+       kid2->parent = self;
+       kid3->parent = self;
 
        self->parents[0] = parent0;
        self->parents[1] = parent1;
@@ -388,110 +413,100 @@ void roam_diamond_merge(RoamDiamond *self, RoamSphere *sphere)
        /* Add/Remove triangles */
        if (tri->t.l->t.l == tri->t.r->t.r &&
            tri->t.l->t.l != tri && tri->parent) {
-               roam_diamond_update(tri->parent, sphere);
+               roam_diamond_update_errors(tri->parent, sphere);
                roam_diamond_add(tri->parent, sphere);
        }
 
        if (base->t.l->t.l == base->t.r->t.r &&
            base->t.l->t.l != base && base->parent) {
-               roam_diamond_update(base->parent, sphere);
+               roam_diamond_update_errors(base->parent, sphere);
                roam_diamond_add(base->parent, sphere);
        }
+
        /* Remove and free diamond and child triangles */
        roam_diamond_remove(self, sphere);
        g_assert(self->kids[0]->p.m == self->kids[1]->p.m &&
                 self->kids[1]->p.m == self->kids[2]->p.m &&
                 self->kids[2]->p.m == self->kids[3]->p.m);
        g_assert(self->kids[0]->p.m->tris == 0);
-       g_free(self->kids[0]->p.m);
-       g_free(self->kids[0]);
-       g_free(self->kids[1]);
-       g_free(self->kids[2]);
-       g_free(self->kids[3]);
+       roam_triangle_free(self->kids[0]);
+       roam_triangle_free(self->kids[1]);
+       roam_triangle_free(self->kids[2]);
+       roam_triangle_free(self->kids[3]);
        g_free(self);
 }
-void roam_diamond_update(RoamDiamond *self, RoamSphere *sphere)
+void roam_diamond_update_errors(RoamDiamond *self, RoamSphere *sphere)
 {
-       roam_triangle_update(self->parents[0], sphere);
-       roam_triangle_update(self->parents[1], sphere);
+       roam_triangle_update_errors(self->parents[0], sphere);
+       roam_triangle_update_errors(self->parents[1], sphere);
        self->error = MAX(self->parents[0]->error, self->parents[1]->error);
 }
 
 /**************
  * RoamSphere *
  **************/
-RoamSphere *roam_sphere_new(RoamTriFunc tri_func, RoamHeightFunc height_func, gpointer user_data)
+RoamSphere *roam_sphere_new()
 {
        RoamSphere *self = g_new0(RoamSphere, 1);
-       self->tri_func    = tri_func;
-       self->height_func = height_func;
-       self->user_data   = user_data;
-       self->polys       = 12;
+       self->polys       = 8;
        self->triangles   = g_pqueue_new((GCompareDataFunc)tri_cmp, NULL);
        self->diamonds    = g_pqueue_new((GCompareDataFunc)dia_cmp, NULL);
 
        RoamPoint *vertexes[] = {
-               roam_point_new( 1, 1, 1), // 0
-               roam_point_new( 1, 1,-1), // 1
-               roam_point_new( 1,-1, 1), // 2
-               roam_point_new( 1,-1,-1), // 3
-               roam_point_new(-1, 1, 1), // 4
-               roam_point_new(-1, 1,-1), // 5
-               roam_point_new(-1,-1, 1), // 6
-               roam_point_new(-1,-1,-1), // 7
+               roam_point_new( 0, 1, 0), // 0
+               roam_point_new( 0,-1, 0), // 1
+               roam_point_new( 0, 0, 1), // 2
+               roam_point_new( 1, 0, 0), // 3
+               roam_point_new( 0, 0,-1), // 4
+               roam_point_new(-1, 0, 0), // 5
        };
        int _triangles[][2][3] = {
                /*lv mv rv   ln, bn, rn */
-               {{3,2,0}, {10, 1, 7}}, // 0
-               {{0,1,3}, { 9, 0, 2}}, // 1
-               {{7,3,1}, {11, 3, 1}}, // 2
-               {{1,5,7}, { 8, 2, 4}}, // 3
-               {{6,7,5}, {11, 5, 3}}, // 4
-               {{5,4,6}, { 8, 4, 6}}, // 5
-               {{2,6,4}, {10, 7, 5}}, // 6
-               {{4,0,2}, { 9, 6, 0}}, // 7
-               {{4,5,1}, { 5, 9, 3}}, // 8
-               {{1,0,4}, { 1, 8, 7}}, // 9
-               {{6,2,3}, { 6,11, 0}}, // 10
-               {{3,7,6}, { 2,10, 4}}, // 11
+               {{2,0,3}, {3, 4, 1}}, // 0
+               {{3,0,4}, {0, 5, 2}}, // 1
+               {{4,0,5}, {1, 6, 3}}, // 2
+               {{5,0,2}, {2, 7, 0}}, // 3
+               {{3,1,2}, {5, 0, 7}}, // 4
+               {{4,1,3}, {6, 1, 4}}, // 5
+               {{5,1,4}, {7, 2, 5}}, // 6
+               {{2,1,5}, {4, 3, 6}}, // 7
        };
-       RoamTriangle *triangles[12];
 
-       for (int i = 0; i < 12; i++)
-               triangles[i] = roam_triangle_new(
+       for (int i = 0; i < 6; i++)
+               roam_point_update_height(vertexes[i]);
+       for (int i = 0; i < 8; i++)
+               self->roots[i] = roam_triangle_new(
                        vertexes[_triangles[i][0][0]],
                        vertexes[_triangles[i][0][1]],
                        vertexes[_triangles[i][0][2]]);
-       for (int i = 0; i < 12; i++)
-               roam_triangle_add(triangles[i],
-                       triangles[_triangles[i][1][0]],
-                       triangles[_triangles[i][1][1]],
-                       triangles[_triangles[i][1][2]],
+       for (int i = 0; i < 8; i++)
+               roam_triangle_add(self->roots[i],
+                       self->roots[_triangles[i][1][0]],
+                       self->roots[_triangles[i][1][1]],
+                       self->roots[_triangles[i][1][2]],
                        self);
 
        return self;
 }
-void roam_sphere_update(RoamSphere *self)
+void roam_sphere_update_errors(RoamSphere *self)
 {
-       g_debug("RoamSphere: update - polys=%d", self->polys);
-       if (self->view) g_free(self->view);
-       self->view = roam_view_get();
+       g_debug("RoamSphere: update_errors - polys=%d", self->polys);
+       if (!self->view)
+               self->view = roam_view_new();
+       roam_view_update(self->view);
 
        GPtrArray *tris = g_pqueue_get_array(self->triangles);
        GPtrArray *dias = g_pqueue_get_array(self->diamonds);
 
        for (int i = 0; i < tris->len; i++) {
-               /* Note: this also updates points */
                RoamTriangle *tri = tris->pdata[i];
-               roam_triangle_clear(tri);
-               roam_triangle_update(tri, self);
+               roam_triangle_update_errors(tri, self);
                g_pqueue_priority_changed(self->triangles, tri->handle);
        }
 
        for (int i = 0; i < dias->len; i++) {
                RoamDiamond *dia = dias->pdata[i];
-               roam_diamond_update(dia, self);
+               roam_diamond_update_errors(dia, self);
                g_pqueue_priority_changed(self->diamonds, dia->handle);
        }
 
@@ -514,22 +529,32 @@ void roam_sphere_merge_one(RoamSphere *self)
 gint roam_sphere_split_merge(RoamSphere *self)
 {
        gint iters = 0, max_iters = 500;
+       //gint target = 4000;
        gint target = 2000;
+       //gint target = 500;
 
        if (!self->view)
                return 0;
 
-       if (target - self->polys > 100)
+       if (target - self->polys > 100) {
+               //g_debug("RoamSphere: split_merge - Splitting %d - %d > 100", target, self->polys);
                while (self->polys < target && iters++ < max_iters)
                        roam_sphere_split_one(self);
+       }
 
-       if (self->polys - target > 100)
+       if (self->polys - target > 100) {
+               //g_debug("RoamSphere: split_merge - Merging %d - %d > 100", self->polys, target);
                while (self->polys > target && iters++ < max_iters)
                        roam_sphere_merge_one(self);
+       }
 
        while (((RoamTriangle*)g_pqueue_peek(self->triangles))->error >
               ((RoamDiamond *)g_pqueue_peek(self->diamonds ))->error &&
               iters++ < max_iters) {
+               //g_debug("RoamSphere: split_merge - Fixing 1 %f > %f && %d < %d",
+               //              ((RoamTriangle*)g_pqueue_peek(self->triangles))->error,
+               //              ((RoamDiamond *)g_pqueue_peek(self->diamonds ))->error,
+               //              iters-1, max_iters);
                roam_sphere_merge_one(self);
                roam_sphere_split_one(self);
        }
@@ -538,27 +563,30 @@ gint roam_sphere_split_merge(RoamSphere *self)
 }
 void roam_sphere_draw(RoamSphere *self)
 {
-       g_pqueue_foreach(self->triangles, (GFunc)self->tri_func, self->user_data);
+       g_debug("RoamSphere: draw");
+       g_pqueue_foreach(self->triangles, (GFunc)roam_triangle_draw, NULL);
 }
 void roam_sphere_draw_normals(RoamSphere *self)
 {
+       g_debug("RoamSphere: draw_normal");
        g_pqueue_foreach(self->triangles, (GFunc)roam_triangle_draw_normal, NULL);
 }
-static void roam_sphere_free_tri(RoamTriangle *tri)
+void roam_sphere_free_tri(RoamTriangle *tri)
 {
        if (--tri->p.l->tris == 0) g_free(tri->p.l);
        if (--tri->p.m->tris == 0) g_free(tri->p.m);
        if (--tri->p.r->tris == 0) g_free(tri->p.r);
-       g_free(tri);
+       roam_triangle_free(tri);
 }
 void roam_sphere_free(RoamSphere *self)
 {
        /* Slow method, but it should work */
-       while (self->polys > 12)
+       while (self->polys > 8)
                roam_sphere_merge_one(self);
        /* TODO: free points */
        g_pqueue_foreach(self->triangles, (GFunc)roam_sphere_free_tri, NULL);
        g_pqueue_free(self->triangles);
        g_pqueue_free(self->diamonds);
+       g_free(self->view);
        g_free(self);
 }