Update.
[universe.git] / generate.cc
1
2 ////////////////////////////////////////////////////////////////////
3 // START_IP_HEADER                                                //
4 //                                                                //
5 // Written by Francois Fleuret                                    //
6 // Contact <francois.fleuret@idiap.ch> for comments & bug reports //
7 //                                                                //
8 // END_IP_HEADER                                                  //
9 ////////////////////////////////////////////////////////////////////
10
11 // for i in {0..49}; do u=$(printf %03d $i); mkdir $u && mv dyn_${u}* ${u}; done
12
13 #include <iostream>
14 #include <fstream>
15 #include <cmath>
16 #include <stdio.h>
17 #include <stdlib.h>
18 #include <stdint.h>
19 #include <errno.h>
20 #include <string.h>
21 #include <sys/stat.h>
22
23 using namespace std;
24
25 #include "misc.h"
26 #include "task.h"
27 #include "simple_window.h"
28 #include "universe.h"
29 #include "plotter.h"
30 #include "retina.h"
31 #include "manipulator.h"
32 #include "intelligence.h"
33 #include "canvas_cairo.h"
34
35 void generate_png(Universe *universe, scalar_t scale, FILE *file) {
36   CanvasCairo canvas(scale, universe->width(), universe->height());
37   canvas.set_line_width(2.0);
38   universe->draw(&canvas);
39   canvas.write_png(file);
40 }
41
42 int main(int argc, char **argv) {
43   const scalar_t world_width = 400;
44   const scalar_t world_height = 400;
45   const scalar_t grab_start_x = world_width * 0.5;
46   const scalar_t grab_start_y = world_height * 0.75;
47   const int nb_blocks = 1;
48   const scalar_t block_size = 80;
49   const int nb_iterations = 250;
50
51   Universe *universe;
52   Polygon *grabbed_polygon;
53
54   if(argc < 2 || argc > 3) {
55     cerr << argv[0] << " <nb pairs to generate> [<dir> [<seed>]]" << endl;
56     exit(1);
57   }
58
59   int nb_pairs = atoi(argv[1]);
60
61   char dir[1024] = "/tmp/";
62
63   if(argc > 2) {
64     strncpy(dir, argv[2], sizeof(dir) / sizeof(char) - 1);
65   }
66
67   if(argc > 3) {
68     srand48(atoi(argv[1]));
69   }
70
71   universe = new Universe(10, world_width, world_height);
72
73   for(int n = 0; n < nb_pairs; n++) {
74     if(n%1000 == 0) { cout << "Example #" << n+1 << endl; }
75
76     do {
77       universe->clear();
78
79       const int nb_attempts_max = 100;
80       int nb_attempts = 0;
81
82       for(int u = 0; u < nb_blocks; u++) {
83         Polygon *pol = 0;
84
85         nb_attempts = 0;
86
87         do {
88           scalar_t x[] = {
89             - block_size * 0.5,
90             + block_size * 0.5,
91             + block_size * 0.5,
92             - block_size * 0.5,
93           };
94
95           scalar_t y[] = {
96             - block_size * 0.5,
97             - block_size * 0.5,
98             + block_size * 0.5,
99             + block_size * 0.5,
100           };
101
102           scalar_t delta = block_size / sqrt(2.0);
103           scalar_t object_center_x = delta + (world_width - 2 * delta) * drand48();
104           scalar_t object_center_y = delta + (world_height - 2 * delta) * drand48();
105           scalar_t red, green, blue;
106           red = 1.00;
107           green = red;
108           blue = red;
109           delete pol;
110           pol = new Polygon(0.5,
111                             red, green, blue,
112                             x, y, sizeof(x)/sizeof(scalar_t));
113           pol->set_position(object_center_x, object_center_y, M_PI * 2 * drand48());
114           pol->set_speed(0, 0, 0);
115           universe->initialize_polygon(pol);
116           nb_attempts++;
117         } while(nb_attempts < nb_attempts_max && universe->collide(pol));
118
119         if(nb_attempts == nb_attempts_max) {
120           delete pol;
121           u = 0;
122           universe->clear();
123           nb_attempts = 0;
124         } else {
125           universe->add_polygon(pol);
126         }
127       }
128
129       grabbed_polygon = universe->pick_polygon(grab_start_x, grab_start_y);
130     } while(!grabbed_polygon);
131
132     const scalar_t scaling = 0.16;
133
134     CanvasCairo grab_trace(scaling, world_width, world_height);
135
136     {
137       char buffer[1024];
138       sprintf(buffer, "%s/%03d/", dir, n/1000);
139       mkdir(buffer, 0777);
140     }
141
142     {
143       char buffer[1024];
144       sprintf(buffer, "%s/%03d/dyn_%06d_world_0.png", dir, n/1000, n);
145       FILE *file = fopen(buffer, "w");
146       generate_png(universe, scaling, file);
147       fclose(file);
148     }
149
150     scalar_t grab_relative_x = grabbed_polygon->relative_x(grab_start_x, grab_start_y);
151     scalar_t grab_relative_y = grabbed_polygon->relative_y(grab_start_x, grab_start_y);
152     // scalar_t grab_previous_x = grab_start_x, grab_previous_y = grab_start_y;
153
154     {
155       int n = 36;
156       scalar_t xp[n], yp[n];
157       for(int k = 0; k < n; k++) {
158         scalar_t radius = 1/scaling;
159         scalar_t alpha = 2 * M_PI * scalar_t(k) / scalar_t(n);
160         xp[k] = grab_start_x + radius * cos(alpha);
161         yp[k] = grab_start_y + radius * sin(alpha);
162       }
163       grab_trace.set_drawing_color(0.0, 0.0, 0.0);
164       grab_trace.set_line_width(1.0);
165       grab_trace.draw_polygon(1, n, xp, yp);
166     }
167
168     scalar_t dt = 0.1;
169     for(int i = 0; i < nb_iterations; i++) {
170       scalar_t xf = grabbed_polygon->absolute_x(grab_relative_x, grab_relative_y);
171       scalar_t yf = grabbed_polygon->absolute_y(grab_relative_x, grab_relative_y);
172       grabbed_polygon->apply_force(dt, xf, yf, 0.0, -1.0);
173       universe->update(dt);
174
175       /*
176         {
177         scalar_t xp[2], yp[2];
178         xp[0] = grab_previous_x;
179         yp[0] = grab_previous_y;
180         xp[1] = xf;
181         yp[1] = yf;
182         grab_previous_x = xf;
183         grab_previous_y = yf;
184
185         grab_trace.set_drawing_color(0.0, 0.0, 0.0);
186         grab_trace.draw_polygon(1, 2, xp, yp);
187         }
188       */
189     }
190
191     {
192       char buffer[1024];
193       sprintf(buffer, "%s/%03d/dyn_%06d_grab.png", dir, n/1000, n);
194       FILE *file = fopen(buffer, "w");
195       grab_trace.write_png(file);
196       fclose(file);
197     }
198
199     {
200       char buffer[1024];
201       sprintf(buffer, "%s/%03d/dyn_%06d_world_1.png", dir, n/1000, n);
202       FILE *file = fopen(buffer, "w");
203       generate_png(universe, scaling, file);
204       fclose(file);
205     }
206   }
207
208   delete universe;
209 }