]> mj.ucw.cz Git - leo.git/blob - labeller.c
Labeller: Unnecessary returns removed
[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; int num_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 are believed to exist, %d exist\n", num_longlines, 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[num_longlines].first = node->edges[i];
671
672         if (dbg_bfs >= VERBOSITY_INDIVIDUAL)
673         {
674           printf("Running new BFS\n");
675           printf("Creating longline %u\n", num_longlines);
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 = num_longlines;
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         num_longlines++;
690       }
691     }
692   }
693   HASH_END_FOR;
694
695   GARY_FREE(bfs_queue);
696 }
697
698 void dump_longlines(void)
699 {
700   printf("*** Longlines dump\n");
701   for (uns i=0; i<GARY_SIZE(longlines); i++)
702   {
703     printf("Longline %u:", i);
704     struct graph_edge *e = longlines[i].first;
705     if ((e->label) && (e->label->type == SYMBOLIZER_TEXT))
706       printf(" labelled %s", osm_val_decode(((struct sym_text *) e->label)->text));
707     printf("\n");
708
709     while (e)
710     {
711       printf("\t#%ju (%d): [%.2f; %.2f] -- [%.2f; %.2f] (dir %d)\n",
712              e->id, e->num, e->n1->o->x, e->n1->o->y, e->n2->o->x, e->n2->o->y, e->dir);
713
714       e = e->next;
715     }
716   }
717 }
718
719 struct request_line *make_new_line(void)
720 {
721   struct request_line *rl = GARY_PUSH(requests_line);
722   rl->request.ind = num_requests++;
723   rl->request.type = REQUEST_LINE;
724   GARY_INIT(rl->sections, 0);
725   GARY_INIT(rl->request.variants, 0);
726
727   return rl;
728 }
729
730 struct request_section *make_new_section(struct request_line *rl)
731 {
732   struct request_section *rls = GARY_PUSH(rl->sections);
733   rls->request.ind = num_requests++;
734   rls->request.type = REQUEST_SECTION;
735   rls->num_segments = 0;
736   GARY_INIT(rls->segments, 0);
737   GARY_INIT(rls->request.variants, 0);
738
739   return rls;
740 }
741
742 struct request_segment *make_new_segment(struct request_section *rls, struct symbol *sym)
743 {
744   struct request_segment *rs = GARY_PUSH(rls->segments);
745   rls->num_segments++;
746
747   rs->request.ind = num_requests++;
748   rs->request.type = REQUEST_SEGMENT;
749
750   GARY_INIT(rs->request.variants, 0);
751   if (sym)
752   {
753     struct variant *v = GARY_PUSH(rs->request.variants);
754     make_bitmap(v, sym);
755   }
756
757   return rs;
758 }
759
760 void cut_edge(struct graph_edge *e, double dist)
761 {
762   if (dbg_segments >= VERBOSITY_PLACEMENT)
763     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);
764
765   struct graph_edge *new = malloc(sizeof(struct graph_edge));
766   *new = *e;
767   e->next = new;
768
769   switch (e->label->type)
770   {
771     case SYMBOLIZER_TEXT:
772       new->label = malloc(sizeof(struct sym_text));
773       *((struct sym_text *) new->label) = *((struct sym_text *) e->label);
774       break;
775     default:
776       ;
777   }
778
779   struct osm_node *n1 = e->n1->o;
780   struct osm_node *n2 = e->n2->o;
781
782   if ((n1->x == n2->x) && (n1->y == n2->y))
783   {
784     printf("[%.2f; %.2f] -- [%.2f; %.2f]\n", n1->x, n1->y, n2->x, n2->y);
785     if (dbg_segments >= VERBOSITY_PLACEMENT)
786       printf("Won't cut point\n");
787     return;
788   }
789
790   struct osm_node *n11 = malloc(sizeof(struct osm_node));
791   struct graph_node *gn = malloc(sizeof(struct graph_node));
792   gn->o = n11;
793   double vsize = sqrt(pow(n1->x - n2->x, 2) + pow(n1->y - n2->y, 2));
794   n11->x = n1->x + (n2->x - n1->x) / vsize * dist;
795   n11->y = n1->y + (n2->y - n1->y) / vsize * dist;
796
797   e->n2 = new->n1 = gn;
798
799   e->length = hypot(abs(n1->x - n11->x), abs(n1->y - n11->y));
800   new->length = hypot(abs(n11->x - n2->x), abs(n11->y - n2->y));
801   new->visited = 0;
802 }
803
804 void make_segments(void)
805 {
806   for (uns i=0; i<GARY_SIZE(longlines); i++)
807   {
808     // Skip lines which are not labelled
809     if (! (longlines[i].first && longlines[i].first->label))
810       continue;
811
812     struct request_line *request = make_new_line();
813     struct request_section *rls = make_new_section(request);
814     struct request_segment *rs = NULL;
815
816     struct graph_edge *e = longlines[i].first;
817     double cur_length = 0;
818
819     struct sym_text *st = NULL;
820     if (e->label->type == SYMBOLIZER_TEXT)
821     {
822       st = (struct sym_text *) e->label;
823     }
824     else
825     {
826       // FIXME: Should other label types be supported in future?
827       if (dbg_segments >= VERBOSITY_PLACEMENT)
828         printf("Warning: Skipping line\n");
829       continue;
830     }
831
832     if (dbg_segments >= VERBOSITY_INDIVIDUAL)
833       printf("New longline\n");
834
835     while (e)
836     {
837       if (e->visited < 0)
838       {
839         if (dbg_segments >= VERBOSITY_PLACEMENT)
840           printf("BEWARE: Edge cycle\n");
841         break;
842       }
843       e->visited = -1;
844
845       if (dbg_segments >= VERBOSITY_PLACEMENT)
846         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);
847
848       if (st && (e->length < st->tw))
849       {
850         e = e->next;
851         if (dbg_segments >= VERBOSITY_PLACEMENT)
852           printf("Warning: Skipping segment\n");
853         continue;
854       }
855
856       if (cur_length + e->length > conf_max_section_length + conf_max_section_overlay)
857       {
858         if (dbg_segments >= VERBOSITY_PLACEMENT)
859           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);
860         // HACK to prevent cutting to 0 lenght
861         cut_edge(e, max2(conf_max_section_length - cur_length, 2));
862       }
863
864       rs = make_new_segment(rls, NULL);
865       rs->label = malloc(sizeof(struct sym_text));
866       *((struct sym_text *) rs->label) = *((struct sym_text *) e->label);
867
868       rs->x1 = e->n1->o->x;
869       rs->y1 = e->n1->o->y;
870       rs->x2 = e->n2->o->x;
871       rs->y2 = e->n2->o->y;
872
873       rs->slope = (rs->y2 - rs->y1) / (rs->x2 - rs->x1);
874       ((struct sym_text *) rs->label)->rotate = atan(rs->slope) * (-180 / M_PI);
875       struct variant *v = GARY_PUSH(rs->request.variants);
876       make_bitmap(v, rs->label);
877
878       rs->zindex = e->zindex;
879
880       cur_length += e->length;
881       if (cur_length > conf_max_section_length)
882       {
883         if (dbg_segments >= VERBOSITY_PLACEMENT)
884           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);
885
886         rls = make_new_section(request);
887         cur_length = 0;
888       }
889
890       e = e->next;
891     }
892
893     if (request->sections[0].num_segments == 0)
894     {
895       if (dbg_segments >= VERBOSITY_INDIVIDUAL)
896         printf("WARNING: Longline without any segment, skipped\n");
897
898       struct request_section *rls = &request->sections[0];
899       GARY_FREE(rls->segments);
900       GARY_FREE(rls->request.variants);
901
902       struct request_line *rl = &requests_line[GARY_SIZE(requests_line)-1];
903       GARY_FREE(rl->sections);
904       GARY_FREE(rl->request.variants);
905
906       GARY_POP(requests_line);
907       num_requests -= 2;
908     }
909   }
910 }
911
912 void dump_linelabel_requests(void)
913 {
914   for (uns i=0; i<GARY_SIZE(requests_line); i++)
915   {
916     if (requests_line[i].sections[0].num_segments == 0)
917     {
918       if (dbg_segments >= VERBOSITY_INDIVIDUAL)
919         printf("Beware: Longline without any segment\n");
920       continue;
921     }
922
923     printf("Request for linelabel, %d sections\n", GARY_SIZE(requests_line[i].sections));
924     dump_label(requests_line[i].sections[0].segments[0].label);
925     for (uns j=0; j<GARY_SIZE(requests_line[i].sections); j++)
926     {
927       printf("%d section, %d segments\n", j, GARY_SIZE(requests_line[i].sections[j].segments));
928       for (uns k=0; k<GARY_SIZE(requests_line[i].sections[j].segments); k++)
929       {
930         struct request_segment *rs = &requests_line[i].sections[j].segments[k];
931         printf("[%.2f; %.2f] -- [%.2f; %.2f]\n", rs->x1, rs->y1, rs->x2, rs->y2);
932       }
933     }
934     printf("\n");
935   }
936 }
937
938 void dump_bitmaps(struct individual *individual)
939 {
940   bool *bitmap = malloc(page_width_int * page_height_int * sizeof(bool));
941   printf("Bitmap size is %d\n", page_width_int * page_height_int);
942   for (int i=0; i<page_height_int; i++)
943     for (int j=0; j<page_width_int; j++)
944       bitmap[i*page_width_int + j] = 0;
945
946   int total = 0;
947   for (uns i=0; i<GARY_SIZE(individual->placements); i++)
948   {
949     if (individual->placements[i].variant_used == -1) continue;
950
951     struct placement *p = &(individual->placements[i]);
952     struct variant *v = NULL;
953
954     switch (p->request->type)
955     {
956       case REQUEST_SEGMENT: ;
957       case REQUEST_POINT: ;
958       case REQUEST_AREA: ;
959         v = &(p->request->variants[p->variant_used]);
960         break;
961       default:
962         ASSERT(p->request->type != REQUEST_INVALID);
963         continue;
964     }
965
966     int base_x = p->x; int base_y = p->y;
967     for (int dr = max2(0, 0-p->y); dr < v->height; dr++)
968     {
969       for (int dc = max2(0, 0-p->x); dc < v->width; dc++)
970       {
971         if (v->bitmap[dr * v->width + dc])
972         {
973           if (bitmap[(base_y + dr) * page_width_int + (base_x + dc)]) total += 1;
974           bitmap[(base_y + dr) * page_width_int + (base_x + dc)] = 1;
975         }
976       }
977     }
978   }
979   if (dbg_overlaps >= VERBOSITY_GENERAL)
980     printf("There were %d collisions during bitmap dump\n", total);
981
982   FILE *fd_dump = fopen("dump.pbm", "w");
983   fprintf(fd_dump, "P1\n");
984   fprintf(fd_dump, "%d %d\n", page_width_int, page_height_int);
985   for (int i=0; i<page_height_int; i++)
986   {
987     for (int j=0; j<page_width_int; j++)
988     {
989       fprintf(fd_dump, "%d", bitmap[(int) (i*page_width_int + j)] ? 1 : 0);
990     }
991     fprintf(fd_dump, "\n");
992   }
993   fclose(fd_dump);
994
995   free(bitmap);
996 }
997
998 void dump_individual(struct individual *individual)
999 {
1000   printf("*** Individual dump\n");
1001   printf("(There are %d requests)\n", num_requests);
1002
1003   for (uns i=0; i<GARY_SIZE(individual->placements); i++)
1004   {
1005     struct placement *p = &(individual->placements[i]);
1006
1007     switch (p->request->type)
1008     {
1009       case REQUEST_POINT:
1010         printf("Point at [%.2f; %.2f] on %u\n", p->x, p->y, ((struct request_point *) p->request)->zindex);
1011         break;
1012       case REQUEST_LINE: ;
1013         struct request_line *rl = (struct request_line *) p->request;
1014         printf("Line: ");
1015         dump_label(rl->sections[0].segments[0].label);
1016         break;
1017       case REQUEST_SECTION: ;
1018         printf("*");
1019         break;
1020       case REQUEST_SEGMENT: ;
1021         if (p->variant_used >= 0)
1022           printf("Segment placed at [%.2f; %.2f] on %u\n", p->x, p->y, ((struct request_segment *) p->request)->zindex);
1023         else
1024           printf("Segment not placed\n");
1025         break;
1026       case REQUEST_AREA: ;
1027         struct request_area *ra = (struct request_area *) p->request;
1028         printf("Area label ");
1029         dump_label(ra->label);
1030         printf(" at [%.2f; %.2f] on %u\n", p->x, p->y, ((struct request_area *) p->request)->zindex);
1031         break;
1032       default:
1033         ASSERT(p->request->type != 0);
1034     }
1035   }
1036   printf("\nTotal penalty: %d\n", individual->penalty);
1037 }
1038
1039 void plan_individual(struct individual *individual)
1040 {
1041   for (uns i=0; i<GARY_SIZE(individual->placements); i++)
1042   {
1043     struct symbol *s = NULL;
1044     z_index_t zindex = 0;
1045     if (individual->placements[i].variant_used < 0) continue;
1046     switch (individual->placements[i].request->type)
1047     {
1048       case REQUEST_POINT: ;
1049         struct request_point *rp = (struct request_point *) individual->placements[i].request;
1050         s = rp->sym;
1051         zindex = rp->zindex;
1052         break;
1053       case REQUEST_SEGMENT: ;
1054         struct request_segment *rs = (struct request_segment *) individual->placements[i].request;
1055         s = rs->label;
1056         zindex = rs->zindex;
1057         break;
1058       case REQUEST_LINE: ;
1059         break;
1060       case REQUEST_AREA: ;
1061         struct request_area *ra = (struct request_area *) individual->placements[i].request;
1062         s = ra->label;
1063         zindex = ra->zindex;
1064         break;
1065       default:
1066         ASSERT(individual->placements[i].request != REQUEST_INVALID);
1067         continue;
1068     }
1069
1070   if (dbg_plan >= VERBOSITY_PLACEMENT)
1071     printf("Will plan symbol at [%.2f; %.2f] on %u\n", individual->placements[i].x, individual->placements[i].y, zindex);
1072
1073     if (s) switch (s->type)
1074     {
1075       case SYMBOLIZER_POINT: ;
1076         struct sym_point *sp = (struct sym_point *) s;
1077         sp->x = individual->placements[i].x;
1078         sp->y = individual->placements[i].y;
1079         sym_plan((struct symbol *) sp, zindex);
1080         break;
1081       case SYMBOLIZER_ICON: ;
1082         struct sym_icon *si = (struct sym_icon *) s;
1083         si->sir.x = individual->placements[i].x;
1084         si->sir.y = individual->placements[i].y;
1085         sym_plan((struct symbol *) si, zindex);
1086         break;
1087       case SYMBOLIZER_TEXT: ;
1088         struct sym_text *st = (struct sym_text *) s;
1089         st->x = individual->placements[i].x;
1090         st->y = individual->placements[i].y;
1091         st->next_duplicate = NULL;
1092         if (dbg_plan >= VERBOSITY_PLACEMENT)
1093           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);
1094         sym_plan((struct symbol *) st, zindex);
1095         break;
1096       default:
1097         ASSERT(s->type != SYMBOLIZER_INVALID);
1098     }
1099   }
1100 }
1101
1102 void dump_penalties(struct individual **population)
1103 {
1104   for (int i=0; i<conf_pop_size; i++)
1105   {
1106     printf("Individual %d has penalty %d\n", i, population[i]->penalty);
1107   }
1108 }
1109
1110 void compute_sizes(void)
1111 {
1112   page_width_int = floor(page_width);
1113   page_height_int = floor(page_height);
1114
1115   num_map_parts_row = (page_width_int + conf_map_part_width) / conf_map_part_width;
1116   num_map_parts_col = (page_height_int + conf_map_part_height) / conf_map_part_height;
1117   num_map_parts = num_map_parts_row * num_map_parts_col;
1118
1119   breed_pop_size = conf_breed_pop_size * conf_pop_size;
1120   breed_rbest_size = conf_breed_rbest * conf_pop_size;
1121   if (dbg_evolution >= VERBOSITY_GENERAL)
1122   {
1123     printf("Breeding parameters:\n");
1124     printf(" %d individuals are created\n", breed_pop_size);
1125     printf(" %d best individuals in old population are considered\n", breed_rbest_size);
1126   }
1127
1128   mutate_pop_size = conf_mutate_pop_size * conf_pop_size;
1129   mutate_rbest_size = conf_mutate_rbest * conf_pop_size;
1130   if (dbg_evolution >= VERBOSITY_GENERAL)
1131   {
1132     printf("Mutation parameters:\n");
1133     printf(" %d individuals are created\n", mutate_pop_size);
1134     printf(" %d best individuals in old population are considered\n", mutate_rbest_size);
1135   }
1136
1137   elite_pop_size = conf_elite_pop_size * conf_pop_size;
1138   if (dbg_evolution >= VERBOSITY_GENERAL)
1139   {
1140     printf("Elitism parameters:\n");
1141     printf(" %d best individuals are copied\n", elite_pop_size);
1142   }
1143
1144   if (breed_pop_size + mutate_pop_size + elite_pop_size != conf_pop_size)
1145   {
1146     if (conf_fit_size)
1147     {
1148       elite_pop_size += conf_pop_size - (breed_pop_size + mutate_pop_size + elite_pop_size);
1149     }
1150     else
1151     {
1152       fprintf(stderr, "Breeding + mutation + elitism won't create correct number of individuals\n");
1153       fprintf(stderr, "Please fix conf_breed_pop_size, conf_mutate_pop_size and conf_elite_pop_size parameters\n");
1154       exit(2);
1155     }
1156   }
1157 }
1158
1159 void labeller_label(void)
1160 {
1161   make_graph();
1162   label_graph();
1163   bfs_wrapper();
1164   make_segments();
1165
1166   GARY_INIT(population1, conf_pop_size);
1167   GARY_INIT(population2, conf_pop_size);
1168   make_population();
1169   rank_population();
1170   qsort(population1, conf_pop_size, sizeof(struct individual *), cmp_individual);
1171
1172   if (dbg_evolution >= VERBOSITY_GENERAL)
1173   {
1174     printf("Penalties after initialization\n");
1175     dump_penalties(population1);
1176   }
1177
1178   while (! shall_terminate())
1179   {
1180     iteration++;
1181     if (dbg_evolution)
1182       printf("\n*** Iteration %d ***\n", iteration);
1183
1184     breed();
1185     mutate();
1186     elite();
1187
1188     struct individual **swp = population1;
1189     population1 = population2;
1190     population2 = swp;
1191     pop2_ind = 0;
1192     clear_population(population2);
1193
1194     rank_population();
1195
1196     if (dbg_evolution >= VERBOSITY_GENERAL)
1197       printf("Sorting population\n");
1198     qsort(population1, conf_pop_size, sizeof(struct individual *), cmp_individual);
1199
1200     if (dbg_evolution >= VERBOSITY_GENERAL)
1201     {
1202       printf("Penalties after sort\n");
1203       dump_penalties(population1);
1204     }
1205
1206     old_best = population1[0]->penalty;
1207   }
1208
1209   if (dbg_overlaps >= VERBOSITY_GENERAL)
1210     dump_bitmaps(population1[0]);
1211
1212   plan_individual(population1[0]);
1213
1214   labeller_cleanup();
1215 }
1216
1217 void labeller_cleanup(void)
1218 {
1219   hash_cleanup();
1220   GARY_FREE(requests_point);
1221   GARY_FREE(requests_line);
1222   GARY_FREE(requests_area);
1223 }
1224
1225 void make_population(void)
1226 {
1227   for (int i=0; i<conf_pop_size; i++)
1228   {
1229     num_placements = 0; // FIXME: This IS a terrible HACK
1230     struct individual *i2 = ep_alloc(ep_individuals);
1231     init_individual(i2);
1232     population2[i] = i2;
1233
1234     if (dbg_init >= VERBOSITY_INDIVIDUAL)
1235       printf("Making individual %d\n", i);
1236     struct individual *individual = ep_alloc(ep_individuals); init_individual(individual);
1237     population1[i] = individual;
1238
1239     int p = 0;
1240     for (uns j=0; j<GARY_SIZE(requests_point); j++)
1241     {
1242       init_placement(&(individual->placements[p++]), individual, (struct request *) &requests_point[j]);
1243     }
1244
1245     for (uns j=0; j<GARY_SIZE(requests_line); j++)
1246     {
1247       init_placement(&(individual->placements[p++]), individual, (struct request *) &requests_line[j]);
1248
1249       for (uns k=0; k<GARY_SIZE(requests_line[j].sections); k++)
1250       {
1251         init_placement(&(individual->placements[p++]), individual, (struct request *) &requests_line[j].sections[k]);
1252
1253         for (uns l=0; l<GARY_SIZE(requests_line[j].sections[k].segments); l++)
1254         {
1255           init_placement(&(individual->placements[p++]), individual, (struct request *) &requests_line[j].sections[k].segments[l]);
1256         }
1257       }
1258     }
1259
1260     for (uns j=0; j<GARY_SIZE(requests_area); j++)
1261     {
1262       init_placement(&(individual->placements[p++]), individual, (struct request *) &requests_area[j]);
1263     }
1264
1265     hide_segment_labels(individual);
1266
1267     ASSERT(p == num_requests);
1268   }
1269 }
1270
1271 bool shall_terminate(void)
1272 {
1273   switch (conf_term_cond)
1274   {
1275     case TERM_COND_PENALTY:
1276       return (population1[0]->penalty < conf_penalty_bound);
1277     case TERM_COND_STAGNATION:
1278       return (abs(old_best - population1[0]->penalty) < conf_stagnation_bound);
1279     case TERM_COND_ITERATIONS:
1280       return (iteration >= conf_iteration_limit);
1281     default:
1282       fprintf(stderr, "Warning: No termination condition is set, terminating\n");
1283       return 1;
1284   }
1285 }
1286
1287 void breed(void)
1288 {
1289   int i=0;
1290
1291   struct individual **breed_buffer;
1292   while (i < breed_pop_size)
1293   {
1294     int parent1 = randint(0, breed_rbest_size);
1295     int parent2 = randint(0, breed_rbest_size);
1296     if (dbg_breeding >= VERBOSITY_INDIVIDUAL)
1297       printf("Will breed %d and %d\n", parent1, parent2);
1298
1299     breed_buffer = perform_crossover(population1[parent1], population1[parent2]);
1300     population2[pop2_ind++] = breed_buffer[0];
1301     population2[pop2_ind++] = breed_buffer[1];
1302     free(breed_buffer);
1303     i += 2;
1304   }
1305 }
1306
1307 struct individual **perform_crossover(struct individual *parent1, struct individual *parent2)
1308 {
1309   struct individual **buffer = malloc(2*sizeof(struct individual));
1310   struct individual *child1 = ep_alloc(ep_individuals); init_individual(child1);
1311   struct individual *child2 = ep_alloc(ep_individuals); init_individual(child2);
1312
1313   bool *processed;
1314   GARY_INIT_ZERO(processed, GARY_SIZE(parent1->placements));
1315
1316   for (uns i=0; i<GARY_SIZE(parent1->placements); i++)
1317   {
1318     if (! processed[parent1->placements[i].ind])
1319     {
1320       if (dbg_breeding >= VERBOSITY_PLACEMENT)
1321         printf("Creating symbol closure for placement %u\n", i);
1322
1323       struct placement **clos_symbols = get_closure(&(parent1->placements[i]));
1324       int x = randint(0, 2);
1325
1326       if (x == 0)
1327       {
1328         if (dbg_breeding >= VERBOSITY_PLACEMENT)
1329           printf("Copying parent->child 1->1 and 2->2\n");
1330         copy_symbols(clos_symbols, parent1, child1, &processed);
1331         copy_symbols(clos_symbols, parent2, child2, &processed);
1332       }
1333       else
1334       {
1335         if (dbg_breeding >= VERBOSITY_PLACEMENT)
1336           printf("Copying parent->child 2->1 and 1->2\n");
1337         copy_symbols(clos_symbols, parent2, child1, &processed);
1338         copy_symbols(clos_symbols, parent1, child2, &processed);
1339       }
1340
1341       GARY_FREE(clos_symbols);
1342     }
1343   }
1344
1345   GARY_FREE(processed);
1346
1347   if (conf_mutate_children)
1348   {
1349     if (randdouble() < conf_mutate_children_prob) perform_mutation(child1);
1350     else hide_segment_labels(child1);
1351
1352     if (randdouble() < conf_mutate_children_prob) perform_mutation(child2);
1353     else hide_segment_labels(child2);
1354   }
1355
1356   buffer[0] = child1;
1357   buffer[1] = child2;
1358   return buffer;
1359 }
1360
1361 void mutate(void)
1362 {
1363   for (int i=0; i < mutate_pop_size; i++)
1364   {
1365     if (dbg_mutation >= VERBOSITY_INDIVIDUAL)
1366       printf("Creating %d-th individual by mutation\n", i);
1367     int ind = randint(0, mutate_rbest_size);
1368     if (dbg_mutation >= VERBOSITY_INDIVIDUAL)
1369       printf("Mutating %d-th individual of original population\n", ind);
1370     population2[pop2_ind] = ep_alloc(ep_individuals);
1371     copy_individual(population1[ind], population2[pop2_ind]);
1372     if (dbg_mutation >= VERBOSITY_INDIVIDUAL)
1373       printf("Individual %d in pop2 inited from individual %d in pop1\n", pop2_ind, ind);
1374     perform_mutation(population2[pop2_ind]);
1375     pop2_ind++;
1376   }
1377 }
1378
1379 void perform_mutation(struct individual *individual)
1380 {
1381   for (uns i=0; i<GARY_SIZE(individual->placements); i++)
1382   {
1383     double x = randdouble();
1384     double acc = 0;
1385
1386     if (x <= acc + conf_mutate_move_bound)
1387     {
1388       if (dbg_mutation >= VERBOSITY_PLACEMENT)
1389         printf("Mutation: Moving symbol in placement %u\n", i);
1390       move_symbol(&(individual->placements[i]));
1391       continue;
1392     }
1393     acc += conf_mutate_move_bound;
1394
1395     if (x <= acc + conf_mutate_regen_bound)
1396     {
1397       gen_coords(&(individual->placements[i]));
1398       continue;
1399     }
1400     acc += conf_mutate_regen_bound;
1401
1402     if (x <= acc + conf_mutate_chvar_bound)
1403     {
1404       struct placement *p = &(individual->placements[i]);
1405       switch (p->request->type)
1406       {
1407         case REQUEST_POINT:
1408         case REQUEST_AREA:
1409           // Does nothing when there are 0 variants... does it mind?
1410           p->variant_used = randint(-1, GARY_SIZE(p->request->variants));
1411           break;
1412         case REQUEST_SEGMENT:
1413           p->variant_used = randint(0, GARY_SIZE(p->request->variants));
1414           break;
1415         case REQUEST_SECTION:
1416           p->variant_used = randint(0, GARY_SIZE(((struct request_section *) p->request)->segments));
1417           break;
1418         default:
1419           ;
1420       }
1421     }
1422   }
1423
1424   hide_segment_labels(individual);
1425 }
1426
1427 void elite(void)
1428 {
1429   for (int i=0; i<elite_pop_size; i++)
1430   {
1431     population2[pop2_ind] = ep_alloc(ep_individuals);
1432     copy_individual(population1[i], population2[pop2_ind++]);
1433   }
1434 }
1435
1436 int overlaps(struct placement *p1, struct placement *p2)
1437 {
1438   if (p1->request->type != REQUEST_POINT &&
1439       p1->request->type != REQUEST_SEGMENT &&
1440       p1->request->type != REQUEST_AREA)
1441     return 0;
1442
1443   if (p2->request->type != REQUEST_POINT &&
1444       p2->request->type != REQUEST_SEGMENT &&
1445       p2->request->type != REQUEST_AREA)
1446     return 0;
1447
1448   if (p1->variant_used == -1 || p2->variant_used == -1)
1449     return 0;
1450
1451   struct variant *v1, *v2;
1452
1453   v1 = &(p1->request->variants[p1->variant_used]);
1454   v2 = &(p2->request->variants[p2->variant_used]);
1455
1456   // FIXME: This doesn't fully respect offset which it probably should
1457   int p1x = p1->x; int p1y = p1->y;
1458   int p2x = p2->x; int p2y = p2->y;
1459
1460   int overlap = 0;
1461   for (int y=max2(0, max2(p1y, p2y)); y<min2(page_height_int, min2(p1y+v1->height, p2y+v2->height)); y++)
1462     for (int x=max2(0, max2(p1x, p2x)); x<min2(page_width_int, min2(p1x+v1->width, p2x+v2->width)); x++)
1463     {
1464       if (v1->bitmap[(y-p1y)*v1->width + (x-p1x)] &&
1465           v2->bitmap[(y-p2y)*v2->width + (x-p2x)])
1466         overlap++;
1467     }
1468
1469   return overlap;
1470 }
1471
1472 int get_overlap(struct placement *p)
1473 {
1474   if (p->variant_used == -1) return 0;
1475
1476   struct map_part **parts = get_map_parts(p);
1477   if (! parts)
1478   {
1479     if (dbg_overlaps >= VERBOSITY_PLACEMENT)
1480       printf("Placement of request %d seems not to be placed\n", p->request->ind);
1481     return 0;
1482   }
1483
1484   struct placement **others;
1485   bool *planned;
1486
1487   GARY_INIT_ZERO(planned, num_requests);
1488   planned[p->request->ind] = 1;
1489   GARY_INIT(others, 0);
1490
1491   for (uns i=0; i<GARY_SIZE(parts); i++)
1492   {
1493     struct map_placement *mp = parts[i]->placement->next_in_map;
1494     while (mp)
1495     {
1496       if (! planned[mp->placement->request->ind])
1497       {
1498         struct placement **p = GARY_PUSH(others);
1499         *p = mp->placement;
1500         planned[mp->placement->request->ind] = true;
1501       }
1502       mp = mp->next_in_map;
1503     }
1504   }
1505
1506   int overlap = 0;
1507   for (uns i=0; i<GARY_SIZE(others); i++)
1508   {
1509     overlap += overlaps(p, others[i]);
1510   }
1511
1512   GARY_FREE(planned);
1513   GARY_FREE(parts);
1514   GARY_FREE(others);
1515
1516   if (dbg_overlaps >= VERBOSITY_PLACEMENT)
1517     printf("Placement of request %d add %d to overlaps\n", p->request->ind, overlap);
1518
1519   if (p->x < 0) overlap += 0 - p->x;
1520   if (p->x + p->request->variants[p->variant_used].width > page_width_int)
1521     overlap += p->x + p->request->variants[p->variant_used].width - page_width_int;
1522
1523   if (p->y < 0) overlap += 0 - p->y;
1524   if (p->y + p->request->variants[p->variant_used].height > page_height_int)
1525     overlap += p->y + p->request->variants[p->variant_used].height - page_height_int;
1526
1527   return overlap;
1528 }
1529
1530 int individual_overlap(struct individual *individual)
1531 {
1532   int overlap = 0;
1533
1534   for (uns i=0; i<GARY_SIZE(individual->placements); i++)
1535   {
1536     overlap += get_overlap(&individual->placements[i]);
1537   }
1538
1539   return overlap;
1540 }
1541
1542 double get_distance(struct placement *p)
1543 {
1544   if (p->variant_used < 0) return 0;
1545   struct variant *v = &p->request->variants[p->variant_used];
1546
1547   double dx, dy, distance;
1548   switch (p->request->type)
1549   {
1550     case REQUEST_POINT: ;
1551       struct request_point *rp = (struct request_point *) p->request;
1552       dx = rp->x + v->offset_x - p->x;
1553       dy = rp->y + v->offset_y - p->y;
1554       distance = sqrt(dx*dx + dy*dy);
1555       if (dbg_rank >= VERBOSITY_PLACEMENT)
1556         printf("Point placed at [%.2f; %.2f], expected at [%.2f; %.2f]\n", p->x, p->y, rp->x, rp->y);
1557       break;
1558     case REQUEST_SEGMENT: ;
1559       struct request_segment *rs = (struct request_segment *) p->request;
1560       struct sym_text *st = (struct sym_text *) rs->label;
1561
1562       double width = p->request->variants[p->variant_used].width;
1563       double rotated_x = p->x + width * sin(st->rotate / (-180 / M_PI));
1564       double rotated_y = p->y + width * cos(st->rotate / (-180 / M_PI));
1565
1566       if (rs->x1 < rs->x2)
1567       {
1568         if (p->x < rs->x1)
1569         {
1570           dx = rs->x1 - p->x;
1571           dy = rs->y1 - p->y;
1572         }
1573         else if (rotated_x > rs->x2)
1574         {
1575           dx = rotated_x - rs->x2;
1576           dy = rotated_y - rs->y2;
1577         }
1578         else
1579         {
1580           dx = dy = 0;
1581         }
1582       }
1583       else
1584       {
1585         if (p->x < rs->x2)
1586         {
1587           dx = rs->x2 - p->x;
1588           dy = rs->y2 - p->y;
1589         }
1590         else if (rotated_x > rs->x1)
1591         {
1592           dx = rotated_x - rs->x1;
1593           dy = rotated_y - rs->y1;
1594         }
1595         else
1596         {
1597           dx = dy = 0;
1598         }
1599       }
1600
1601       distance = sqrt(dx*dx + dy*dy);
1602       break;
1603     case REQUEST_AREA: ;
1604       struct request_area *ra = (struct request_area *) p->request;
1605       dx = ra->cx + v->offset_x - p->x;
1606       dy = ra->cy + v->offset_y - p->y;
1607       distance = sqrt(dx*dx + dy*dy);
1608       if (dbg_rank >= VERBOSITY_PLACEMENT)
1609         printf("Area placed at [%.2f; %.2f], expected at [%.2f; %.2f]\n", p->x, p->y, ra->cx, ra->cy);
1610       break;
1611     default:
1612       return 0;
1613   }
1614
1615   if (dbg_rank >= VERBOSITY_PLACEMENT)
1616     printf("Placement %d has distance %.2f\n", p->ind, distance);
1617   return distance;
1618 }
1619
1620 double individual_distances(struct individual *individual)
1621 {
1622   int distances = 0;
1623
1624   for (uns i=0; i<GARY_SIZE(individual->placements); i++)
1625   {
1626     distances += get_distance(&individual->placements[i]);
1627   }
1628
1629   return distances;
1630 }
1631
1632 double get_omittment(struct placement *p)
1633 {
1634   if (p->variant_used >= 0) return 0;
1635
1636   // FIX ME :)
1637   switch (p->request->type)
1638   {
1639     case REQUEST_POINT:
1640     case REQUEST_AREA:
1641       return 10;
1642       break;
1643     default:
1644       return 0;
1645   }
1646 }
1647
1648 double individual_omittment(struct individual *individual)
1649 {
1650   int omittment = 0;
1651
1652   for (uns i=0; i<GARY_SIZE(individual->placements); i++)
1653   {
1654     omittment += get_omittment(&individual->placements[i]);
1655   }
1656
1657   return omittment;
1658 }
1659
1660 int cmp_individual(const void *a, const void *b)
1661 {
1662   struct individual **ia = (struct individual **) a;
1663   struct individual **ib = (struct individual **) b;
1664
1665   return (*ia)->penalty - (*ib)->penalty;
1666 }
1667
1668 void rank_population(void)
1669 {
1670   int penalty;
1671
1672   for (int i=0; i<conf_pop_size; i++)
1673   {
1674     if (dbg_rank >= VERBOSITY_INDIVIDUAL)
1675       printf("Individual %d\n", i);
1676     population1[i]->penalty = 0;
1677
1678     penalty = individual_omittment(population1[i]);
1679     if (dbg_rank >= VERBOSITY_INDIVIDUAL)
1680       printf("Increasing penalty by %d for omittment\n", penalty);
1681     population1[i]->penalty += penalty;
1682
1683     penalty = individual_overlap(population1[i]);
1684     if (dbg_rank >= VERBOSITY_INDIVIDUAL)
1685       printf("Increasing penalty by %d for overlap\n", penalty);
1686     population1[i]->penalty += penalty;
1687
1688     penalty = individual_distances(population1[i]);
1689     if (dbg_rank >= VERBOSITY_INDIVIDUAL)
1690       printf("Increasing penalty by %d for distances\n", penalty);
1691     population1[i]->penalty += penalty;
1692   }
1693 }
1694
1695 struct map_part **get_map_parts(struct placement *p)
1696 {
1697   if (p->variant_used < 0) return NULL;
1698
1699   struct map_part **buffer;
1700   GARY_INIT(buffer, 0);
1701
1702   if (dbg_map_parts >= VERBOSITY_PLACEMENT)
1703     printf("Looking for map parts containing placement of request %d, placed at [%.2f; %.2f]\n", p->request->ind, p->x, p->y);
1704
1705   struct variant v;
1706   switch (p->request->type)
1707   {
1708     case REQUEST_POINT:
1709     case REQUEST_SEGMENT:
1710     case REQUEST_AREA:
1711       v = p->request->variants[p->variant_used];
1712       break;
1713     default:
1714       if (dbg_map_parts >= VERBOSITY_ALL)
1715         printf("Skipping unsupported request type (%d)\n", p->request->type);
1716       return NULL;
1717   }
1718
1719   if (dbg_map_parts >= VERBOSITY_PLACEMENT)
1720     printf("Bitmap is %d x %d\n", v.width, v.height);
1721
1722   int x_min = max2(0, p->x) / conf_map_part_width;
1723   // CHECK ME: Is rounding needed?
1724   int x_max = min2(page_width_int, (p->x + v.width)) / conf_map_part_width;
1725   int y_min = max2(0, p->y) / conf_map_part_height;
1726   // CHECK ME: Is rounding needed?
1727   int y_max = min2(page_height_int, (p->y + v.height)) / conf_map_part_height;
1728
1729   if (dbg_map_parts >= VERBOSITY_PLACEMENT)
1730     printf("Cells between [%d; %d] and [%d; %d] generated\n", x_min, y_min, x_max, y_max);
1731
1732   for (int y=y_min; y<=y_max; y++)
1733     for (int x=x_min; x<=x_max; x++)
1734     {
1735       struct map_part **m = GARY_PUSH(buffer);
1736       if (dbg_map_parts >= VERBOSITY_ALL)
1737         printf("Asking for %d of %u\n", y * num_map_parts_row + x, GARY_SIZE(p->individual->map));
1738       *m = p->individual->map[y * num_map_parts_row + x];
1739     }
1740
1741   if (dbg_map_parts >= VERBOSITY_PLACEMENT)
1742     printf("Returning %u map parts potentially containing the symbol\n", GARY_SIZE(buffer));
1743
1744   return buffer;
1745 }
1746
1747 void update_map_parts_delete(struct placement *p)
1748 {
1749   struct map_placement *mp = p->map_links;
1750   while (mp)
1751   {
1752     mp->prev_in_map->next_in_map = mp->next_in_map;
1753     if (mp->next_in_map)
1754       mp->next_in_map->prev_in_map = mp->prev_in_map;
1755
1756     struct map_placement *tmp = mp;
1757     mp = mp->next_in_placement;
1758     free(tmp);
1759   }
1760   p->map_links = NULL;
1761 }
1762
1763 void update_map_parts_create(struct placement *p)
1764 {
1765   struct map_part **parts = get_map_parts(p);
1766   if (parts == NULL) return;
1767
1768   for (uns i=0; i<GARY_SIZE(parts); i++)
1769   {
1770     struct map_placement *mp = malloc(sizeof(struct map_placement));
1771     mp->placement = p;
1772     mp->part = parts[i];
1773
1774     mp->next_in_map = parts[i]->placement->next_in_map;
1775     mp->prev_in_map = parts[i]->placement;
1776     parts[i]->placement->next_in_map = mp;
1777     if (mp->next_in_map) mp->next_in_map->prev_in_map = mp;
1778
1779     mp->next_in_placement = p->map_links;
1780     mp->prev_in_placement = NULL;
1781     p->map_links = mp;
1782   }
1783
1784   GARY_FREE(parts);
1785 }
1786
1787 void update_map_parts(struct placement *p)
1788 {
1789   update_map_parts_delete(p);
1790   update_map_parts_create(p);
1791 }
1792
1793 void gen_coords(struct placement *p)
1794 {
1795   switch(p->request->type)
1796   {
1797     case REQUEST_POINT:
1798       gen_coords_point(p);
1799       break;
1800     case REQUEST_AREA:
1801       gen_coords_area(p);
1802       break;
1803     case REQUEST_SEGMENT:
1804       gen_coords_segment(p);
1805       break;
1806     case REQUEST_LINE:
1807       if (dbg_movement)
1808         printf("Not yet implemented\n");
1809       break;
1810     default:
1811       if (dbg_movement >= VERBOSITY_ALL)
1812         printf("Testing request type\n");
1813       ASSERT(p->request->type != REQUEST_INVALID);
1814   }
1815
1816   update_map_parts(p);
1817 }
1818
1819 double gen_movement(void)
1820 {
1821   double m = (random() % 100000) / 10000;
1822   m = pow(m, 1.0/3) * flip(1, -1);
1823   if (dbg_movement >= VERBOSITY_ALL)
1824     printf("Movement %.2f\n", m);
1825   return m;
1826 }
1827
1828 double gen_movement_uniform(void)
1829 {
1830   return (move_max - move_min) * randdouble() * flip(1, -1);
1831 }
1832
1833 void gen_coords_point(struct placement *p)
1834 {
1835   p->x = p->x + gen_movement();
1836 }
1837
1838 void gen_coords_segment(struct placement *p)
1839 {
1840   struct request_segment *rs = (struct request_segment *) p->request;
1841   p->x = (rs->x1 + rs->x2) / 2;
1842   p->y = (rs->y1 + rs->y2) / 2;
1843 }
1844
1845 void gen_coords_area(struct placement *p)
1846 {
1847   struct request_area *ra = (struct request_area *) p->request;
1848
1849   p->x = p->x + gen_movement();
1850   p->y = p->y + gen_movement();
1851
1852   if (dbg_movement >= VERBOSITY_PLACEMENT)
1853     printf("Moved label to [%.2f; %.2f] from [%.2f; %.2f]\n", p->x, p->y, ra->cx, ra->cy);
1854 }
1855
1856 int randint(int min, int max)
1857 {
1858   if (min == max) return min;
1859   int r = random();
1860   return min + (r % (max - min));
1861 }
1862
1863 struct placement **get_closure(struct placement *placement)
1864 {
1865   struct placement **closure;
1866   GARY_INIT(closure, 0);
1867   bool *chosen = malloc(GARY_SIZE(placement->individual->placements) * sizeof(bool));
1868   for (uns i=0; i<GARY_SIZE(placement->individual->placements); i++) { chosen[i] = 0; }
1869   chosen[placement->request->ind] = 1;
1870
1871   struct placement **p = GARY_PUSH(closure); *p = placement;
1872
1873   uns first = 0;
1874   while (first < GARY_SIZE(closure))
1875   {
1876     if (dbg_breeding >= VERBOSITY_ALL)
1877       printf("Iterating, first is %d of current %u\n", first, GARY_SIZE(closure));
1878     struct placement **overlapping = get_overlapping(placement);
1879     if (! overlapping) { first++; continue; }
1880
1881     struct placement **filtered = filter(overlapping, &chosen);
1882     if (dbg_breeding >= VERBOSITY_ALL)
1883       printf("There are %u new overlapping symbols\n", GARY_SIZE(filtered));
1884     GARY_FREE(overlapping);
1885     overlapping = filtered;
1886     for (uns j=0; j<GARY_SIZE(overlapping); j++)
1887     {
1888       if (! chosen[overlapping[j]->request->ind])
1889       {
1890         if (overlaps(*p, overlapping[j]))
1891         {
1892           p = GARY_PUSH(closure); *p = overlapping[j];
1893           if (dbg_breeding >= VERBOSITY_ALL)
1894             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);
1895           chosen[overlapping[j]->request->ind] = 1;
1896         }
1897       }
1898     }
1899     GARY_FREE(overlapping);
1900     first++;
1901   }
1902
1903   free(chosen);
1904
1905   return closure;
1906 }
1907
1908 void copy_symbols(struct placement **closure, struct individual *parent, struct individual *child, bool **processed_ptr)
1909 {
1910   bool *processed = *processed_ptr;
1911   if (dbg_breeding >= VERBOSITY_ALL)
1912     printf("Will copy %u symbols\n", GARY_SIZE(closure));
1913
1914   for (uns i=0; i<GARY_SIZE(closure); i++)
1915   {
1916     processed[closure[i]->ind] = 1;
1917     int ind = closure[i]->ind;
1918     child->placements[ind] = parent->placements[ind];
1919     child->placements[ind].individual = child;
1920     child->placements[ind].processed = 0;
1921     child->placements[ind].map_links = NULL;
1922     update_map_parts(&child->placements[ind]);
1923   }
1924 }
1925
1926 void move_symbol(struct placement *p)
1927 {
1928   switch (p->request->type)
1929   {
1930     case REQUEST_POINT:
1931     case REQUEST_AREA:
1932       move_symbol_point(p);
1933       break;
1934     case REQUEST_SEGMENT:
1935       move_symbol_segment(p);
1936       break;
1937     default:
1938       ASSERT(p->request->type != REQUEST_INVALID);
1939   }
1940 }
1941
1942 void move_symbol_point(struct placement *p)
1943 {
1944   p->x += gen_movement_uniform();
1945   p->y += gen_movement_uniform();
1946 }
1947
1948 void move_symbol_segment(struct placement *p)
1949 {
1950   double m = gen_movement_uniform();
1951   // CHECK ME
1952   p->x += m;
1953   p->y += m * ((struct request_segment *) p->request)->slope;
1954 }
1955
1956 void hide_segment_labels(struct individual *individual)
1957 {
1958   // BEWARE: This fully depends on current genetic encoding
1959
1960   int used = -1, num = -1;
1961   for (uns i=0; i<GARY_SIZE(individual->placements); i++)
1962   {
1963     switch (individual->placements[i].request->type)
1964     {
1965       case REQUEST_SECTION:
1966         used = individual->placements[i].variant_used;
1967         num = 0;
1968         break;
1969       case REQUEST_SEGMENT:
1970         if (num == used)
1971           individual->placements[i].variant_used = 0;
1972         else
1973           individual->placements[i].variant_used = -1;
1974         num++;
1975         break;
1976       default:
1977         ;
1978     }
1979   }
1980 }
1981
1982 void init_placement(struct placement *p, struct individual *individual, struct request *r)
1983 {
1984   p->ind = num_placements++;
1985   p->request = r;
1986   p->processed = 0;
1987   p->x = p->y = 0; // To prevent valgrind from complaining
1988   p->variant_used = 0;
1989   p->map_links = NULL;
1990   p->individual = individual;
1991   switch (r->type)
1992   {
1993     case REQUEST_POINT: ;
1994       struct request_point *rp = (struct request_point *) r;
1995       p->x = rp->x;
1996       p->y = rp->y;
1997       break;
1998     case REQUEST_LINE: ;
1999       break;
2000     case REQUEST_SECTION: ;
2001       struct request_section *rls = (struct request_section *) r;
2002       p->variant_used = randint(0, rls->num_segments);
2003       break;
2004     case REQUEST_SEGMENT: ;
2005       struct request_segment *rs = (struct request_segment *) r;
2006       p->x = rs->x2;
2007       p->y = rs->y2;
2008       break;
2009     case REQUEST_AREA: ;
2010       struct request_area *ra = (struct request_area *) r;
2011       p->x = ra->cx;
2012       p->y = ra->cy;
2013       p->variant_used = 0;
2014       break;
2015     default:
2016       ASSERT(p->request->type != REQUEST_INVALID);
2017   }
2018
2019   gen_coords(p);
2020   if (dbg_init >= VERBOSITY_PLACEMENT)
2021     printf("Inited placement to [%.2f; %.2f]\n", p->x, p->y);
2022 }
2023
2024 void reset_individual_map(struct individual *i)
2025 {
2026   for (uns j=0; j<num_map_parts; j++)
2027   {
2028     struct map_placement *mp = i->map[j]->placement;
2029     while (mp)
2030     {
2031       struct map_placement *tmp = mp;
2032       mp = mp->next_in_map;
2033       free(tmp);
2034     }
2035
2036     free(i->map[j]);
2037     struct map_part *part = malloc(sizeof(struct map_part));
2038     part->ind = j;
2039
2040     mp = malloc(sizeof(struct map_placement));
2041     part->placement = mp;
2042     mp->placement = &dummy_placement;
2043     mp->next_in_map = mp->prev_in_map = NULL;
2044     mp->next_in_placement = mp->prev_in_placement = NULL;
2045     i->map[j] = part;
2046   }
2047 }
2048
2049 void update_individual(struct individual *individual)
2050 {
2051   for (uns i=0; i<GARY_SIZE(individual->placements); i++)
2052   {
2053     update_map_parts_delete(&individual->placements[i]);
2054   }
2055 }
2056
2057 void clear_individual(struct individual *individual)
2058 {
2059   for (uns j=0; j<num_map_parts; j++)
2060   {
2061     struct map_placement *mp = individual->map[j]->placement;
2062     while (mp)
2063     {
2064       struct map_placement *tmp = mp;
2065       mp = mp->next_in_map;
2066       free(tmp);
2067     }
2068
2069     free(individual->map[j]);
2070   }
2071
2072   GARY_FREE(individual->map);
2073   GARY_FREE(individual->placements);
2074   ep_free(ep_individuals, individual);
2075 }
2076
2077 void clear_population(struct individual **pop)
2078 {
2079   for (uns i=0; i<GARY_SIZE(pop); i++)
2080   {
2081     clear_individual(pop[i]);
2082   }
2083 }
2084
2085 struct placement **get_overlapping(struct placement *p)
2086 {
2087   struct placement **buffer;
2088   GARY_INIT(buffer, 0);
2089
2090   struct map_part **parts = get_map_parts(p);
2091   if (! parts) return NULL;
2092
2093   for (uns i=0; i<GARY_SIZE(parts); i++)
2094   {
2095     struct map_placement *mp = parts[i]->placement->next_in_map;
2096     while (mp)
2097     {
2098       if (p->variant_used >= 0)
2099       {
2100         struct placement **p = GARY_PUSH(buffer);
2101         *p = mp->placement;
2102       }
2103       mp = mp->next_in_map;
2104     }
2105   }
2106   GARY_FREE(parts);
2107
2108   if (dbg_map_parts >= VERBOSITY_PLACEMENT)
2109     printf("Returning %u potentially overlapping placements\n", GARY_SIZE(buffer));
2110
2111   return buffer;
2112 }
2113
2114 struct placement **filter(struct placement **list, bool **pred_ptr)
2115 {
2116   bool *pred = *pred_ptr; // As GARY can't be passed directly
2117   struct placement **filtered;
2118   GARY_INIT(filtered, 0);
2119
2120   for (uns i=0; i<GARY_SIZE(list); i++)
2121   {
2122     if (pred[list[i]->request->ind])
2123       continue;
2124
2125     struct placement **p = GARY_PUSH(filtered);
2126     *p = list[i];
2127   }
2128
2129   return filtered;
2130 }
2131
2132 int flip(int a, int b)
2133 {
2134   return (random() % 2 ? a : b);
2135 }
2136
2137 double randdouble(void)
2138 {
2139   return ((double) rand() / (double) RAND_MAX);
2140 }
2141
2142 void init_individual(struct individual *individual)
2143 {
2144   GARY_INIT(individual->placements, num_requests);
2145   GARY_INIT(individual->map, 0);
2146   for (uns j=0; j<num_map_parts; j++)
2147   {
2148     GARY_PUSH(individual->map);
2149     struct map_part *part = malloc(sizeof(struct map_part));
2150     struct map_placement *mp = malloc(sizeof(struct map_placement));
2151     part->placement = mp;
2152     part->ind = j;
2153     mp->placement = &dummy_placement;
2154     mp->next_in_map = mp->prev_in_map = NULL;
2155     mp->next_in_placement = mp->prev_in_placement = NULL;
2156     individual->map[j] = part;
2157   }
2158   individual->penalty = 0;
2159 }
2160
2161 void copy_individual(struct individual *src, struct individual *dest)
2162 {
2163   init_individual(dest);
2164   dest->penalty = src->penalty;
2165
2166   for (uns i=0; i<GARY_SIZE(src->placements); i++)
2167   {
2168     dest->placements[i] = src->placements[i];
2169     dest->placements[i].map_links = NULL;
2170     dest->placements[i].individual = dest;
2171
2172     update_map_parts_create(&dest->placements[i]);
2173   }
2174 }