]> mj.ucw.cz Git - leo.git/blob - labeller.c
80d69e8f1bdf755a7c8108f476b38c1f43cf1d0e
[leo.git] / labeller.c
1 #include <ucw/lib.h>
2 #include <ucw/gary.h>
3 #include <ucw/mempool.h>
4 #include <ucw/eltpool.h>
5
6 #include "leo.h"
7 #include "sym.h"
8 #include "map.h"
9 #include "labeller.h"
10
11 #define HASH_NODE struct graph_node
12 #define HASH_PREFIX(x) hash_##x
13 #define HASH_KEY_ATOMIC id
14 #define HASH_WANT_FIND
15 #define HASH_WANT_NEW
16 #define HASH_WANT_CLEANUP
17 #include <ucw/hashtable.h>
18
19 #include <stdio.h>
20 #include <stdlib.h>
21 #include <math.h>
22 #include <fcntl.h>
23 #include <limits.h>
24
25 #define BLOCK_SIZE 4096
26
27 static struct request_point *requests_point;
28 static struct request_line *requests_line;
29 static struct request_area *requests_area;
30
31 static struct graph_edge **bfs_queue;
32 static struct longline *longlines;
33 static struct buffer_line *buffer_line;
34 static struct buffer_linelabel *buffer_linelabel;
35
36 struct eltpool *ep_individuals;
37
38 struct individual **population1;
39 struct individual **population2;
40
41 int dbg_segments = VERBOSITY_NONE;
42 int dbg_plan = VERBOSITY_NONE;
43 int dbg_requests = VERBOSITY_NONE;
44 int dbg_graph = VERBOSITY_NONE;
45 int dbg_bfs = VERBOSITY_NONE;
46 int dbg_map_parts = VERBOSITY_NONE;
47 int dbg_movement = VERBOSITY_NONE;
48 int dbg_init = VERBOSITY_NONE;
49 int dbg_overlaps = VERBOSITY_NONE;
50 int dbg_rank = VERBOSITY_NONE;
51 int dbg_evolution = VERBOSITY_INDIVIDUAL;
52 int dbg_mutation = VERBOSITY_NONE;
53 int dbg_breeding = VERBOSITY_NONE;
54
55 int page_width_int;
56 int page_height_int;
57
58 int num_nodes;
59 int num_edges = 0;
60 int dbg_num_hits = 0;
61
62 int conf_pop_size = 50;
63 int conf_fit_size = 1;
64
65 int conf_penalty_bound = 0;
66 int conf_stagnation_bound = 0;
67 int conf_iteration_limit = 100;
68
69 int conf_term_cond = TERM_COND_ITERATIONS;
70
71 double conf_breed_pop_size = 0.4;
72 double conf_breed_rbest = 0.2;
73
74 int breed_pop_size;
75 int breed_rbest_size;
76
77 bool conf_mutate_children = 1;
78 double conf_mutate_children_prob = 1.0;
79
80 double conf_mutate_pop_size = 0.4;
81 double conf_mutate_rbest = 0.2;
82
83 double conf_mutate_move_bound = 0.1;
84 double conf_mutate_regen_bound = 0.0;
85 double conf_mutate_chvar_bound = 0.0;
86
87 int mutate_pop_size;
88 int mutate_rbest_size;
89
90 double conf_elite_pop_size = 0.2;
91 int elite_pop_size;
92
93 double conf_max_section_length = 100;
94 double conf_max_section_overlay = 10;
95
96 int old_best = INT_MAX;
97 int iteration = 0;
98 int pop2_ind;
99
100 // In milimeters
101 int move_min = 0;
102 int move_max = 5;
103
104 int num_requests = 0;
105 int num_placements = 0;
106
107 // In milimeters
108 int conf_map_part_width = 5;
109 int conf_map_part_height = 5;
110
111 uns num_map_parts_row;
112 uns num_map_parts_col;
113 uns num_map_parts;
114
115 void compute_sizes(void);
116
117 void make_population(void);
118 bool shall_terminate(void);
119 void breed(void);
120 void mutate(void);
121 void elite(void);
122 void rank_population(void);
123 void plan_individual(struct individual *individual);
124
125 int overlaps(struct placement *p1, struct placement *p2);
126 int get_overlap(struct placement *p);
127 int individual_overlap(struct individual *individual);
128
129 double get_distance(struct placement *p);
130 double individual_distances(struct individual *individual);
131
132 double get_omittment(struct placement *p);
133 double individual_omittment(struct individual *individual);
134
135 struct individual **perform_crossover(struct individual *parent1, struct individual *parent2);
136 void perform_mutation(struct individual *individual);
137 void init_placement(struct placement *p, struct individual *individual, struct request *r);
138 void init_individual(struct individual *i);
139 void copy_individual(struct individual *src, struct individual *dest);
140 int cmp_individual(const void *a, const void *b);
141
142 void clear_individual(struct individual *individual);
143 void clear_population(struct individual **pop);
144
145 void make_bitmap(struct variant *v, struct symbol *sym);
146 void make_bitmap_icon(struct variant *v, struct sym_icon *si);
147 void make_bitmap_point(struct variant *v, struct sym_point *sp);
148 void make_bitmap_label(struct variant *v, struct sym_text *text);
149
150 double gen_movement(void);
151 double gen_movement_uniform(void);
152 void move_symbol(struct placement *p);
153 void move_symbol_point(struct placement *p);
154 void move_symbol_segment(struct placement *p);
155 void hide_segment_labels(struct individual *individual);
156
157 void gen_coords(struct placement *p);
158 void gen_coords_point(struct placement *p);
159 void gen_coords_segment(struct placement *p);
160 void gen_coords_area(struct placement *p);
161
162 struct map_part **get_map_parts(struct placement *p);
163 void update_map_parts(struct placement *p);
164 void update_map_parts_delete(struct placement *p);
165 void update_map_parts_create(struct placement *p);
166 struct placement **get_closure(struct placement *placement);
167 void copy_symbols(struct placement **closure, struct individual *parent, struct individual *child, bool **processed_ptr);
168 struct placement **get_overlapping(struct placement *p);
169 struct placement **filter(struct placement **list, bool **pred_ptr);
170
171
172 void make_graph(void);
173 void label_graph(void);
174 void bfs_wrapper(void);
175 void bfs(uns longline);
176 void bfs_edge(struct graph_edge *e, struct graph_node *node, struct graph_node *anode, enum edge_dir dir);
177 void make_segments(void);
178
179 void cut_edge(struct graph_edge *e, double dist);
180 struct request_line *make_new_line(void);
181 struct request_section *make_new_section(struct request_line *rl);
182 struct request_segment *make_new_segment(struct request_section *rls, struct symbol *sym);
183
184 void dump_bitmaps(struct individual *individual);
185 void dump_graph(void);
186 void dump_longlines(void);
187 void dump_linelabel_requests(void);
188 void dump_individual(struct individual *individual);
189 void dump_label(struct symbol *sym);
190 void dump_penalties(struct individual **population);
191
192 int randint(int min, int max);
193 int flip(int a, int b);
194 double randdouble(void);
195
196 int max2(int a, int b);
197 int min2(int a, int b);
198 int max4(int a, int b, int c, int d);
199 int min4(int a, int b, int c, int d);
200
201 struct placement dummy_placement;
202
203 int max2(int a, int b)
204 {
205   return (a > b ? a : b);
206 }
207
208 int min2(int a, int b)
209 {
210   return (a < b ? a : b);
211 }
212
213 int max4(int a, int b, int c, int d)
214 {
215   return max2(max2(a, b), max2(c, d));
216 }
217
218 int min4(int a, int b, int c, int d)
219 {
220   return min2(min2(a, b), min2(c, d));
221 }
222
223 void dump_label(struct symbol *sym)
224 {
225   switch (sym->type)
226   {
227     case SYMBOLIZER_TEXT: ;
228       struct sym_text *st = (struct sym_text *) sym;
229       printf("%s\n", osm_val_decode(st->text));
230     default:
231       // FIXME
232       ;
233   }
234 }
235
236 void labeller_init(void)
237 {
238   GARY_INIT(requests_point, 0);
239   GARY_INIT(requests_line, 0);
240   GARY_INIT(requests_area, 0);
241   GARY_INIT(buffer_line, 0);
242   GARY_INIT(buffer_linelabel, 0);
243   ep_individuals = ep_new(sizeof(struct individual), 1);
244
245   compute_sizes();
246 }
247
248 void make_bitmap(struct variant *v, struct symbol *sym)
249 {
250   v->offset_x = v->offset_y = 0;
251
252   switch (sym->type)
253   {
254     case SYMBOLIZER_POINT:
255       make_bitmap_point(v, (struct sym_point *) sym);
256       break;
257     case SYMBOLIZER_ICON:
258       make_bitmap_icon(v, (struct sym_icon *) sym);
259       break;
260     case SYMBOLIZER_TEXT:
261       make_bitmap_label(v, (struct sym_text *) sym);
262       break;
263     default:
264       ASSERT(sym->type != SYMBOLIZER_INVALID);
265   }
266 }
267
268 void make_bitmap_icon(struct variant *v, struct sym_icon *si)
269 {
270   v->width = si->sir.width + 1;
271   v->height = si->sir.height + 1;
272   v->bitmap = malloc(v->width * v->height * sizeof(bool));
273   for (int i=0; i<v->width*v->height; i++) v->bitmap[i] = 1;
274 }
275
276 void make_bitmap_point(struct variant *v, struct sym_point *sp)
277 {
278   v->width = v->height = sp->size + 1;
279   v->bitmap = malloc(v->width * v->height * sizeof(bool));
280   // FIXME: Okay, memset would be much nicer here
281   for (int i=0; i<sp->size*sp->size; i++) v->bitmap[i] = 1;
282 }
283
284 void make_bitmap_label(struct variant *v, struct sym_text *text)
285 {
286   int tw = ceil(text->tw);
287   int th = ceil(text->th);
288
289   double rotate_rad = text->rotate / (-180 / M_PI);
290
291   // Initially, ll = [0; 0], lr = [tw, 0], ul = [0, th], ur = [tw, th]
292   // They could be declared before but should not be initialized in code
293   // as reassigning x-coordinate affects computation of y-cordinate
294   int llx = 0;
295   int lly = 0;
296
297   int lrx = tw * cos(rotate_rad);
298   int lry = tw * sin(rotate_rad);
299
300   int ulx = th * sin(rotate_rad);
301   int uly = th * cos(rotate_rad);
302
303   int urx = tw * cos(rotate_rad) + th * sin(rotate_rad);
304   int ury = tw * sin(rotate_rad) + th * cos(rotate_rad);
305
306   int min_x = min4(llx, lrx, ulx, urx);
307   int min_y = min4(lly, lry, uly, ury);
308   int max_x = max4(llx, lrx, ulx, urx);
309   int max_y = max4(lly, lry, uly, ury);
310
311   v->width = max_x - min_x + 1;
312   v->height = max_y - min_y + 1;
313   v->bitmap = malloc(v->width * v->height * sizeof(bool));
314   memset(v->bitmap, 0, v->width * v->height * sizeof(bool));
315
316   for (int i=0; i<th; i++)
317   {
318     for (int j=0; j<tw; j++)
319     {
320       int nx = j*cos(rotate_rad) + i*sin(rotate_rad);
321       int ny = j*sin(rotate_rad) + i*cos(rotate_rad);
322       v->bitmap[(ny-min_y)*v->width + (nx-min_x)] = 1;
323     }
324   }
325 }
326
327 void labeller_add_point(struct symbol *sym, struct osm_object *object, z_index_t zindex)
328 {
329   if (dbg_requests >= VERBOSITY_PLACEMENT)
330     printf("Adding point\n");
331   if (object->type != OSM_TYPE_NODE)
332   {
333     printf("Warning: Point label requested on non-point object\n");
334     return;
335   }
336
337   struct request_point *r = GARY_PUSH(requests_point);
338
339   r->request.type = REQUEST_POINT;
340   r->request.ind = num_requests++;
341
342   r->sym = sym;
343   r->zindex = zindex;
344
345   r->offset_x = 0;
346   r->offset_y = 0;
347
348   r->num_variants = 1;
349   GARY_INIT(r->request.variants, 0);
350
351   struct variant *v = GARY_PUSH(r->request.variants);
352
353   struct osm_node *n = (struct osm_node *) object; // FIXME: Compiler warning
354   r->x = n->x;
355   r->y = n->y;
356   make_bitmap(v, sym);
357   switch (sym->type)
358   {
359     case SYMBOLIZER_ICON:
360       // FIXME: Really?
361       r->x = ((struct sym_icon *)sym)->sir.x;
362       r->y = ((struct sym_icon *)sym)->sir.y;
363       break;
364     default:
365       // FIXME
366       return;
367   }
368
369   if (dbg_requests >= VERBOSITY_PLACEMENT)
370     printf("Inited point to [%.2f; %.2f] on %u\n", r->x, r->y, r->zindex);
371 }
372
373 void labeller_add_line(struct symbol *sym, z_index_t zindex)
374 {
375   if (dbg_requests >= VERBOSITY_PLACEMENT)
376     printf("Adding line on %u\n", zindex);
377   struct buffer_line *b = GARY_PUSH(buffer_line);
378   b->line = (struct sym_line *) sym;
379   b->zindex = zindex;
380   sym_plan(sym, zindex);
381 }
382
383 void labeller_add_linelabel(struct symbol *sym, struct osm_object *o, z_index_t zindex)
384 {
385   if (o->type != OSM_TYPE_WAY)
386   {
387     printf("Linelabel request on object which is not way\n");
388     return;
389   }
390
391   if (dbg_requests >= VERBOSITY_PLACEMENT)
392     printf("Labelling way %ju on %u\n", o->id, zindex);
393   struct buffer_linelabel *ll = GARY_PUSH(buffer_linelabel);
394   ll->way = (struct osm_way *) o;
395   ll->label = sym;
396   ll->zindex = zindex;
397 }
398
399 void labeller_add_arealabel(struct symbol *sym, struct osm_object *o, z_index_t zindex)
400 {
401   if (dbg_requests >= VERBOSITY_PLACEMENT)
402     printf("Adding area on %u\n", zindex);
403   struct request_area *r = GARY_PUSH(requests_area);
404
405   r->request.type = REQUEST_AREA;
406   r->request.ind = num_requests++;
407
408   r->o = (struct osm_multipolygon *) o;
409   r->zindex = zindex;
410   r->label = sym;
411
412   osm_obj_center(o, &(r->cx), &(r->cy));
413
414   GARY_INIT(r->request.variants, 0);
415   struct variant *v = GARY_PUSH(r->request.variants);
416   make_bitmap(v, sym);
417 }
418
419 void make_graph(void)
420 {
421   hash_init();
422   struct mempool *mp_edges = mp_new(BLOCK_SIZE);
423
424   if (dbg_graph >= VERBOSITY_GENERAL)
425     printf("Extracting nodes, will iterate over %lld ways\n", GARY_SIZE(buffer_line));
426   for (uns i=0; i<GARY_SIZE(buffer_line); i++)
427   {
428     struct osm_way *way = (struct osm_way *) buffer_line[i].line->s.o;
429     struct graph_node *g_prev = NULL;
430     struct osm_node *o_prev = NULL;
431
432     CLIST_FOR_EACH(struct osm_ref *, ref, way->nodes)
433     {
434       // FIXME: Shall osm_object's type be checked here?
435       struct osm_node *o_node = (struct osm_node *) ref->o;
436
437       struct graph_node *g_node = hash_find(ref->o->id);
438       if (!g_node)
439       {
440         g_node = hash_new(ref->o->id);
441         GARY_INIT(g_node->edges, 0);
442         g_node->o = o_node;
443         g_node->id = ref->o->id;
444         g_node->num = num_nodes++;
445       }
446
447       if (! g_prev)
448       {
449         g_prev = g_node;
450         o_prev = o_node;
451         continue;
452       }
453
454       struct graph_edge *e = mp_alloc(mp_edges, sizeof(struct graph_edge));
455       e->num = num_edges++;
456       e->id = buffer_line[i].line->s.o->id;
457       e->color = buffer_line[i].line->color;
458       e->length = hypot(abs(o_prev->x - o_node->x), abs(o_prev->y - o_node->y));
459       e->visited = -1;
460       e->prev = NULL;
461       e->next = NULL;
462       e->n1 = g_prev;
463       e->n2 = g_node;
464       e->longline = (uns) -1;
465       e->line = buffer_line[i].line;
466       e->dir = DIR_UNSET;
467       e->label = NULL;
468
469       struct graph_edge **edge = GARY_PUSH(g_prev->edges);
470       *edge = e;
471       edge = GARY_PUSH(g_node->edges);
472       *edge = e;
473
474       g_prev = g_node;
475       o_prev = o_node;
476     }
477   }
478 }
479
480 void dump_graph(void)
481 {
482   HASH_FOR_ALL(hash, node)
483   {
484     printf("* Node: (%d) #%ju [%.2f; %.2f]\n", node->num, node->id, node->o->x, node->o->y);
485     for (uns i=0; i<GARY_SIZE(node->edges); i++)
486     {
487       struct graph_edge *e = node->edges[i];
488       printf("\t edge (%d) #%ju to ", e->num, e->id);
489       if (node->edges[i]->n1->id == node->id)
490         printf("(%d) #%ju [%.2f; %.2f]\n", e->n2->num, e->n2->id, e->n2->o->x, e->n2->o->y);
491       else if (node->edges[i]->n2->id == node->id)
492         printf("(%d) #%ju [%.2f; %.2f]\n", e->n1->num, e->n1->id, e->n1->o->x, e->n1->o->y);
493       else
494       {
495         // This shouldn't ever happen
496         printf("BEWARE! Edge is associated with a node it doesn't belongs to!\n");
497       }
498
499       printf("\t\t");
500
501       if ((node->edges[i]->label) && (node->edges[i]->label->type == SYMBOLIZER_TEXT)) printf(" labelled %s;", osm_val_decode(((struct sym_text *) node->edges[i]->label)->text));
502       else if ((node->edges[i]->label)) printf("Labelled\n");
503
504       printf(" colored %d;", node->edges[i]->color);
505       printf("   length %.2f", node->edges[i]->length);
506       printf("\n");
507     }
508   }
509   HASH_END_FOR;
510 }
511
512 void label_graph(void)
513 {
514   if (dbg_graph >= VERBOSITY_GENERAL)
515     printf("There are %u line labels requested\n", GARY_SIZE(buffer_linelabel));
516   for (uns i=0; i<GARY_SIZE(buffer_linelabel); i++)
517   {
518     if (buffer_linelabel[i].label->type == SYMBOLIZER_TEXT)
519     if (dbg_graph >= VERBOSITY_INDIVIDUAL)
520       printf("Labelling nodes of way %s\n", osm_val_decode(((struct sym_text *) buffer_linelabel[i].label)->text));
521     CLIST_FOR_EACH(struct osm_ref *, ref, buffer_linelabel[i].way->nodes)
522     {
523       if (dbg_graph >= VERBOSITY_PLACEMENT)
524         printf("Looking for node %ju\n", ref->o->id);
525       struct graph_node *n = hash_find(ref->o->id);
526       if (n == NULL)
527       {
528         printf("BEWARE! Requested node couldn't be found.\n");
529       }
530       else
531       {
532         if (dbg_graph >= VERBOSITY_ALL)
533           printf("Searching among %u edges\n", GARY_SIZE(n->edges));
534         for (uns j=0; j<GARY_SIZE(n->edges); j++)
535         {
536           if (n->edges[j]->id == buffer_linelabel[i].way->o.id)
537           {
538             if (dbg_graph >= VERBOSITY_ALL)
539               printf("Labelling node %ju\n", n->id);
540             n->edges[j]->label = buffer_linelabel[i].label;
541             n->edges[j]->zindex = buffer_linelabel[i].zindex;
542           }
543         }
544       }
545     }
546   }
547 }
548
549 void bfs_edge(struct graph_edge *e, struct graph_node *node, struct graph_node *anode, enum edge_dir dir)
550 {
551   if (dbg_bfs >= VERBOSITY_PLACEMENT)
552     printf("BFS edge called for edge %d (going %d) in direction %d\n", e->num, e->dir, dir);
553   struct graph_edge *candidate = NULL;
554
555   for (uns i=0; i<GARY_SIZE(node->edges); i++)
556   {
557     struct graph_edge *other = node->edges[i];
558     if ((other->longline != (uns) -1) && (other->longline != e->longline)) continue;
559
560     if ((uns) other->visited != e->longline) {
561     if (dbg_bfs >= VERBOSITY_PLACEMENT)
562       printf("Pushing new edge %d / %ju\n", other->num, other->id);
563     struct graph_edge **e_ptr = GARY_PUSH(bfs_queue);
564     *e_ptr = other;
565     other->visited = e->longline;
566     }
567
568     if (((other->n1->id == node->id) && (other->n2->id == anode->id)) ||
569         ((other->n2->id == node->id) && (other->n1->id == anode->id)))
570         continue;
571
572     if (((other->n1->id == node->id) || (other->n2->id == node->id)) &&
573         (e->label) && (other->label) &&
574         (e->label->type == SYMBOLIZER_TEXT) && (other->label->type == SYMBOLIZER_TEXT) &&
575         (((struct sym_text *) e->label)->text == ((struct sym_text *) other->label)->text))
576     {
577       if (! candidate || (other->length > candidate->length))
578       candidate = other;
579     }
580   }
581
582   if (candidate)
583   {
584     if (dbg_bfs >= VERBOSITY_PLACEMENT)
585       printf("New line in longline %u\n", e->longline);
586     struct graph_edge *other = candidate;
587       other->longline = e->longline;
588       other->dir = dir;
589       if (((dir == DIR_BWD) && (other->n1->id == node->id)) ||
590           ((dir == DIR_FWD) && (other->n2->id == node->id)))
591       {
592         struct graph_node *swp = other->n2;
593         other->n2 = other->n1;
594         other->n1 = swp;
595       }
596
597       switch (dir)
598       {
599         case DIR_BWD:
600           e->prev = other;
601           other->next = e;
602           longlines[other->longline].first = other;
603           break;
604         case DIR_FWD:
605           e->next = other;
606           other->prev = e;
607           break;
608         default:
609           printf("Oops\n");
610           ASSERT(0);
611       }
612   }
613 }
614
615 void bfs(uns longline)
616 {
617   if (dbg_bfs >= VERBOSITY_INDIVIDUAL)
618   {
619     printf("BFS called for longline %u\n", longline);
620     printf("%d longlines exist\n", GARY_SIZE(longlines));
621   }
622
623   for (uns i=0; i<GARY_SIZE(bfs_queue); i++)
624   {
625     struct graph_edge *cur = bfs_queue[i];
626     if (dbg_bfs >= VERBOSITY_PLACEMENT)
627       printf("Exploring new edge %d; %d remaining\n", cur->num, GARY_SIZE(bfs_queue));
628
629     cur->visited = longline;
630
631     if (cur->longline == (uns) -1)
632       continue;
633
634     if (cur->dir == DIR_UNSET)
635     {
636       cur->dir = DIR_CENTER;
637       bfs_edge(cur, cur->n1, cur->n2, DIR_BWD);
638       bfs_edge(cur, cur->n2, cur->n1, DIR_FWD);
639     }
640     else
641     {
642       switch (cur->dir)
643       {
644         case DIR_BWD:
645           bfs_edge(cur, cur->n1, cur->n2, cur->dir);
646           break;
647         case DIR_FWD:
648           bfs_edge(cur, cur->n2, cur->n1, cur->dir);
649           break;
650         default:
651           // FIXME
652           ;
653       }
654     }
655   }
656 }
657
658 void bfs_wrapper(void)
659 {
660   GARY_INIT(bfs_queue, 0);
661   GARY_INIT(longlines, 0);
662
663   HASH_FOR_ALL(hash, node)
664   {
665     for (uns i=0; i<GARY_SIZE(node->edges); i++)
666     {
667       if ((node->edges[i]->label) && (node->edges[i]->longline == (uns) -1))
668       {
669         GARY_PUSH(longlines);
670         longlines[GARY_SIZE(longlines)-1].first = node->edges[i];
671
672         if (dbg_bfs >= VERBOSITY_INDIVIDUAL)
673         {
674           printf("Running new BFS\n");
675           printf("Creating longline %u\n", GARY_SIZE(longlines)-1);
676         }
677
678         GARY_RESIZE(bfs_queue, 0);
679         struct graph_edge **e = GARY_PUSH(bfs_queue);
680         *e = node->edges[i];
681         node->edges[i]->longline = GARY_SIZE(longlines)-1;
682         bfs(node->edges[i]->longline);
683
684         if (dbg_bfs >= VERBOSITY_INDIVIDUAL)
685         {
686           printf("Joined %d edges\n", dbg_num_hits); dbg_num_hits = 0;
687           printf("Planned %u edges\n", GARY_SIZE(bfs_queue));
688         }
689       }
690     }
691   }
692   HASH_END_FOR;
693
694   GARY_FREE(bfs_queue);
695 }
696
697 void dump_longlines(void)
698 {
699   printf("*** Longlines dump\n");
700   for (uns i=0; i<GARY_SIZE(longlines); i++)
701   {
702     printf("Longline %u:", i);
703     struct graph_edge *e = longlines[i].first;
704     if ((e->label) && (e->label->type == SYMBOLIZER_TEXT))
705       printf(" labelled %s", osm_val_decode(((struct sym_text *) e->label)->text));
706     printf("\n");
707
708     while (e)
709     {
710       printf("\t#%ju (%d): [%.2f; %.2f] -- [%.2f; %.2f] (dir %d)\n",
711              e->id, e->num, e->n1->o->x, e->n1->o->y, e->n2->o->x, e->n2->o->y, e->dir);
712
713       e = e->next;
714     }
715   }
716 }
717
718 struct request_line *make_new_line(void)
719 {
720   struct request_line *rl = GARY_PUSH(requests_line);
721   rl->request.ind = num_requests++;
722   rl->request.type = REQUEST_LINE;
723   GARY_INIT(rl->sections, 0);
724   GARY_INIT(rl->request.variants, 0);
725
726   return rl;
727 }
728
729 struct request_section *make_new_section(struct request_line *rl)
730 {
731   struct request_section *rls = GARY_PUSH(rl->sections);
732   rls->request.ind = num_requests++;
733   rls->request.type = REQUEST_SECTION;
734   rls->num_segments = 0;
735   GARY_INIT(rls->segments, 0);
736   GARY_INIT(rls->request.variants, 0);
737
738   return rls;
739 }
740
741 struct request_segment *make_new_segment(struct request_section *rls, struct symbol *sym)
742 {
743   struct request_segment *rs = GARY_PUSH(rls->segments);
744   rls->num_segments++;
745
746   rs->request.ind = num_requests++;
747   rs->request.type = REQUEST_SEGMENT;
748
749   GARY_INIT(rs->request.variants, 0);
750   if (sym)
751   {
752     struct variant *v = GARY_PUSH(rs->request.variants);
753     make_bitmap(v, sym);
754   }
755
756   return rs;
757 }
758
759 void cut_edge(struct graph_edge *e, double dist)
760 {
761   if (dbg_segments >= VERBOSITY_PLACEMENT)
762     printf("Cutting [%.2f; %.2f] -- [%.2f; %.2f] to dist %.2f\n", e->n1->o->x, e->n1->o->y, e->n2->o->x, e->n2->o->y, dist);
763
764   struct graph_edge *new = malloc(sizeof(struct graph_edge));
765   *new = *e;
766   e->next = new;
767
768   switch (e->label->type)
769   {
770     case SYMBOLIZER_TEXT:
771       new->label = malloc(sizeof(struct sym_text));
772       *((struct sym_text *) new->label) = *((struct sym_text *) e->label);
773       break;
774     default:
775       ;
776   }
777
778   struct osm_node *n1 = e->n1->o;
779   struct osm_node *n2 = e->n2->o;
780
781   if ((n1->x == n2->x) && (n1->y == n2->y))
782   {
783     printf("[%.2f; %.2f] -- [%.2f; %.2f]\n", n1->x, n1->y, n2->x, n2->y);
784     if (dbg_segments >= VERBOSITY_PLACEMENT)
785       printf("Won't cut point\n");
786     return;
787   }
788
789   struct osm_node *n11 = malloc(sizeof(struct osm_node));
790   struct graph_node *gn = malloc(sizeof(struct graph_node));
791   gn->o = n11;
792   double vsize = sqrt(pow(n1->x - n2->x, 2) + pow(n1->y - n2->y, 2));
793   n11->x = n1->x + (n2->x - n1->x) / vsize * dist;
794   n11->y = n1->y + (n2->y - n1->y) / vsize * dist;
795
796   e->n2 = new->n1 = gn;
797
798   e->length = hypot(abs(n1->x - n11->x), abs(n1->y - n11->y));
799   new->length = hypot(abs(n11->x - n2->x), abs(n11->y - n2->y));
800   new->visited = 0;
801 }
802
803 void make_segments(void)
804 {
805   for (uns i=0; i<GARY_SIZE(longlines); i++)
806   {
807     // Skip lines which are not labelled
808     if (! (longlines[i].first && longlines[i].first->label))
809       continue;
810
811     struct request_line *request = make_new_line();
812     struct request_section *rls = make_new_section(request);
813     struct request_segment *rs = NULL;
814
815     struct graph_edge *e = longlines[i].first;
816     double cur_length = 0;
817
818     struct sym_text *st = NULL;
819     if (e->label->type == SYMBOLIZER_TEXT)
820     {
821       st = (struct sym_text *) e->label;
822     }
823     else
824     {
825       // FIXME: Should other label types be supported in future?
826       if (dbg_segments >= VERBOSITY_PLACEMENT)
827         printf("Warning: Skipping line\n");
828       continue;
829     }
830
831     if (dbg_segments >= VERBOSITY_INDIVIDUAL)
832       printf("New longline\n");
833
834     while (e)
835     {
836       if (e->visited < 0)
837       {
838         if (dbg_segments >= VERBOSITY_PLACEMENT)
839           printf("BEWARE: Edge cycle\n");
840         break;
841       }
842       e->visited = -1;
843
844       if (dbg_segments >= VERBOSITY_PLACEMENT)
845         printf("Taking edge from [%.2f; %.2f] to [%.2f; %.2f] of length %.2f\n", e->n1->o->x, e->n1->o->y, e->n2->o->x, e->n2->o->y, e->length);
846
847       if (st && (e->length < st->tw))
848       {
849         e = e->next;
850         if (dbg_segments >= VERBOSITY_PLACEMENT)
851           printf("Warning: Skipping segment\n");
852         continue;
853       }
854
855       if (cur_length + e->length > conf_max_section_length + conf_max_section_overlay)
856       {
857         if (dbg_segments >= VERBOSITY_PLACEMENT)
858           printf("Edge too long, length is %.2f; %.2f - %.2f = %.2f\n", e->length, conf_max_section_length, cur_length, conf_max_section_length - cur_length);
859         // HACK to prevent cutting to 0 lenght
860         cut_edge(e, max2(conf_max_section_length - cur_length, 2));
861       }
862
863       rs = make_new_segment(rls, NULL);
864       rs->label = malloc(sizeof(struct sym_text));
865       *((struct sym_text *) rs->label) = *((struct sym_text *) e->label);
866
867       rs->x1 = e->n1->o->x;
868       rs->y1 = e->n1->o->y;
869       rs->x2 = e->n2->o->x;
870       rs->y2 = e->n2->o->y;
871
872       rs->slope = (rs->y2 - rs->y1) / (rs->x2 - rs->x1);
873       ((struct sym_text *) rs->label)->rotate = atan(rs->slope) * (-180 / M_PI);
874       struct variant *v = GARY_PUSH(rs->request.variants);
875       make_bitmap(v, rs->label);
876
877       rs->zindex = e->zindex;
878
879       cur_length += e->length;
880       if (cur_length > conf_max_section_length)
881       {
882         if (dbg_segments >= VERBOSITY_PLACEMENT)
883           printf("Making new section, new length would be %f, allowed is %.2f / %.2f\n", cur_length + e->length, conf_max_section_length, conf_max_section_overlay);
884
885         rls = make_new_section(request);
886         cur_length = 0;
887       }
888
889       e = e->next;
890     }
891
892     if (request->sections[0].num_segments == 0)
893     {
894       if (dbg_segments >= VERBOSITY_INDIVIDUAL)
895         printf("WARNING: Longline without any segment, skipped\n");
896
897       struct request_section *rls = &request->sections[0];
898       GARY_FREE(rls->segments);
899       GARY_FREE(rls->request.variants);
900
901       struct request_line *rl = &requests_line[GARY_SIZE(requests_line)-1];
902       GARY_FREE(rl->sections);
903       GARY_FREE(rl->request.variants);
904
905       GARY_POP(requests_line);
906       num_requests -= 2;
907     }
908   }
909 }
910
911 void dump_linelabel_requests(void)
912 {
913   for (uns i=0; i<GARY_SIZE(requests_line); i++)
914   {
915     if (requests_line[i].sections[0].num_segments == 0)
916     {
917       if (dbg_segments >= VERBOSITY_INDIVIDUAL)
918         printf("Beware: Longline without any segment\n");
919       continue;
920     }
921
922     printf("Request for linelabel, %d sections\n", GARY_SIZE(requests_line[i].sections));
923     dump_label(requests_line[i].sections[0].segments[0].label);
924     for (uns j=0; j<GARY_SIZE(requests_line[i].sections); j++)
925     {
926       printf("%d section, %d segments\n", j, GARY_SIZE(requests_line[i].sections[j].segments));
927       for (uns k=0; k<GARY_SIZE(requests_line[i].sections[j].segments); k++)
928       {
929         struct request_segment *rs = &requests_line[i].sections[j].segments[k];
930         printf("[%.2f; %.2f] -- [%.2f; %.2f]\n", rs->x1, rs->y1, rs->x2, rs->y2);
931       }
932     }
933     printf("\n");
934   }
935 }
936
937 void dump_bitmaps(struct individual *individual)
938 {
939   bool *bitmap = malloc(page_width_int * page_height_int * sizeof(bool));
940   printf("Bitmap size is %d\n", page_width_int * page_height_int);
941   for (int i=0; i<page_height_int; i++)
942     for (int j=0; j<page_width_int; j++)
943       bitmap[i*page_width_int + j] = 0;
944
945   int total = 0;
946   for (uns i=0; i<GARY_SIZE(individual->placements); i++)
947   {
948     if (individual->placements[i].variant_used == -1) continue;
949
950     struct placement *p = &(individual->placements[i]);
951     struct variant *v = NULL;
952
953     switch (p->request->type)
954     {
955       case REQUEST_SEGMENT: ;
956       case REQUEST_POINT: ;
957       case REQUEST_AREA: ;
958         v = &(p->request->variants[p->variant_used]);
959         break;
960       default:
961         ASSERT(p->request->type != REQUEST_INVALID);
962         continue;
963     }
964
965     int base_x = p->x; int base_y = p->y;
966     for (int dr = max2(0, 0-p->y); dr < v->height; dr++)
967     {
968       for (int dc = max2(0, 0-p->x); dc < v->width; dc++)
969       {
970         if (v->bitmap[dr * v->width + dc])
971         {
972           if (bitmap[(base_y + dr) * page_width_int + (base_x + dc)]) total += 1;
973           bitmap[(base_y + dr) * page_width_int + (base_x + dc)] = 1;
974         }
975       }
976     }
977   }
978   if (dbg_overlaps >= VERBOSITY_GENERAL)
979     printf("There were %d collisions during bitmap dump\n", total);
980
981   FILE *fd_dump = fopen("dump.pbm", "w");
982   fprintf(fd_dump, "P1\n");
983   fprintf(fd_dump, "%d %d\n", page_width_int, page_height_int);
984   for (int i=0; i<page_height_int; i++)
985   {
986     for (int j=0; j<page_width_int; j++)
987     {
988       fprintf(fd_dump, "%d", bitmap[(int) (i*page_width_int + j)] ? 1 : 0);
989     }
990     fprintf(fd_dump, "\n");
991   }
992   fclose(fd_dump);
993
994   free(bitmap);
995 }
996
997 void dump_individual(struct individual *individual)
998 {
999   printf("*** Individual dump\n");
1000   printf("(There are %d requests)\n", num_requests);
1001
1002   for (uns i=0; i<GARY_SIZE(individual->placements); i++)
1003   {
1004     struct placement *p = &(individual->placements[i]);
1005
1006     switch (p->request->type)
1007     {
1008       case REQUEST_POINT:
1009         printf("Point at [%.2f; %.2f] on %u\n", p->x, p->y, ((struct request_point *) p->request)->zindex);
1010         break;
1011       case REQUEST_LINE: ;
1012         struct request_line *rl = (struct request_line *) p->request;
1013         printf("Line: ");
1014         dump_label(rl->sections[0].segments[0].label);
1015         break;
1016       case REQUEST_SECTION: ;
1017         printf("*");
1018         break;
1019       case REQUEST_SEGMENT: ;
1020         if (p->variant_used >= 0)
1021           printf("Segment placed at [%.2f; %.2f] on %u\n", p->x, p->y, ((struct request_segment *) p->request)->zindex);
1022         else
1023           printf("Segment not placed\n");
1024         break;
1025       case REQUEST_AREA: ;
1026         struct request_area *ra = (struct request_area *) p->request;
1027         printf("Area label ");
1028         dump_label(ra->label);
1029         printf(" at [%.2f; %.2f] on %u\n", p->x, p->y, ((struct request_area *) p->request)->zindex);
1030         break;
1031       default:
1032         ASSERT(p->request->type != 0);
1033     }
1034   }
1035   printf("\nTotal penalty: %d\n", individual->penalty);
1036 }
1037
1038 void plan_individual(struct individual *individual)
1039 {
1040   for (uns i=0; i<GARY_SIZE(individual->placements); i++)
1041   {
1042     struct symbol *s = NULL;
1043     z_index_t zindex = 0;
1044     if (individual->placements[i].variant_used < 0) continue;
1045     switch (individual->placements[i].request->type)
1046     {
1047       case REQUEST_POINT: ;
1048         struct request_point *rp = (struct request_point *) individual->placements[i].request;
1049         s = rp->sym;
1050         zindex = rp->zindex;
1051         break;
1052       case REQUEST_SEGMENT: ;
1053         struct request_segment *rs = (struct request_segment *) individual->placements[i].request;
1054         s = rs->label;
1055         zindex = rs->zindex;
1056         break;
1057       case REQUEST_LINE: ;
1058         break;
1059       case REQUEST_AREA: ;
1060         struct request_area *ra = (struct request_area *) individual->placements[i].request;
1061         s = ra->label;
1062         zindex = ra->zindex;
1063         break;
1064       default:
1065         ASSERT(individual->placements[i].request != REQUEST_INVALID);
1066         continue;
1067     }
1068
1069   if (dbg_plan >= VERBOSITY_PLACEMENT)
1070     printf("Will plan symbol at [%.2f; %.2f] on %u\n", individual->placements[i].x, individual->placements[i].y, zindex);
1071
1072     if (s) switch (s->type)
1073     {
1074       case SYMBOLIZER_POINT: ;
1075         struct sym_point *sp = (struct sym_point *) s;
1076         sp->x = individual->placements[i].x;
1077         sp->y = individual->placements[i].y;
1078         sym_plan((struct symbol *) sp, zindex);
1079         break;
1080       case SYMBOLIZER_ICON: ;
1081         struct sym_icon *si = (struct sym_icon *) s;
1082         si->sir.x = individual->placements[i].x;
1083         si->sir.y = individual->placements[i].y;
1084         sym_plan((struct symbol *) si, zindex);
1085         break;
1086       case SYMBOLIZER_TEXT: ;
1087         struct sym_text *st = (struct sym_text *) s;
1088         st->x = individual->placements[i].x;
1089         st->y = individual->placements[i].y;
1090         st->next_duplicate = NULL;
1091         if (dbg_plan >= VERBOSITY_PLACEMENT)
1092           printf("Planning text %s at [%.2f; %.2f] on %u, with rotation %.2f\n", osm_val_decode(st->text), st->x, st->y, zindex, st->rotate);
1093         sym_plan((struct symbol *) st, zindex);
1094         break;
1095       default:
1096         ASSERT(s->type != SYMBOLIZER_INVALID);
1097     }
1098   }
1099 }
1100
1101 void dump_penalties(struct individual **population)
1102 {
1103   for (int i=0; i<conf_pop_size; i++)
1104   {
1105     printf("Individual %d has penalty %d\n", i, population[i]->penalty);
1106   }
1107 }
1108
1109 void compute_sizes(void)
1110 {
1111   page_width_int = floor(page_width);
1112   page_height_int = floor(page_height);
1113
1114   num_map_parts_row = (page_width_int + conf_map_part_width) / conf_map_part_width;
1115   num_map_parts_col = (page_height_int + conf_map_part_height) / conf_map_part_height;
1116   num_map_parts = num_map_parts_row * num_map_parts_col;
1117
1118   breed_pop_size = conf_breed_pop_size * conf_pop_size;
1119   breed_rbest_size = conf_breed_rbest * conf_pop_size;
1120   if (dbg_evolution >= VERBOSITY_GENERAL)
1121   {
1122     printf("Breeding parameters:\n");
1123     printf(" %d individuals are created\n", breed_pop_size);
1124     printf(" %d best individuals in old population are considered\n", breed_rbest_size);
1125   }
1126
1127   mutate_pop_size = conf_mutate_pop_size * conf_pop_size;
1128   mutate_rbest_size = conf_mutate_rbest * conf_pop_size;
1129   if (dbg_evolution >= VERBOSITY_GENERAL)
1130   {
1131     printf("Mutation parameters:\n");
1132     printf(" %d individuals are created\n", mutate_pop_size);
1133     printf(" %d best individuals in old population are considered\n", mutate_rbest_size);
1134   }
1135
1136   elite_pop_size = conf_elite_pop_size * conf_pop_size;
1137   if (dbg_evolution >= VERBOSITY_GENERAL)
1138   {
1139     printf("Elitism parameters:\n");
1140     printf(" %d best individuals are copied\n", elite_pop_size);
1141   }
1142
1143   if (breed_pop_size + mutate_pop_size + elite_pop_size != conf_pop_size)
1144   {
1145     if (conf_fit_size)
1146     {
1147       elite_pop_size += conf_pop_size - (breed_pop_size + mutate_pop_size + elite_pop_size);
1148     }
1149     else
1150     {
1151       fprintf(stderr, "Breeding + mutation + elitism won't create correct number of individuals\n");
1152       fprintf(stderr, "Please fix conf_breed_pop_size, conf_mutate_pop_size and conf_elite_pop_size parameters\n");
1153       exit(2);
1154     }
1155   }
1156 }
1157
1158 void labeller_label(void)
1159 {
1160   make_graph();
1161   label_graph();
1162   bfs_wrapper();
1163   make_segments();
1164
1165   GARY_INIT(population1, conf_pop_size);
1166   GARY_INIT(population2, conf_pop_size);
1167   make_population();
1168   rank_population();
1169   qsort(population1, conf_pop_size, sizeof(struct individual *), cmp_individual);
1170
1171   if (dbg_evolution >= VERBOSITY_GENERAL)
1172   {
1173     printf("Penalties after initialization\n");
1174     dump_penalties(population1);
1175   }
1176
1177   while (! shall_terminate())
1178   {
1179     iteration++;
1180     if (dbg_evolution)
1181       printf("\n*** Iteration %d ***\n", iteration);
1182
1183     breed();
1184     mutate();
1185     elite();
1186
1187     struct individual **swp = population1;
1188     population1 = population2;
1189     population2 = swp;
1190     pop2_ind = 0;
1191     clear_population(population2);
1192
1193     rank_population();
1194
1195     if (dbg_evolution >= VERBOSITY_GENERAL)
1196       printf("Sorting population\n");
1197     qsort(population1, conf_pop_size, sizeof(struct individual *), cmp_individual);
1198
1199     if (dbg_evolution >= VERBOSITY_GENERAL)
1200     {
1201       printf("Penalties after sort\n");
1202       dump_penalties(population1);
1203     }
1204
1205     old_best = population1[0]->penalty;
1206   }
1207
1208   if (dbg_overlaps >= VERBOSITY_GENERAL)
1209     dump_bitmaps(population1[0]);
1210
1211   plan_individual(population1[0]);
1212
1213   labeller_cleanup();
1214 }
1215
1216 void labeller_cleanup(void)
1217 {
1218   hash_cleanup();
1219   GARY_FREE(requests_point);
1220   GARY_FREE(requests_line);
1221   GARY_FREE(requests_area);
1222 }
1223
1224 void make_population(void)
1225 {
1226   for (int i=0; i<conf_pop_size; i++)
1227   {
1228     num_placements = 0; // FIXME: This IS a terrible HACK
1229     struct individual *i2 = ep_alloc(ep_individuals);
1230     init_individual(i2);
1231     population2[i] = i2;
1232
1233     if (dbg_init >= VERBOSITY_INDIVIDUAL)
1234       printf("Making individual %d\n", i);
1235     struct individual *individual = ep_alloc(ep_individuals); init_individual(individual);
1236     population1[i] = individual;
1237
1238     int p = 0;
1239     for (uns j=0; j<GARY_SIZE(requests_point); j++)
1240     {
1241       init_placement(&(individual->placements[p++]), individual, (struct request *) &requests_point[j]);
1242     }
1243
1244     for (uns j=0; j<GARY_SIZE(requests_line); j++)
1245     {
1246       init_placement(&(individual->placements[p++]), individual, (struct request *) &requests_line[j]);
1247
1248       for (uns k=0; k<GARY_SIZE(requests_line[j].sections); k++)
1249       {
1250         init_placement(&(individual->placements[p++]), individual, (struct request *) &requests_line[j].sections[k]);
1251
1252         for (uns l=0; l<GARY_SIZE(requests_line[j].sections[k].segments); l++)
1253         {
1254           init_placement(&(individual->placements[p++]), individual, (struct request *) &requests_line[j].sections[k].segments[l]);
1255         }
1256       }
1257     }
1258
1259     for (uns j=0; j<GARY_SIZE(requests_area); j++)
1260     {
1261       init_placement(&(individual->placements[p++]), individual, (struct request *) &requests_area[j]);
1262     }
1263
1264     hide_segment_labels(individual);
1265
1266     ASSERT(p == num_requests);
1267   }
1268 }
1269
1270 bool shall_terminate(void)
1271 {
1272   switch (conf_term_cond)
1273   {
1274     case TERM_COND_PENALTY:
1275       return (population1[0]->penalty < conf_penalty_bound);
1276     case TERM_COND_STAGNATION:
1277       return (abs(old_best - population1[0]->penalty) < conf_stagnation_bound);
1278     case TERM_COND_ITERATIONS:
1279       return (iteration >= conf_iteration_limit);
1280     default:
1281       fprintf(stderr, "Warning: No termination condition is set, terminating\n");
1282       return 1;
1283   }
1284 }
1285
1286 void breed(void)
1287 {
1288   int i=0;
1289
1290   struct individual **breed_buffer;
1291   while (i < breed_pop_size)
1292   {
1293     int parent1 = randint(0, breed_rbest_size);
1294     int parent2 = randint(0, breed_rbest_size);
1295     if (dbg_breeding >= VERBOSITY_INDIVIDUAL)
1296       printf("Will breed %d and %d\n", parent1, parent2);
1297
1298     breed_buffer = perform_crossover(population1[parent1], population1[parent2]);
1299     population2[pop2_ind++] = breed_buffer[0];
1300     population2[pop2_ind++] = breed_buffer[1];
1301     free(breed_buffer);
1302     i += 2;
1303   }
1304 }
1305
1306 struct individual **perform_crossover(struct individual *parent1, struct individual *parent2)
1307 {
1308   struct individual **buffer = malloc(2*sizeof(struct individual));
1309   struct individual *child1 = ep_alloc(ep_individuals); init_individual(child1);
1310   struct individual *child2 = ep_alloc(ep_individuals); init_individual(child2);
1311
1312   bool *processed;
1313   GARY_INIT_ZERO(processed, GARY_SIZE(parent1->placements));
1314
1315   for (uns i=0; i<GARY_SIZE(parent1->placements); i++)
1316   {
1317     if (! processed[parent1->placements[i].ind])
1318     {
1319       if (dbg_breeding >= VERBOSITY_PLACEMENT)
1320         printf("Creating symbol closure for placement %u\n", i);
1321
1322       struct placement **clos_symbols = get_closure(&(parent1->placements[i]));
1323       int x = randint(0, 2);
1324
1325       if (x == 0)
1326       {
1327         if (dbg_breeding >= VERBOSITY_PLACEMENT)
1328           printf("Copying parent->child 1->1 and 2->2\n");
1329         copy_symbols(clos_symbols, parent1, child1, &processed);
1330         copy_symbols(clos_symbols, parent2, child2, &processed);
1331       }
1332       else
1333       {
1334         if (dbg_breeding >= VERBOSITY_PLACEMENT)
1335           printf("Copying parent->child 2->1 and 1->2\n");
1336         copy_symbols(clos_symbols, parent2, child1, &processed);
1337         copy_symbols(clos_symbols, parent1, child2, &processed);
1338       }
1339
1340       GARY_FREE(clos_symbols);
1341     }
1342   }
1343
1344   GARY_FREE(processed);
1345
1346   if (conf_mutate_children)
1347   {
1348     if (randdouble() < conf_mutate_children_prob) perform_mutation(child1);
1349     else hide_segment_labels(child1);
1350
1351     if (randdouble() < conf_mutate_children_prob) perform_mutation(child2);
1352     else hide_segment_labels(child2);
1353   }
1354
1355   buffer[0] = child1;
1356   buffer[1] = child2;
1357   return buffer;
1358 }
1359
1360 void mutate(void)
1361 {
1362   for (int i=0; i < mutate_pop_size; i++)
1363   {
1364     if (dbg_mutation >= VERBOSITY_INDIVIDUAL)
1365       printf("Creating %d-th individual by mutation\n", i);
1366     int ind = randint(0, mutate_rbest_size);
1367     if (dbg_mutation >= VERBOSITY_INDIVIDUAL)
1368       printf("Mutating %d-th individual of original population\n", ind);
1369     population2[pop2_ind] = ep_alloc(ep_individuals);
1370     copy_individual(population1[ind], population2[pop2_ind]);
1371     if (dbg_mutation >= VERBOSITY_INDIVIDUAL)
1372       printf("Individual %d in pop2 inited from individual %d in pop1\n", pop2_ind, ind);
1373     perform_mutation(population2[pop2_ind]);
1374     pop2_ind++;
1375   }
1376 }
1377
1378 void perform_mutation(struct individual *individual)
1379 {
1380   for (uns i=0; i<GARY_SIZE(individual->placements); i++)
1381   {
1382     double x = randdouble();
1383     double acc = 0;
1384
1385     if (x <= acc + conf_mutate_move_bound)
1386     {
1387       if (dbg_mutation >= VERBOSITY_PLACEMENT)
1388         printf("Mutation: Moving symbol in placement %u\n", i);
1389       move_symbol(&(individual->placements[i]));
1390       continue;
1391     }
1392     acc += conf_mutate_move_bound;
1393
1394     if (x <= acc + conf_mutate_regen_bound)
1395     {
1396       gen_coords(&(individual->placements[i]));
1397       continue;
1398     }
1399     acc += conf_mutate_regen_bound;
1400
1401     if (x <= acc + conf_mutate_chvar_bound)
1402     {
1403       struct placement *p = &(individual->placements[i]);
1404       switch (p->request->type)
1405       {
1406         case REQUEST_POINT:
1407         case REQUEST_AREA:
1408           // Does nothing when there are 0 variants... does it mind?
1409           p->variant_used = randint(-1, GARY_SIZE(p->request->variants));
1410           break;
1411         case REQUEST_SEGMENT:
1412           p->variant_used = randint(0, GARY_SIZE(p->request->variants));
1413           break;
1414         case REQUEST_SECTION:
1415           p->variant_used = randint(0, GARY_SIZE(((struct request_section *) p->request)->segments));
1416           break;
1417         default:
1418           ;
1419       }
1420     }
1421   }
1422
1423   hide_segment_labels(individual);
1424 }
1425
1426 void elite(void)
1427 {
1428   for (int i=0; i<elite_pop_size; i++)
1429   {
1430     population2[pop2_ind] = ep_alloc(ep_individuals);
1431     copy_individual(population1[i], population2[pop2_ind++]);
1432   }
1433 }
1434
1435 int overlaps(struct placement *p1, struct placement *p2)
1436 {
1437   if (p1->request->type != REQUEST_POINT &&
1438       p1->request->type != REQUEST_SEGMENT &&
1439       p1->request->type != REQUEST_AREA)
1440     return 0;
1441
1442   if (p2->request->type != REQUEST_POINT &&
1443       p2->request->type != REQUEST_SEGMENT &&
1444       p2->request->type != REQUEST_AREA)
1445     return 0;
1446
1447   if (p1->variant_used == -1 || p2->variant_used == -1)
1448     return 0;
1449
1450   struct variant *v1, *v2;
1451
1452   v1 = &(p1->request->variants[p1->variant_used]);
1453   v2 = &(p2->request->variants[p2->variant_used]);
1454
1455   // FIXME: This doesn't fully respect offset which it probably should
1456   int p1x = p1->x; int p1y = p1->y;
1457   int p2x = p2->x; int p2y = p2->y;
1458
1459   int overlap = 0;
1460   for (int y=max2(0, max2(p1y, p2y)); y<min2(page_height_int, min2(p1y+v1->height, p2y+v2->height)); y++)
1461     for (int x=max2(0, max2(p1x, p2x)); x<min2(page_width_int, min2(p1x+v1->width, p2x+v2->width)); x++)
1462     {
1463       if (v1->bitmap[(y-p1y)*v1->width + (x-p1x)] &&
1464           v2->bitmap[(y-p2y)*v2->width + (x-p2x)])
1465         overlap++;
1466     }
1467
1468   return overlap;
1469 }
1470
1471 int get_overlap(struct placement *p)
1472 {
1473   if (p->variant_used == -1) return 0;
1474
1475   struct map_part **parts = get_map_parts(p);
1476   if (! parts)
1477   {
1478     if (dbg_overlaps >= VERBOSITY_PLACEMENT)
1479       printf("Placement of request %d seems not to be placed\n", p->request->ind);
1480     return 0;
1481   }
1482
1483   struct placement **others;
1484   bool *planned;
1485
1486   GARY_INIT_ZERO(planned, num_requests);
1487   planned[p->request->ind] = 1;
1488   GARY_INIT(others, 0);
1489
1490   for (uns i=0; i<GARY_SIZE(parts); i++)
1491   {
1492     struct map_placement *mp = parts[i]->placement->next_in_map;
1493     while (mp)
1494     {
1495       if (! planned[mp->placement->request->ind])
1496       {
1497         struct placement **p = GARY_PUSH(others);
1498         *p = mp->placement;
1499         planned[mp->placement->request->ind] = true;
1500       }
1501       mp = mp->next_in_map;
1502     }
1503   }
1504
1505   int overlap = 0;
1506   for (uns i=0; i<GARY_SIZE(others); i++)
1507   {
1508     overlap += overlaps(p, others[i]);
1509   }
1510
1511   GARY_FREE(planned);
1512   GARY_FREE(parts);
1513   GARY_FREE(others);
1514
1515   if (dbg_overlaps >= VERBOSITY_PLACEMENT)
1516     printf("Placement of request %d add %d to overlaps\n", p->request->ind, overlap);
1517
1518   if (p->x < 0) overlap += 0 - p->x;
1519   if (p->x + p->request->variants[p->variant_used].width > page_width_int)
1520     overlap += p->x + p->request->variants[p->variant_used].width - page_width_int;
1521
1522   if (p->y < 0) overlap += 0 - p->y;
1523   if (p->y + p->request->variants[p->variant_used].height > page_height_int)
1524     overlap += p->y + p->request->variants[p->variant_used].height - page_height_int;
1525
1526   return overlap;
1527 }
1528
1529 int individual_overlap(struct individual *individual)
1530 {
1531   int overlap = 0;
1532
1533   for (uns i=0; i<GARY_SIZE(individual->placements); i++)
1534   {
1535     overlap += get_overlap(&individual->placements[i]);
1536   }
1537
1538   return overlap;
1539 }
1540
1541 double get_distance(struct placement *p)
1542 {
1543   if (p->variant_used < 0) return 0;
1544   struct variant *v = &p->request->variants[p->variant_used];
1545
1546   double dx, dy, distance;
1547   switch (p->request->type)
1548   {
1549     case REQUEST_POINT: ;
1550       struct request_point *rp = (struct request_point *) p->request;
1551       dx = rp->x + v->offset_x - p->x;
1552       dy = rp->y + v->offset_y - p->y;
1553       distance = sqrt(dx*dx + dy*dy);
1554       if (dbg_rank >= VERBOSITY_PLACEMENT)
1555         printf("Point placed at [%.2f; %.2f], expected at [%.2f; %.2f]\n", p->x, p->y, rp->x, rp->y);
1556       break;
1557     case REQUEST_SEGMENT: ;
1558       struct request_segment *rs = (struct request_segment *) p->request;
1559       struct sym_text *st = (struct sym_text *) rs->label;
1560
1561       double width = p->request->variants[p->variant_used].width;
1562       double rotated_x = p->x + width * sin(st->rotate / (-180 / M_PI));
1563       double rotated_y = p->y + width * cos(st->rotate / (-180 / M_PI));
1564
1565       if (rs->x1 < rs->x2)
1566       {
1567         if (p->x < rs->x1)
1568         {
1569           dx = rs->x1 - p->x;
1570           dy = rs->y1 - p->y;
1571         }
1572         else if (rotated_x > rs->x2)
1573         {
1574           dx = rotated_x - rs->x2;
1575           dy = rotated_y - rs->y2;
1576         }
1577         else
1578         {
1579           dx = dy = 0;
1580         }
1581       }
1582       else
1583       {
1584         if (p->x < rs->x2)
1585         {
1586           dx = rs->x2 - p->x;
1587           dy = rs->y2 - p->y;
1588         }
1589         else if (rotated_x > rs->x1)
1590         {
1591           dx = rotated_x - rs->x1;
1592           dy = rotated_y - rs->y1;
1593         }
1594         else
1595         {
1596           dx = dy = 0;
1597         }
1598       }
1599
1600       distance = sqrt(dx*dx + dy*dy);
1601       break;
1602     case REQUEST_AREA: ;
1603       struct request_area *ra = (struct request_area *) p->request;
1604       dx = ra->cx + v->offset_x - p->x;
1605       dy = ra->cy + v->offset_y - p->y;
1606       distance = sqrt(dx*dx + dy*dy);
1607       if (dbg_rank >= VERBOSITY_PLACEMENT)
1608         printf("Area placed at [%.2f; %.2f], expected at [%.2f; %.2f]\n", p->x, p->y, ra->cx, ra->cy);
1609       break;
1610     default:
1611       return 0;
1612   }
1613
1614   if (dbg_rank >= VERBOSITY_PLACEMENT)
1615     printf("Placement %d has distance %.2f\n", p->ind, distance);
1616   return distance;
1617 }
1618
1619 double individual_distances(struct individual *individual)
1620 {
1621   int distances = 0;
1622
1623   for (uns i=0; i<GARY_SIZE(individual->placements); i++)
1624   {
1625     distances += get_distance(&individual->placements[i]);
1626   }
1627
1628   return distances;
1629 }
1630
1631 double get_omittment(struct placement *p)
1632 {
1633   if (p->variant_used >= 0) return 0;
1634
1635   // FIX ME :)
1636   switch (p->request->type)
1637   {
1638     case REQUEST_POINT:
1639     case REQUEST_AREA:
1640       return 10;
1641       break;
1642     default:
1643       return 0;
1644   }
1645 }
1646
1647 double individual_omittment(struct individual *individual)
1648 {
1649   int omittment = 0;
1650
1651   for (uns i=0; i<GARY_SIZE(individual->placements); i++)
1652   {
1653     omittment += get_omittment(&individual->placements[i]);
1654   }
1655
1656   return omittment;
1657 }
1658
1659 int cmp_individual(const void *a, const void *b)
1660 {
1661   struct individual **ia = (struct individual **) a;
1662   struct individual **ib = (struct individual **) b;
1663
1664   return (*ia)->penalty - (*ib)->penalty;
1665 }
1666
1667 void rank_population(void)
1668 {
1669   int penalty;
1670
1671   for (int i=0; i<conf_pop_size; i++)
1672   {
1673     if (dbg_rank >= VERBOSITY_INDIVIDUAL)
1674       printf("Individual %d\n", i);
1675     population1[i]->penalty = 0;
1676
1677     penalty = individual_omittment(population1[i]);
1678     if (dbg_rank >= VERBOSITY_INDIVIDUAL)
1679       printf("Increasing penalty by %d for omittment\n", penalty);
1680     population1[i]->penalty += penalty;
1681
1682     penalty = individual_overlap(population1[i]);
1683     if (dbg_rank >= VERBOSITY_INDIVIDUAL)
1684       printf("Increasing penalty by %d for overlap\n", penalty);
1685     population1[i]->penalty += penalty;
1686
1687     penalty = individual_distances(population1[i]);
1688     if (dbg_rank >= VERBOSITY_INDIVIDUAL)
1689       printf("Increasing penalty by %d for distances\n", penalty);
1690     population1[i]->penalty += penalty;
1691   }
1692 }
1693
1694 struct map_part **get_map_parts(struct placement *p)
1695 {
1696   if (p->variant_used < 0) return NULL;
1697
1698   struct map_part **buffer;
1699   GARY_INIT(buffer, 0);
1700
1701   if (dbg_map_parts >= VERBOSITY_PLACEMENT)
1702     printf("Looking for map parts containing placement of request %d, placed at [%.2f; %.2f]\n", p->request->ind, p->x, p->y);
1703
1704   struct variant v;
1705   switch (p->request->type)
1706   {
1707     case REQUEST_POINT:
1708     case REQUEST_SEGMENT:
1709     case REQUEST_AREA:
1710       v = p->request->variants[p->variant_used];
1711       break;
1712     default:
1713       if (dbg_map_parts >= VERBOSITY_ALL)
1714         printf("Skipping unsupported request type (%d)\n", p->request->type);
1715       return NULL;
1716   }
1717
1718   if (dbg_map_parts >= VERBOSITY_PLACEMENT)
1719     printf("Bitmap is %d x %d\n", v.width, v.height);
1720
1721   int x_min = max2(0, p->x) / conf_map_part_width;
1722   // CHECK ME: Is rounding needed?
1723   int x_max = min2(page_width_int, (p->x + v.width)) / conf_map_part_width;
1724   int y_min = max2(0, p->y) / conf_map_part_height;
1725   // CHECK ME: Is rounding needed?
1726   int y_max = min2(page_height_int, (p->y + v.height)) / conf_map_part_height;
1727
1728   if (dbg_map_parts >= VERBOSITY_PLACEMENT)
1729     printf("Cells between [%d; %d] and [%d; %d] generated\n", x_min, y_min, x_max, y_max);
1730
1731   for (int y=y_min; y<=y_max; y++)
1732     for (int x=x_min; x<=x_max; x++)
1733     {
1734       struct map_part **m = GARY_PUSH(buffer);
1735       if (dbg_map_parts >= VERBOSITY_ALL)
1736         printf("Asking for %d of %u\n", y * num_map_parts_row + x, GARY_SIZE(p->individual->map));
1737       *m = p->individual->map[y * num_map_parts_row + x];
1738     }
1739
1740   if (dbg_map_parts >= VERBOSITY_PLACEMENT)
1741     printf("Returning %u map parts potentially containing the symbol\n", GARY_SIZE(buffer));
1742
1743   return buffer;
1744 }
1745
1746 void update_map_parts_delete(struct placement *p)
1747 {
1748   struct map_placement *mp = p->map_links;
1749   while (mp)
1750   {
1751     mp->prev_in_map->next_in_map = mp->next_in_map;
1752     if (mp->next_in_map)
1753       mp->next_in_map->prev_in_map = mp->prev_in_map;
1754
1755     struct map_placement *tmp = mp;
1756     mp = mp->next_in_placement;
1757     free(tmp);
1758   }
1759   p->map_links = NULL;
1760 }
1761
1762 void update_map_parts_create(struct placement *p)
1763 {
1764   struct map_part **parts = get_map_parts(p);
1765   if (parts == NULL) return;
1766
1767   for (uns i=0; i<GARY_SIZE(parts); i++)
1768   {
1769     struct map_placement *mp = malloc(sizeof(struct map_placement));
1770     mp->placement = p;
1771     mp->part = parts[i];
1772
1773     mp->next_in_map = parts[i]->placement->next_in_map;
1774     mp->prev_in_map = parts[i]->placement;
1775     parts[i]->placement->next_in_map = mp;
1776     if (mp->next_in_map) mp->next_in_map->prev_in_map = mp;
1777
1778     mp->next_in_placement = p->map_links;
1779     mp->prev_in_placement = NULL;
1780     p->map_links = mp;
1781   }
1782
1783   GARY_FREE(parts);
1784 }
1785
1786 void update_map_parts(struct placement *p)
1787 {
1788   update_map_parts_delete(p);
1789   update_map_parts_create(p);
1790 }
1791
1792 void gen_coords(struct placement *p)
1793 {
1794   switch(p->request->type)
1795   {
1796     case REQUEST_POINT:
1797       gen_coords_point(p);
1798       break;
1799     case REQUEST_AREA:
1800       gen_coords_area(p);
1801       break;
1802     case REQUEST_SEGMENT:
1803       gen_coords_segment(p);
1804       break;
1805     case REQUEST_LINE:
1806       if (dbg_movement)
1807         printf("Not yet implemented\n");
1808       break;
1809     default:
1810       if (dbg_movement >= VERBOSITY_ALL)
1811         printf("Testing request type\n");
1812       ASSERT(p->request->type != REQUEST_INVALID);
1813   }
1814
1815   update_map_parts(p);
1816 }
1817
1818 double gen_movement(void)
1819 {
1820   double m = (random() % 100000) / 10000;
1821   m = pow(m, 1.0/3) * flip(1, -1);
1822   if (dbg_movement >= VERBOSITY_ALL)
1823     printf("Movement %.2f\n", m);
1824   return m;
1825 }
1826
1827 double gen_movement_uniform(void)
1828 {
1829   return (move_max - move_min) * randdouble() * flip(1, -1);
1830 }
1831
1832 void gen_coords_point(struct placement *p)
1833 {
1834   p->x = p->x + gen_movement();
1835 }
1836
1837 void gen_coords_segment(struct placement *p)
1838 {
1839   struct request_segment *rs = (struct request_segment *) p->request;
1840   p->x = (rs->x1 + rs->x2) / 2;
1841   p->y = (rs->y1 + rs->y2) / 2;
1842 }
1843
1844 void gen_coords_area(struct placement *p)
1845 {
1846   struct request_area *ra = (struct request_area *) p->request;
1847
1848   p->x = p->x + gen_movement();
1849   p->y = p->y + gen_movement();
1850
1851   if (dbg_movement >= VERBOSITY_PLACEMENT)
1852     printf("Moved label to [%.2f; %.2f] from [%.2f; %.2f]\n", p->x, p->y, ra->cx, ra->cy);
1853 }
1854
1855 int randint(int min, int max)
1856 {
1857   if (min == max) return min;
1858   int r = random();
1859   return min + (r % (max - min));
1860 }
1861
1862 struct placement **get_closure(struct placement *placement)
1863 {
1864   struct placement **closure;
1865   GARY_INIT(closure, 0);
1866   bool *chosen = malloc(GARY_SIZE(placement->individual->placements) * sizeof(bool));
1867   for (uns i=0; i<GARY_SIZE(placement->individual->placements); i++) { chosen[i] = 0; }
1868   chosen[placement->request->ind] = 1;
1869
1870   struct placement **p = GARY_PUSH(closure); *p = placement;
1871
1872   uns first = 0;
1873   while (first < GARY_SIZE(closure))
1874   {
1875     if (dbg_breeding >= VERBOSITY_ALL)
1876       printf("Iterating, first is %d of current %u\n", first, GARY_SIZE(closure));
1877     struct placement **overlapping = get_overlapping(placement);
1878     if (! overlapping) { first++; continue; }
1879
1880     struct placement **filtered = filter(overlapping, &chosen);
1881     if (dbg_breeding >= VERBOSITY_ALL)
1882       printf("There are %u new overlapping symbols\n", GARY_SIZE(filtered));
1883     GARY_FREE(overlapping);
1884     overlapping = filtered;
1885     for (uns j=0; j<GARY_SIZE(overlapping); j++)
1886     {
1887       if (! chosen[overlapping[j]->request->ind])
1888       {
1889         if (overlaps(*p, overlapping[j]))
1890         {
1891           p = GARY_PUSH(closure); *p = overlapping[j];
1892           if (dbg_breeding >= VERBOSITY_ALL)
1893             printf("Adding placement of request %d (in fact at [%.2f; %.2f] of size %d x %d)\n", overlapping[j]->request->ind, overlapping[j]->x, overlapping[j]->y, overlapping[j]->request->variants[overlapping[j]->variant_used].width, overlapping[j]->request->variants[overlapping[j]->variant_used].height);
1894           chosen[overlapping[j]->request->ind] = 1;
1895         }
1896       }
1897     }
1898     GARY_FREE(overlapping);
1899     first++;
1900   }
1901
1902   free(chosen);
1903
1904   return closure;
1905 }
1906
1907 void copy_symbols(struct placement **closure, struct individual *parent, struct individual *child, bool **processed_ptr)
1908 {
1909   bool *processed = *processed_ptr;
1910   if (dbg_breeding >= VERBOSITY_ALL)
1911     printf("Will copy %u symbols\n", GARY_SIZE(closure));
1912
1913   for (uns i=0; i<GARY_SIZE(closure); i++)
1914   {
1915     processed[closure[i]->ind] = 1;
1916     int ind = closure[i]->ind;
1917     child->placements[ind] = parent->placements[ind];
1918     child->placements[ind].individual = child;
1919     child->placements[ind].processed = 0;
1920     child->placements[ind].map_links = NULL;
1921     update_map_parts(&child->placements[ind]);
1922   }
1923 }
1924
1925 void move_symbol(struct placement *p)
1926 {
1927   switch (p->request->type)
1928   {
1929     case REQUEST_POINT:
1930     case REQUEST_AREA:
1931       move_symbol_point(p);
1932       break;
1933     case REQUEST_SEGMENT:
1934       move_symbol_segment(p);
1935       break;
1936     default:
1937       ASSERT(p->request->type != REQUEST_INVALID);
1938   }
1939 }
1940
1941 void move_symbol_point(struct placement *p)
1942 {
1943   p->x += gen_movement_uniform();
1944   p->y += gen_movement_uniform();
1945 }
1946
1947 void move_symbol_segment(struct placement *p)
1948 {
1949   double m = gen_movement_uniform();
1950   // CHECK ME
1951   p->x += m;
1952   p->y += m * ((struct request_segment *) p->request)->slope;
1953 }
1954
1955 void hide_segment_labels(struct individual *individual)
1956 {
1957   // BEWARE: This fully depends on current genetic encoding
1958
1959   int used = -1, num = -1;
1960   for (uns i=0; i<GARY_SIZE(individual->placements); i++)
1961   {
1962     switch (individual->placements[i].request->type)
1963     {
1964       case REQUEST_SECTION:
1965         used = individual->placements[i].variant_used;
1966         num = 0;
1967         break;
1968       case REQUEST_SEGMENT:
1969         if (num == used)
1970           individual->placements[i].variant_used = 0;
1971         else
1972           individual->placements[i].variant_used = -1;
1973         num++;
1974         break;
1975       default:
1976         ;
1977     }
1978   }
1979 }
1980
1981 void init_placement(struct placement *p, struct individual *individual, struct request *r)
1982 {
1983   p->ind = num_placements++;
1984   p->request = r;
1985   p->processed = 0;
1986   p->x = p->y = 0; // To prevent valgrind from complaining
1987   p->variant_used = 0;
1988   p->map_links = NULL;
1989   p->individual = individual;
1990   switch (r->type)
1991   {
1992     case REQUEST_POINT: ;
1993       struct request_point *rp = (struct request_point *) r;
1994       p->x = rp->x;
1995       p->y = rp->y;
1996       break;
1997     case REQUEST_LINE: ;
1998       break;
1999     case REQUEST_SECTION: ;
2000       struct request_section *rls = (struct request_section *) r;
2001       p->variant_used = randint(0, rls->num_segments);
2002       break;
2003     case REQUEST_SEGMENT: ;
2004       struct request_segment *rs = (struct request_segment *) r;
2005       p->x = rs->x2;
2006       p->y = rs->y2;
2007       break;
2008     case REQUEST_AREA: ;
2009       struct request_area *ra = (struct request_area *) r;
2010       p->x = ra->cx;
2011       p->y = ra->cy;
2012       p->variant_used = 0;
2013       break;
2014     default:
2015       ASSERT(p->request->type != REQUEST_INVALID);
2016   }
2017
2018   gen_coords(p);
2019   if (dbg_init >= VERBOSITY_PLACEMENT)
2020     printf("Inited placement to [%.2f; %.2f]\n", p->x, p->y);
2021 }
2022
2023 void reset_individual_map(struct individual *i)
2024 {
2025   for (uns j=0; j<num_map_parts; j++)
2026   {
2027     struct map_placement *mp = i->map[j]->placement;
2028     while (mp)
2029     {
2030       struct map_placement *tmp = mp;
2031       mp = mp->next_in_map;
2032       free(tmp);
2033     }
2034
2035     free(i->map[j]);
2036     struct map_part *part = malloc(sizeof(struct map_part));
2037     part->ind = j;
2038
2039     mp = malloc(sizeof(struct map_placement));
2040     part->placement = mp;
2041     mp->placement = &dummy_placement;
2042     mp->next_in_map = mp->prev_in_map = NULL;
2043     mp->next_in_placement = mp->prev_in_placement = NULL;
2044     i->map[j] = part;
2045   }
2046 }
2047
2048 void update_individual(struct individual *individual)
2049 {
2050   for (uns i=0; i<GARY_SIZE(individual->placements); i++)
2051   {
2052     update_map_parts_delete(&individual->placements[i]);
2053   }
2054 }
2055
2056 void clear_individual(struct individual *individual)
2057 {
2058   for (uns j=0; j<num_map_parts; j++)
2059   {
2060     struct map_placement *mp = individual->map[j]->placement;
2061     while (mp)
2062     {
2063       struct map_placement *tmp = mp;
2064       mp = mp->next_in_map;
2065       free(tmp);
2066     }
2067
2068     free(individual->map[j]);
2069   }
2070
2071   GARY_FREE(individual->map);
2072   GARY_FREE(individual->placements);
2073   ep_free(ep_individuals, individual);
2074 }
2075
2076 void clear_population(struct individual **pop)
2077 {
2078   for (uns i=0; i<GARY_SIZE(pop); i++)
2079   {
2080     clear_individual(pop[i]);
2081   }
2082 }
2083
2084 struct placement **get_overlapping(struct placement *p)
2085 {
2086   struct placement **buffer;
2087   GARY_INIT(buffer, 0);
2088
2089   struct map_part **parts = get_map_parts(p);
2090   if (! parts) return NULL;
2091
2092   for (uns i=0; i<GARY_SIZE(parts); i++)
2093   {
2094     struct map_placement *mp = parts[i]->placement->next_in_map;
2095     while (mp)
2096     {
2097       if (p->variant_used >= 0)
2098       {
2099         struct placement **p = GARY_PUSH(buffer);
2100         *p = mp->placement;
2101       }
2102       mp = mp->next_in_map;
2103     }
2104   }
2105   GARY_FREE(parts);
2106
2107   if (dbg_map_parts >= VERBOSITY_PLACEMENT)
2108     printf("Returning %u potentially overlapping placements\n", GARY_SIZE(buffer));
2109
2110   return buffer;
2111 }
2112
2113 struct placement **filter(struct placement **list, bool **pred_ptr)
2114 {
2115   bool *pred = *pred_ptr; // As GARY can't be passed directly
2116   struct placement **filtered;
2117   GARY_INIT(filtered, 0);
2118
2119   for (uns i=0; i<GARY_SIZE(list); i++)
2120   {
2121     if (pred[list[i]->request->ind])
2122       continue;
2123
2124     struct placement **p = GARY_PUSH(filtered);
2125     *p = list[i];
2126   }
2127
2128   return filtered;
2129 }
2130
2131 int flip(int a, int b)
2132 {
2133   return (random() % 2 ? a : b);
2134 }
2135
2136 double randdouble(void)
2137 {
2138   return ((double) rand() / (double) RAND_MAX);
2139 }
2140
2141 void init_individual(struct individual *individual)
2142 {
2143   GARY_INIT(individual->placements, num_requests);
2144   GARY_INIT(individual->map, 0);
2145   for (uns j=0; j<num_map_parts; j++)
2146   {
2147     GARY_PUSH(individual->map);
2148     struct map_part *part = malloc(sizeof(struct map_part));
2149     struct map_placement *mp = malloc(sizeof(struct map_placement));
2150     part->placement = mp;
2151     part->ind = j;
2152     mp->placement = &dummy_placement;
2153     mp->next_in_map = mp->prev_in_map = NULL;
2154     mp->next_in_placement = mp->prev_in_placement = NULL;
2155     individual->map[j] = part;
2156   }
2157   individual->penalty = 0;
2158 }
2159
2160 void copy_individual(struct individual *src, struct individual *dest)
2161 {
2162   init_individual(dest);
2163   dest->penalty = src->penalty;
2164
2165   for (uns i=0; i<GARY_SIZE(src->placements); i++)
2166   {
2167     dest->placements[i] = src->placements[i];
2168     dest->placements[i].map_links = NULL;
2169     dest->placements[i].individual = dest;
2170
2171     update_map_parts_create(&dest->placements[i]);
2172   }
2173 }