chiark / gitweb /
f6907bcfda9151eea1b8cd7d4666e66f88fba7f7
[moebius2.git] / energy.c
1 /*
2  * We try to find an optimal triangle grid
3  */
4
5 #include "common.h"
6 #include "bgl.h"
7 #include "mgraph.h"
8
9 #include <gsl/gsl_errno.h>
10 #include <gsl/gsl_multimin.h>
11
12 #define BEST_F "best"
13 #define INITIAL_F "initial"
14
15 static double edgewise_vertex_displacement_cost(const Vertices vertices);
16 static double noncircular_rim_cost(const Vertices vertices);
17
18 static void compute_vertex_areas(const Vertices vertices, double areas[N]);
19 static double best_energy= DBL_MAX;
20
21 static void cost(double *energy, double tweight, double tcost);
22 #define COST(weight, compute) cost(&energy, (weight), (compute))
23
24 /*---------- main energy computation and subroutines ----------*/
25
26 static double compute_energy(const Vertices vertices) {
27   double vertex_areas[N], energy;
28
29   compute_vertex_areas(vertices,vertex_areas);
30   energy= 0;
31   printf("cost > energy |");
32
33   COST(1000.0, edgewise_vertex_displacement_cost(vertices));
34   COST(1.0,    graph_layout_cost(vertices,vertex_areas));
35   COST(1e-30,    noncircular_rim_cost(vertices));
36   
37   printf("| total %# e |", energy);
38   if (energy < best_energy) {
39     FILE *best_f;
40     int r;
41     
42     printf(" BEST");
43     
44     best_f= fopen(BEST_F ".new","wb");  if (!best_f) diee("fopen new best");
45     r= fwrite(vertices,sizeof(Vertices),1,best_f); if (r!=1) diee("fwrite");
46     if (fclose(best_f)) diee("fclose new best");
47     if (rename(BEST_F ".new", BEST_F)) diee("rename install new best");
48
49     best_energy= energy;
50   }
51   putchar('\n');
52   flushoutput();
53
54   return energy;
55 }    
56
57 static void cost(double *energy, double tweight, double tcost) {
58   double tenergy= tweight * tcost;
59   printf(" %# e > %# e |", tcost, tenergy);
60   *energy += tenergy;
61 }
62
63 static void compute_vertex_areas(const Vertices vertices, double areas[N]) {
64   int v0,v1,v2, e1,e2, k;
65   
66   FOR_VERTEX(v0) {
67     double total= 0.0;
68     int count= 0;
69     
70     FOR_VEDGE(v0,e1,v1) {
71       e2= (e1+1) % V6;
72       v2= EDGE_END2(v0,e2);
73       if (v2<0) continue;
74       
75       double e1v[D3], e2v[D3], av[D3];
76       K {
77         e1v[k]= vertices[v1][k] - vertices[v0][k];
78         e2v[k]= vertices[v2][k] - vertices[v0][k];
79       }
80       xprod(av, e1v, e2v);
81       total += magnD(av);
82       count++;
83     }
84     areas[v0]= total / count;
85   }
86 }
87
88 /*---------- use of GSL ----------*/
89
90   /* We want to do multidimensional minimisation.
91    *
92    * We don't think there are any local minima.  Or at least, if there
93    * are, the local minimum which will be found from the starting
94    * state is the one we want.
95    *
96    * We don't want to try to provide a derivative of the cost
97    * function.  That's too tedious (and anyway the polynomial
98    * approximation to our our cost function sometimes has high degree
99    * in the inputs which means the quadratic model implied by most of
100    * the gradient descent minimisers is not ideal).
101    *
102    * This eliminates most of the algorithms.  Nelder and Mead's
103    * simplex algorithm is still available and we will try that.
104    *
105    * In our application we are searching for the optimal locations of
106    * N actualvertices in D3 (3) dimensions - ie, we are searching for
107    * the optimal metapoint in an N*D3-dimensional space.
108    * 
109    * So eg with X=Y=100, the simplex will contain 300 metavertices
110    * each of which is an array of 300 doubles for the actualvertex
111    * coordinates.  Hopefully this won't be too slow ...
112    */
113
114 static gsl_multimin_fminimizer *minimiser;
115
116 static const double stop_epsilon= 1e-4;
117
118 static double minfunc_f(const gsl_vector *x, void *params) {
119   assert(x->size == DIM);
120   assert(x->stride == 1);
121   return compute_energy((const double(*)[D3])x->data);
122 }
123
124 int main(int argc, const char *const *argv) {
125   gsl_multimin_function multimin_function;
126   double size;
127   Vertices initial, step_size;
128   FILE *initial_f;
129   gsl_vector initial_gsl, step_size_gsl;
130   int r, v, vx,vy, k;
131   
132   if (argc>1) { fputs("takes no arguments\n",stderr); exit(8); }
133
134   minimiser= gsl_multimin_fminimizer_alloc
135     (gsl_multimin_fminimizer_nmsimplex, DIM);
136   if (!minimiser) { perror("alloc minimiser"); exit(-1); }
137
138   multimin_function.f= minfunc_f;
139   multimin_function.n= DIM;
140   multimin_function.params= 0;
141
142   initial_f= fopen(INITIAL_F,"rb");  if (!initial_f) diee("fopen initial");
143   errno= 0; r= fread(initial,sizeof(initial),1,initial_f);
144   if (r!=1) diee("fread");
145   fclose(initial_f);
146
147   initial_gsl.size= DIM;
148   initial_gsl.stride= 1;
149   initial_gsl.block= 0;
150   initial_gsl.owner= 0;
151   step_size_gsl= initial_gsl;
152
153   initial_gsl.data= &initial[0][0];
154   step_size_gsl.data= &step_size[0][0];
155
156   FOR_VERTEX(v)
157     K step_size[v][k]= 1e-4;
158   FOR_RIM_VERTEX(vx,vy,v)
159     step_size[v][3] *= 0.1;
160
161   GA( gsl_multimin_fminimizer_set(minimiser, &multimin_function,
162                                   &initial_gsl, &step_size_gsl) );
163   
164   for (;;) {
165     GA( gsl_multimin_fminimizer_iterate(minimiser) );
166
167     size= gsl_multimin_fminimizer_size(minimiser);
168     r= gsl_multimin_test_size(size, stop_epsilon);
169
170     printf("size %# e, r=%d\n", size, r);
171     flushoutput();
172
173     if (r==GSL_SUCCESS) break;
174     assert(r==GSL_CONTINUE);
175   }
176   return 0;
177 }
178
179 /*---------- Edgewise vertex displacement ----------*/
180
181   /*
182    *  
183    *
184    *
185    *                Q `-_
186    *              / |    `-_
187    *   R' - _ _ _/_ |       `-.
188    *    .       /   M - - - - - S
189    *    .      /    |      _,-'
190    *    .     /     |  _,-'
191    *    .    /    , P '
192    *    .   /  ,-'
193    *    .  /,-'
194    *    . /'
195    *     R
196    *
197    *
198    *
199    *  Find R', the `expected' location of R, by
200    *  reflecting S in M (the midpoint of QP).
201    *
202    *  Let 2d = |RR'|
203    *       b = |PQ|
204    *       l = |RS|
205    *
206    *  Giving energy contribution:
207    *
208    *                               2
209    *                            b d
210    *    E             =  F   .  ----
211    *     vd, edge PQ      vd      3
212    *                             l
213    *
214    *  (The dimensions of this are those of F_vd.)
215    *
216    *  By symmetry, this calculation gives the same answer with R and S
217    *  exchanged.  Looking at the projection in the RMS plane:
218    *
219    *
220    *                           S'
221    *                         ,'
222    *                       ,'
223    *    R'               ,'             2d" = |SS'| = |RR'| = 2d
224    *      `-._         ,'
225    *          `-._   ,'                 By congruent triangles,
226    *              ` M                   with M' = midpoint of RS,
227    *              ,'  `-._              |MM'| = |RR'|/2 = d
228    *            ,'        `-._
229    *          ,'              ` S       So use
230    *        ,'       M' _ , - '            d = |MM'|
231    *      ,'   _ , - '
232    *     R - '
233    *
234    *  We choose this value for l (rather than |RM|+|MS|, say, or |RM|)
235    *  because we want this symmetry and because we're happy to punish
236    *  bending more than uneveness in the metric.
237    *
238    *  In practice to avoid division by zero we'll add epsilon to l^3
239    *  and the huge energy ought then to be sufficient for the model to
240    *  avoid being close to R=S.
241    */
242
243 static double edgewise_vertex_displacement_cost(const Vertices vertices) {
244   static const double l3_epsilon= 1e-6;
245
246   int pi,e,qi,ri,si, k;
247   double m[D3], mprime[D3], b, d2, l, sigma_bd2_l3=0;
248
249   FOR_EDGE(pi,e,qi) {
250     ri= EDGE_END2(pi,(e+1)%V6); if (ri<0) continue;
251     si= EDGE_END2(pi,(e+5)%V6); if (si<0) continue;
252     
253     K m[k]= (vertices[pi][k] + vertices[qi][k]) * 0.5;
254     K mprime[k]= (vertices[ri][k] + vertices[si][k]) * 0.5;
255     b= hypotD(vertices[pi], vertices[qi]);
256     d2= hypotD2(m, mprime);
257     l= hypotD(vertices[ri], vertices[si]);
258     double l3 = l*l*l + l3_epsilon;
259
260     sigma_bd2_l3 += b * d2 / l3;
261   }
262   return sigma_bd2_l3;
263 }
264
265 /*---------- noncircular rim cost ----------*/
266
267 static double noncircular_rim_cost(const Vertices vertices) {
268   int vy,vx,v;
269   double cost= 0.0;
270   
271   FOR_RIM_VERTEX(vy,vx,v) {
272     double oncircle[3];
273     /* By symmetry, nearest point on circle is the one with
274      * the same angle subtended at the z axis. */
275     oncircle[0]= vertices[v][0];
276     oncircle[1]= vertices[v][1];
277     oncircle[2]= 0;
278     double mult= 1.0/ magnD(oncircle);
279     oncircle[0] *= mult;
280     oncircle[1] *= mult;
281     double d2= hypotD2(vertices[v], oncircle);
282     cost += d2*d2;
283   }
284   return cost;
285 }