2 * Hic Est Leo -- OSM Data Representation
4 * (c) 2014 Martin Mares <mj@ucw.cz>
9 #include <ucw/mempool.h>
10 #include <ucw/stkstring.h>
11 #include <ucw/strtonum.h>
20 static struct mempool *osm_pool;
22 /*** Generic objects ***/
24 struct osm_id_to_obj {
29 clist osm_obj_list[OSM_TYPE_MAX];
31 #define P(x) [OSM_TYPE_##x] = #x,
32 const char * const osm_obj_type_names[OSM_TYPE_MAX] = {
33 [OSM_TYPE_INVALID] = "Invalid",
34 [OSM_TYPE_NODE] = "Node",
35 [OSM_TYPE_WAY] = "Way",
36 [OSM_TYPE_RELATION] = "Relation",
37 [OSM_TYPE_MULTIPOLYGON] = "Multipolygon",
41 #define HASH_NODE struct osm_id_to_obj
42 #define HASH_PREFIX(x) osm_id_hash_##x
43 #define HASH_KEY_ATOMIC id
44 #define HASH_ATOMIC_TYPE osm_id_t
45 #define HASH_WANT_FIND
46 #define HASH_WANT_LOOKUP
47 #define HASH_USE_POOL osm_pool
48 #define HASH_ZERO_FILL
49 #define HASH_TABLE_DYNAMIC
50 #include <ucw/hashtable.h>
52 static struct osm_id_hash_table osm_id_hash[OSM_TYPE_MAX];
54 osm_id_t osm_parse_id(const char *str)
57 const char *err = str_to_uintmax(&id, str, NULL, STN_WHOLE | STN_MINUS | 10);
58 if (err || id != (osm_id_t)id)
59 return OSM_INVALID_ID;
64 struct osm_object *osm_obj_find_by_id(enum osm_object_type type, osm_id_t id)
66 ASSERT(type != OSM_TYPE_INVALID && type < OSM_TYPE_MAX);
67 struct osm_id_to_obj *ii = osm_id_hash_find(&osm_id_hash[type], id);
68 return ii ? ii->o : NULL;
71 static void *osm_obj_new(enum osm_object_type type, osm_id_t id, uns size)
73 ASSERT(type != OSM_TYPE_INVALID && type < OSM_TYPE_MAX);
74 struct osm_id_to_obj *ii = osm_id_hash_lookup(&osm_id_hash[type], id);
76 die("Id %ju for type %s defined twice", (uintmax_t) id, osm_obj_type_names[type]);
78 struct osm_object *o = mp_alloc_zero(osm_pool, size);
79 clist_add_tail(&osm_obj_list[type], &o->n);
83 clist_init(&o->backrefs);
88 void osm_ref_add(struct osm_object *parent, clist *list, struct osm_object *son, osm_val_t role)
90 ASSERT(parent != son);
92 struct osm_ref *ref = mp_alloc(osm_pool, sizeof(*ref));
95 clist_add_tail(list, &ref->n);
97 struct osm_ref *backref = mp_alloc(osm_pool, sizeof(*ref));
100 clist_add_tail(&son->backrefs, &backref->n);
103 void osm_obj_dump(struct osm_object *o)
108 osm_node_dump((struct osm_node *) o);
111 osm_way_dump((struct osm_way *) o);
113 case OSM_TYPE_RELATION:
114 osm_relation_dump((struct osm_relation *) o);
116 case OSM_TYPE_MULTIPOLYGON:
117 osm_multipolygon_dump((struct osm_multipolygon *) o);
124 void osm_obj_warn(struct osm_object *o, const char *mesg, ...)
127 va_start(args, mesg);
128 msg(L_WARN, "%s: %s", STK_OSM_NAME(o), stk_vprintf(mesg, args));
134 struct dict osm_key_dict, osm_value_dict;
136 void osm_obj_add_tag_raw(struct osm_object *o, osm_key_t key, osm_val_t val)
138 struct osm_tag *t = mp_alloc(osm_pool, sizeof(*t));
141 clist_add_tail(&o->tags, &t->n);
144 void osm_obj_add_tag(struct osm_object *o, const char *key, const char *val)
146 osm_obj_add_tag_raw(o, osm_key_encode(key), osm_val_encode(val));
149 osm_val_t osm_obj_find_tag(struct osm_object *o, osm_key_t key)
151 CLIST_FOR_EACH(struct osm_tag *, t, o->tags)
157 void osm_tag_dump(struct osm_tag *t)
159 printf("\t%s = %s\n", osm_key_decode(t->key), osm_val_decode(t->val));
162 static const char * const osm_wk_keys[] = {
164 #define P(x,y) [KEY_##x] = y,
165 #include "dict-keys.h"
170 static const char * const osm_wk_values[] = {
172 #define P(x,y) [VALUE_##x] = y,
173 #include "dict-values.h"
178 static void osm_tag_init(void)
180 dict_init(&osm_key_dict, osm_wk_keys);
181 dict_init(&osm_value_dict, osm_wk_values);
186 struct osm_node *osm_node_new(osm_id_t id)
188 struct osm_node *n = osm_obj_new(OSM_TYPE_NODE, id, sizeof(*n));
192 void osm_node_dump(struct osm_node *n)
194 printf("Node %ju: (%f,%f)\n", (uintmax_t) n->o.id, n->x, n->y);
195 CLIST_FOR_EACH(struct osm_tag *, t, n->o.tags)
199 void osm_node_dump_all(void)
201 printf("Known nodes:\n");
202 CLIST_FOR_EACH(struct osm_node *, n, osm_obj_list[OSM_TYPE_NODE])
209 struct osm_way *osm_way_new(osm_id_t id)
211 struct osm_way *w = osm_obj_new(OSM_TYPE_WAY, id, sizeof(*w));
212 clist_init(&w->nodes);
216 void osm_way_add_node(struct osm_way *w, struct osm_node *n)
218 osm_ref_add(&w->o, &w->nodes, &n->o, 0);
221 void osm_way_dump(struct osm_way *w)
223 printf("Way %ju%s\n", (uintmax_t) w->o.id, (osm_way_cyclic_p(w) ? " (cyclic)" : ""));
224 CLIST_FOR_EACH(struct osm_tag *, t, w->o.tags)
226 OSM_FOR_EACH_BEGIN(struct osm_node *, n, w->nodes)
228 printf("\tNode %ju\n", (uintmax_t) n->o.id);
233 void osm_way_dump_all(void)
235 printf("Known ways:\n");
236 CLIST_FOR_EACH(struct osm_way *, w, osm_obj_list[OSM_TYPE_WAY])
241 bool osm_way_cyclic_p(struct osm_way *w)
243 struct osm_ref *first_ref = clist_head(&w->nodes);
244 struct osm_ref *last_ref = clist_tail(&w->nodes);
245 return (first_ref && last_ref &&
246 first_ref != last_ref &&
247 first_ref->o == last_ref->o);
252 struct osm_relation *osm_relation_new(osm_id_t id)
254 struct osm_relation *r = osm_obj_new(OSM_TYPE_RELATION, id, sizeof(*r));
255 clist_init(&r->members);
259 void osm_relation_add_member(struct osm_relation *r, struct osm_object *o, const char *role)
261 osm_ref_add(&r->o, &r->members, o, (role && role[0] ? osm_val_encode(role) : 0));
264 void osm_relation_dump(struct osm_relation *r)
266 printf("Relation %ju\n", (uintmax_t) r->o.id);
267 CLIST_FOR_EACH(struct osm_tag *, t, r->o.tags)
269 CLIST_FOR_EACH(struct osm_ref *, f, r->members)
270 printf("\tRole %s: %s %ju\n", (f->role ? osm_val_decode(f->role) : "<none>"), osm_obj_type_names[f->o->type], (uintmax_t) f->o->id);
273 void osm_relation_dump_all(void)
275 printf("Known relations:\n");
276 CLIST_FOR_EACH(struct osm_relation *, r, osm_obj_list[OSM_TYPE_RELATION])
277 osm_relation_dump(r);
281 /*** Multipolygons ***/
283 void osm_multipolygon_dump(struct osm_multipolygon *m)
285 printf("Multipolygon %ju\n", (uintmax_t) m->o.id);
286 CLIST_FOR_EACH(struct osm_tag *, t, m->o.tags)
288 CLIST_FOR_EACH(struct osm_mpg_boundary *, b, m->boundaries)
290 printf("\tBoundary inner=%u\n", b->inner);
291 CLIST_FOR_EACH(struct osm_ref *, f, b->nodes)
292 printf("\t\tNode %ju\n", (uintmax_t) f->o->id);
296 void osm_multipolygon_dump_all(void)
298 printf("Known multipolygons:\n");
299 CLIST_FOR_EACH(struct osm_multipolygon *, r, osm_obj_list[OSM_TYPE_MULTIPOLYGON])
300 osm_multipolygon_dump(r);
304 static struct mempool *mpg_pool;
305 static struct osm_multipolygon *mpg_current;
309 struct osm_object *o;
310 clist edges; // of mpg_edge's
316 struct mpg_edge *twin;
317 struct mpg_vertex *dest;
321 #define HASH_NODE struct mpg_vertex
322 #define HASH_PREFIX(x) mpg_vertex_hash_##x
323 #define HASH_KEY_ATOMIC id
324 #define HASH_ATOMIC_TYPE osm_id_t
325 #define HASH_USE_POOL mpg_pool
326 #define HASH_TABLE_ALLOC
327 #define HASH_WANT_LOOKUP
328 #define HASH_LOOKUP_DETECT_NEW
329 #include <ucw/hashtable.h>
331 static void mpg_insert_way(struct osm_way *w)
333 struct mpg_vertex *prev = NULL;
334 OSM_FOR_EACH_BEGIN(struct osm_node *, n, w->nodes)
337 struct mpg_vertex *v = mpg_vertex_hash_lookup(n->o.id, &new);
340 clist_init(&v->edges);
346 struct mpg_edge *e1 = mp_alloc_zero(mpg_pool, sizeof(*e1));
347 struct mpg_edge *e2 = mp_alloc_zero(mpg_pool, sizeof(*e2));
350 clist_add_tail(&prev->edges, &e1->n);
353 clist_add_tail(&v->edges, &e2->n);
360 static void UNUSED mpg_dump(void)
362 printf("=== Multipolygon graph for relation %ju ===\n", (uintmax_t) mpg_current->o.id);
363 HASH_FOR_ALL(mpg_vertex_hash, v)
365 printf("Vertex %ju\n", (uintmax_t) v->id);
366 CLIST_FOR_EACH(struct mpg_edge *, e, v->edges)
367 printf("\t-> %ju\n", (uintmax_t) e->dest->id);
373 static void mpg_walk_boundary(struct osm_multipolygon *m, bool inner)
375 // FIXME: Replace by a better algorithm, which respects geometry
376 // and is able to cope with higher degree vertices.
377 HASH_FOR_ALL(mpg_vertex_hash, v)
381 struct osm_mpg_boundary *b = mp_alloc(osm_pool, sizeof(*b));
382 clist_add_tail(&m->boundaries, &b->n);
384 clist_init(&b->nodes);
386 struct mpg_vertex *w = v;
390 struct osm_ref *f = mp_alloc(osm_pool, sizeof(*f));
391 clist_add_tail(&b->nodes, &f->n);
395 struct mpg_vertex *dest = NULL;
396 CLIST_FOR_EACH(struct mpg_edge *, e, w->edges)
403 osm_obj_warn(&mpg_current->o, "Suspicious vertex degree of node %ju", (uintmax_t) w->o->id);
418 osm_obj_warn(&mpg_current->o, "Boundary not closed at node %ju", (uintmax_t) w->o->id);
420 struct osm_ref *f = mp_alloc(osm_pool, sizeof(*f));
421 clist_add_tail(&b->nodes, &f->n);
429 static void osm_multipolygon_make(struct osm_relation *r)
431 struct osm_multipolygon *m = osm_obj_new(OSM_TYPE_MULTIPOLYGON, r->o.id, sizeof(*m));
434 CLIST_FOR_EACH(struct osm_tag *, t, r->o.tags)
435 osm_obj_add_tag_raw(&m->o, t->key, t->val);
436 clist_init(&m->boundaries);
438 for (int inner=0; inner<2; inner++)
441 mpg_pool = mp_new(4096);
442 mpg_vertex_hash_init();
444 CLIST_FOR_EACH(struct osm_ref *, f, r->members)
446 struct osm_object *o = f->o;
447 if (f->role != VALUE_INNER && f->role != VALUE_OUTER)
450 osm_obj_warn(o, "Unknown role %s in multipolygon relation", osm_val_decode(f->role));
453 if ((f->role == VALUE_INNER) != inner)
455 if (o->type == OSM_TYPE_WAY)
456 mpg_insert_way((struct osm_way *) o);
458 osm_obj_warn(o, "Only ways are supported in multipolygon boundaries");
461 if (debug_dump_multipolygons)
464 mpg_walk_boundary(m, inner);
469 void osm_make_multipolygons(void)
473 CLIST_FOR_EACH(struct osm_relation *, r, osm_obj_list[OSM_TYPE_RELATION])
474 if (osm_obj_find_tag(&r->o, KEY_TYPE) == VALUE_MULTIPOLYGON)
476 osm_multipolygon_make(r);
479 msg(L_INFO, "Converted %u relations to multipolygons", mpg_cnt);
484 static projPJ osm_pj;
486 void osm_project(const char *spec)
488 osm_pj = pj_init_plus(spec);
490 die("Unable to initialize projection %s", spec);
492 CLIST_FOR_EACH(struct osm_node *, n, osm_obj_list[OSM_TYPE_NODE])
495 p.u = n->x * DEG_TO_RAD;
496 p.v = n->y * DEG_TO_RAD;
497 p = pj_fwd(p, osm_pj);
503 /*** Object centers ***/
505 bool osm_obj_center(struct osm_object *o, double *xp, double *yp)
511 struct osm_node *n = (struct osm_node *) o;
518 struct osm_way *w = (struct osm_way *) o;
519 double sx = 0, sy = 0;
521 OSM_FOR_EACH_BEGIN(struct osm_node *, n, w->nodes)
534 case OSM_TYPE_MULTIPOLYGON:
536 struct osm_multipolygon *m = (struct osm_multipolygon *) o;
537 double sx = 0, sy = 0;
539 CLIST_FOR_EACH(struct osm_mpg_boundary *, b, m->boundaries)
543 OSM_FOR_EACH_BEGIN(struct osm_node *, n, b->nodes)
566 osm_pool = mp_new(65536);
567 for (int i=0; i<OSM_TYPE_MAX; i++)
569 clist_init(&osm_obj_list[i]);
570 osm_id_hash_init(&osm_id_hash[i]);
579 osm_relation_dump_all();
580 osm_multipolygon_dump_all();