source: git/src/network.c @ 859b92f

stereo-2025
Last change on this file since 859b92f was 226342b, checked in by Olly Betts <olly@…>, 8 months ago

Fix label on declaration

Not supported by older C compilers.

  • Property mode set to 100644
File size: 21.0 KB
RevLine 
[ff6cfe1]1/* network.c
[5853657]2 * Survex network reduction - find patterns and apply network reductions
[37c5191]3 * Copyright (C) 1991-2002,2005,2024 Olly Betts
[846746e]4 *
[89231c4]5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
[846746e]9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
[89231c4]12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13 * GNU General Public License for more details.
[846746e]14 *
[89231c4]15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
[ecbc6c18]17 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
[a420b49]18 */
19
[032ed06]20#if 0
[564f471]21#define DEBUG_INVALID 1
22#define VALIDATE 1
[5853657]23#define DUMP_NETWORK 1
[032ed06]24#endif
25
[4c83f84]26#include <config.h>
[d1b1380]27
28#include "validate.h"
29#include "debug.h"
[a420b49]30#include "cavern.h"
[4167edd]31#include "message.h"
[d1b1380]32#include "netbits.h"
33#include "network.h"
34#include "out.h"
35
[37c5191]36typedef struct reduction {
37   struct reduction *next;
38   enum {
39       TYPE_PARALLEL,
40       TYPE_LOLLIPOP,
41       TYPE_DELTASTAR,
42   } type;
43   linkfor* join[];
44} reduction;
[4d695ce3]45
[37c5191]46#define allocate_reduction(N) osmalloc(sizeof(reduction) + (N) * sizeof(linkfor*))
[d1b1380]47
[37c5191]48// Head of linked list of reductions.
49static reduction *reduction_stack;
[d1b1380]50
[5853657]51/* can be altered by -z<letters> on command line */
52unsigned long optimize = BITA('l') | BITA('p') | BITA('d');
53/* Lollipops, Parallel legs, Iterate mx, Delta* */
[a420b49]54
55extern void
56remove_subnets(void)
57{
58   node *stn, *stn2, *stn3, *stn4;
59   int dirn, dirn2, dirn3, dirn4;
[37c5191]60   reduction *trav;
[a420b49]61   linkfor *newleg, *newleg2;
[63d4f07]62   bool fMore = true;
[a420b49]63
[37c5191]64   reduction_stack = NULL;
[cb3d1e2]65
[a420b49]66   out_current_action(msg(/*Simplifying network*/129));
67
68   while (fMore) {
[63d4f07]69      fMore = false;
[a420b49]70      if (optimize & BITA('l')) {
[1e431a4e]71#if PRINT_NETBITS
72         printf("replacing lollipops\n");
73#endif
[5c05606]74         /*        _
75          *       ( )
76          *        * stn
77          *        |
78          *        * stn2
79          *       / \
80          * stn4 *   * stn3  -->  stn4 *---* stn3
81          *      :   :                 :   :
[a420b49]82          */
83         /* NB can have non-fixed 0 nodes */
[564f471]84         FOR_EACH_STN(stn, stnlist) {
[bf9faf6]85            if (three_node(stn)) {
[a420b49]86               dirn = -1;
87               if (stn->leg[1]->l.to == stn) dirn++;
88               if (stn->leg[0]->l.to == stn) dirn += 2;
89               if (dirn < 0) continue;
90
91               stn2 = stn->leg[dirn]->l.to;
92               if (fixed(stn2)) continue;
93
[4c07c51]94               SVX_ASSERT(three_node(stn2));
[a420b49]95
96               dirn2 = reverse_leg_dirn(stn->leg[dirn]);
97               dirn2 = (dirn2 + 1) % 3;
98               stn3 = stn2->leg[dirn2]->l.to;
99               if (stn2 == stn3) continue; /* dumb-bell - leave alone */
100
101               dirn3 = reverse_leg_dirn(stn2->leg[dirn2]);
102
[37c5191]103               trav = allocate_reduction(2);
104               trav->type = TYPE_LOLLIPOP;
105
[a420b49]106               newleg2 = (linkfor*)osnew(linkrev);
107
108               newleg = copy_link(stn3->leg[dirn3]);
109
110               dirn2 = (dirn2 + 1) % 3;
111               stn4 = stn2->leg[dirn2]->l.to;
112               dirn4 = reverse_leg_dirn(stn2->leg[dirn2]);
[d1b1380]113#if 0
[37c5191]114               printf("Lollipop found with stn...stn4 = \n");
[a420b49]115               print_prefix(stn->name); putnl();
116               print_prefix(stn2->name); putnl();
117               print_prefix(stn3->name); putnl();
118               print_prefix(stn4->name); putnl();
[d1b1380]119#endif
120
[a420b49]121               addto_link(newleg, stn2->leg[dirn2]);
[d1b1380]122
[564f471]123               /* remove stn and stn2 */
124               remove_stn_from_list(&stnlist, stn);
125               remove_stn_from_list(&stnlist, stn2);
[d1b1380]126
[37c5191]127               /* stack lollipop and replace with a leg between stn3 and stn4 */
128               trav->join[0] = stn3->leg[dirn3];
[a420b49]129               newleg->l.to = stn4;
130               newleg->l.reverse = dirn4 | FLAG_DATAHERE | FLAG_REPLACEMENTLEG;
[d1b1380]131
[37c5191]132               trav->join[1] = stn4->leg[dirn4];
[a420b49]133               newleg2->l.to = stn3;
134               newleg2->l.reverse = dirn3 | FLAG_REPLACEMENTLEG;
[d1b1380]135
[a420b49]136               stn3->leg[dirn3] = newleg;
137               stn4->leg[dirn4] = newleg2;
[d1b1380]138
[37c5191]139               trav->next = reduction_stack;
[032ed06]140#if PRINT_NETBITS
[37c5191]141               printf("remove lollipop\n");
[a420b49]142#endif
[37c5191]143               reduction_stack = trav;
[63d4f07]144               fMore = true;
[a420b49]145            }
146         }
[d1b1380]147      }
148
[a420b49]149      if (optimize & BITA('p')) {
[032ed06]150#if PRINT_NETBITS
151         printf("replacing parallel legs\n");
152#endif
[564f471]153         FOR_EACH_STN(stn, stnlist) {
[a420b49]154            /*
[5c05606]155             *  :            :
156             *  * stn3       * stn3
157             *  |            |
158             *  * stn        |
159             * ( )      -->  |
160             *  * stn2       |
161             *  |            |
162             *  * stn4       * stn4
163             *  :            :
[a420b49]164             */
[bf9faf6]165            if (three_node(stn)) {
[a420b49]166               stn2 = stn->leg[0]->l.to;
167               if (stn2 == stn->leg[1]->l.to) {
168                  dirn = 2;
169               } else if (stn2 == stn->leg[2]->l.to) {
170                  dirn = 1;
171               } else {
172                  if (stn->leg[1]->l.to != stn->leg[2]->l.to) continue;
173                  stn2 = stn->leg[1]->l.to;
174                  dirn = 0;
175               }
176
[37c5191]177               /* stn == stn2 => lollipop */
[01d9c43b]178               if (stn == stn2 || fixed(stn2)) continue;
[a420b49]179
[4c07c51]180               SVX_ASSERT(three_node(stn2));
[a420b49]181
182               stn3 = stn->leg[dirn]->l.to;
183               /* 3 parallel legs (=> nothing else) so leave */
184               if (stn3 == stn2) continue;
185
186               dirn3 = reverse_leg_dirn(stn->leg[dirn]);
187               dirn2 = (0 + 1 + 2 - reverse_leg_dirn(stn->leg[(dirn + 1) % 3])
188                        - reverse_leg_dirn(stn->leg[(dirn + 2) % 3]));
189
190               stn4 = stn2->leg[dirn2]->l.to;
191               dirn4 = reverse_leg_dirn(stn2->leg[dirn2]);
192
[37c5191]193               trav = allocate_reduction(2);
194               trav->type = TYPE_PARALLEL;
[a420b49]195
196               newleg = copy_link(stn->leg[(dirn + 1) % 3]);
197               /* use newleg2 for scratch */
198               newleg2 = copy_link(stn->leg[(dirn + 2) % 3]);
199                 {
[43d6ecfe]200#ifdef NO_COVARIANCES
[dac18d8]201                    vars sum;
202                    var prod;
[eb18f4d]203                    delta temp, temp2;
[dac18d8]204                    addss(&sum, &newleg->v, &newleg2->v);
[4c07c51]205                    SVX_ASSERT2(!fZeros(&sum), "loop of zero variance found");
[dac18d8]206                    mulss(&prod, &newleg->v, &newleg2->v);
207                    mulsd(&temp, &newleg2->v, &newleg->d);
208                    mulsd(&temp2, &newleg->v, &newleg2->d);
[a420b49]209                    adddd(&temp, &temp, &temp2);
[dac18d8]210                    divds(&newleg->d, &temp, &sum);
211                    sdivvs(&newleg->v, &prod, &sum);
[43d6ecfe]212#else
[59f2dbb]213                    svar inv1, inv2, sum;
[eb18f4d]214                    delta temp, temp2;
[43d6ecfe]215                    /* if leg one is an equate, we can just ignore leg two
216                     * whatever it is */
[dac18d8]217                    if (invert_svar(&inv1, &newleg->v)) {
218                       if (invert_svar(&inv2, &newleg2->v)) {
[59f2dbb]219                          addss(&sum, &inv1, &inv2);
[dac18d8]220                          if (!invert_svar(&newleg->v, &sum)) {
[2d3f65a]221                             BUG("matrix singular in parallel legs replacement");
[43d6ecfe]222                          }
[cb3d1e2]223
[59f2dbb]224                          mulsd(&temp, &inv1, &newleg->d);
225                          mulsd(&temp2, &inv2, &newleg2->d);
[43d6ecfe]226                          adddd(&temp, &temp, &temp2);
[59f2dbb]227                          mulsd(&newleg->d, &newleg->v, &temp);
[43d6ecfe]228                       } else {
229                          /* leg two is an equate, so just ignore leg 1 */
230                          linkfor *tmpleg;
231                          tmpleg = newleg;
232                          newleg = newleg2;
233                          newleg2 = tmpleg;
234                       }
235                    }
236#endif
[a420b49]237                 }
238               osfree(newleg2);
239               newleg2 = (linkfor*)osnew(linkrev);
240
241               addto_link(newleg, stn2->leg[dirn2]);
242               addto_link(newleg, stn3->leg[dirn3]);
[d1b1380]243
244#if 0
[a420b49]245               printf("Parallel found with stn...stn4 = \n");
246               (dump_node)(stn); (dump_node)(stn2); (dump_node)(stn3); (dump_node)(stn4);
247               printf("dirns = %d %d %d %d\n", dirn, dirn2, dirn3, dirn4);
[d1b1380]248#endif
[4c07c51]249               SVX_ASSERT2(stn3->leg[dirn3]->l.to == stn, "stn3 end of || doesn't recip");
250               SVX_ASSERT2(stn4->leg[dirn4]->l.to == stn2, "stn4 end of || doesn't recip");
251               SVX_ASSERT2(stn->leg[(dirn+1)%3]->l.to == stn2 && stn->leg[(dirn + 2) % 3]->l.to == stn2, "|| legs aren't");
[a420b49]252
[564f471]253               /* remove stn and stn2 (already discarded triple parallel) */
[a420b49]254               /* so stn!=stn4 <=> stn2!=stn3 */
[564f471]255               remove_stn_from_list(&stnlist, stn);
256               remove_stn_from_list(&stnlist, stn2);
[a420b49]257
258               /* stack parallel and replace with a leg between stn3 and stn4 */
[37c5191]259               trav->join[0] = stn3->leg[dirn3];
[a420b49]260               newleg->l.to = stn4;
261               newleg->l.reverse = dirn4 | FLAG_DATAHERE | FLAG_REPLACEMENTLEG;
262
[37c5191]263               trav->join[1] = stn4->leg[dirn4];
[a420b49]264               newleg2->l.to = stn3;
265               newleg2->l.reverse = dirn3 | FLAG_REPLACEMENTLEG;
266
267               stn3->leg[dirn3] = newleg;
268               stn4->leg[dirn4] = newleg2;
269
[37c5191]270               trav->next = reduction_stack;
[032ed06]271#if PRINT_NETBITS
272               printf("remove parallel\n");
[a420b49]273#endif
[37c5191]274               reduction_stack = trav;
[63d4f07]275               fMore = true;
[a420b49]276            }
277         }
[d1b1380]278      }
279
[a420b49]280      if (optimize & BITA('d')) {
281         node *stn5, *stn6;
[66be513]282         int dirn5, dirn6;
[a420b49]283         linkfor *legAB, *legBC, *legCA;
[1e431a4e]284#if PRINT_NETBITS
285         printf("replacing deltas with stars\n");
286#endif
[564f471]287         FOR_EACH_STN(stn, stnlist) {
[a420b49]288            /*    printf("*");*/
289            /*
[5c05606]290             *          :                     :
291             *          * stn5                * stn5
292             *          |                     |
293             *          * stn2                |
294             *         / \        -->         O stnZ
295             *        |   |                  / \
296             *    stn *---* stn3            /   \
297             *       /     \               /     \
298             * stn4 *       * stn6   stn4 *       * stn6
299             *      :       :             :       :
[a420b49]300             */
[bf9faf6]301            if (three_node(stn)) {
[66be513]302               for (int dirn12 = 0; dirn12 <= 2; dirn12++) {
303                  stn2 = stn->leg[dirn12]->l.to;
[01d9c43b]304                  if (stn2 == stn || fixed(stn2)) continue;
[66be513]305                  SVX_ASSERT(three_node(stn2));
306                  int dirn13 = (dirn12 + 1) % 3;
307                  stn3 = stn->leg[dirn13]->l.to;
308                  if (stn3 == stn || stn3 == stn2 || fixed(stn3)) continue;
309                  SVX_ASSERT(three_node(stn3));
310                  int dirn23 = reverse_leg_dirn(stn->leg[dirn12]);
311                  dirn23 = (dirn23 + 1) % 3;
312                  if (stn2->leg[dirn23]->l.to != stn3) {
313                      dirn23 = (dirn23 + 1) % 3;
314                      if (stn2->leg[dirn23]->l.to != stn3) {
315                          continue;
316                      }
[a420b49]317                  }
[66be513]318                  legAB = copy_link(stn->leg[dirn12]);
319                  legBC = copy_link(stn2->leg[dirn23]);
320                  legCA = copy_link(stn3->leg[reverse_leg_dirn(stn->leg[dirn13])]);
321                  dirn = (0 + 1 + 2) - dirn12 - dirn13;
322                  dirn2 = (0 + 1 + 2) - dirn23 - reverse_leg_dirn(stn->leg[dirn12]);
323                  dirn3 = (0 + 1 + 2) - reverse_leg_dirn(stn->leg[dirn13]) - reverse_leg_dirn(stn2->leg[dirn23]);
324                  stn4 = stn->leg[dirn]->l.to;
325                  stn5 = stn2->leg[dirn2]->l.to;
326                  stn6 = stn3->leg[dirn3]->l.to;
327                  if (stn4 == stn2 || stn4 == stn3 || stn5 == stn3) continue;
328                  dirn4 = reverse_leg_dirn(stn->leg[dirn]);
329                  dirn5 = reverse_leg_dirn(stn2->leg[dirn2]);
330                  dirn6 = reverse_leg_dirn(stn3->leg[dirn3]);
[d1b1380]331#if 0
[66be513]332                  printf("delta-star, stn ... stn6 are:\n");
333                  (dump_node)(stn);
334                  (dump_node)(stn2);
335                  (dump_node)(stn3);
336                  (dump_node)(stn4);
337                  (dump_node)(stn5);
338                  (dump_node)(stn6);
[d1b1380]339#endif
[66be513]340                  SVX_ASSERT(stn4->leg[dirn4]->l.to == stn);
341                  SVX_ASSERT(stn5->leg[dirn5]->l.to == stn2);
342                  SVX_ASSERT(stn6->leg[dirn6]->l.to == stn3);
[a420b49]343
[37c5191]344                  trav = allocate_reduction(3);
345                  trav->type = TYPE_DELTASTAR;
[66be513]346                  {
[e322717]347                    linkfor *legAZ, *legBZ, *legCZ;
[a420b49]348                    node *stnZ;
349                    prefix *nameZ;
[59f2dbb]350                    svar invAB, invBC, invCA, tmp, sum, inv;
351                    var vtmp;
352                    svar sumAZBZ, sumBZCZ, sumCZAZ;
[eb18f4d]353                    delta temp, temp2;
[cb3d1e2]354
[43d6ecfe]355                    /* FIXME: ought to handle cases when some legs are
356                     * equates, but handle as a special case maybe? */
[dac18d8]357                    if (!invert_svar(&invAB, &legAB->v)) break;
358                    if (!invert_svar(&invBC, &legBC->v)) break;
359                    if (!invert_svar(&invCA, &legCA->v)) break;
[43d6ecfe]360
[59f2dbb]361                    addss(&sum, &legBC->v, &legCA->v);
362                    addss(&tmp, &sum, &legAB->v);
[dac18d8]363                    if (!invert_svar(&inv, &tmp)) {
[647407d]364                       /* impossible - loop of zero variance */
365                       BUG("loop of zero variance found");
366                    }
[cb3d1e2]367
[e322717]368                    legAZ = osnew(linkfor);
369                    legBZ = osnew(linkfor);
370                    legCZ = osnew(linkfor);
371
[43d6ecfe]372                    /* AZBZ */
[c861f75]373                    /* done above: addvv(&sum, &legBC->v, &legCA->v); */
[59f2dbb]374                    mulss(&vtmp, &sum, &inv);
375                    smulvs(&sumAZBZ, &vtmp, &legAB->v);
[43d6ecfe]376
377                    adddd(&temp, &legBC->d, &legCA->d);
[59f2dbb]378                    divds(&temp2, &temp, &sum);
379                    mulsd(&temp, &invAB, &legAB->d);
[c861f75]380                    subdd(&temp, &temp2, &temp);
[59f2dbb]381                    mulsd(&legBZ->d, &sumAZBZ, &temp);
[43d6ecfe]382
[c861f75]383                    /* leg vectors after transform are determined up to
384                     * a constant addition, so arbitrarily fix AZ = 0 */
385                    legAZ->d[2] = legAZ->d[1] = legAZ->d[0] = 0;
[43d6ecfe]386
[c861f75]387                    /* BZCZ */
[59f2dbb]388                    addss(&sum, &legCA->v, &legAB->v);
389                    mulss(&vtmp, &sum, &inv);
390                    smulvs(&sumBZCZ, &vtmp, &legBC->v);
[43d6ecfe]391
392                    /* CZAZ */
[59f2dbb]393                    addss(&sum, &legAB->v, &legBC->v);
394                    mulss(&vtmp, &sum, &inv);
395                    smulvs(&sumCZAZ, &vtmp, &legCA->v);
[43d6ecfe]396
397                    adddd(&temp, &legAB->d, &legBC->d);
[59f2dbb]398                    divds(&temp2, &temp, &sum);
399                    mulsd(&temp, &invCA, &legCA->d);
[c861f75]400                    /* NB: swapped arguments to negate answer for legCZ->d */
401                    subdd(&temp, &temp, &temp2);
[59f2dbb]402                    mulsd(&legCZ->d, &sumCZAZ, &temp);
[43d6ecfe]403
[e322717]404                    osfree(legAB);
405                    osfree(legBC);
406                    osfree(legCA);
407
[43d6ecfe]408                    /* Now add two, subtract third, and scale by 0.5 */
[59f2dbb]409                    addss(&sum, &sumAZBZ, &sumCZAZ);
410                    subss(&sum, &sum, &sumBZCZ);
411                    mulsc(&legAZ->v, &sum, 0.5);
[43d6ecfe]412
[59f2dbb]413                    addss(&sum, &sumBZCZ, &sumAZBZ);
414                    subss(&sum, &sum, &sumCZAZ);
415                    mulsc(&legBZ->v, &sum, 0.5);
[43d6ecfe]416
[59f2dbb]417                    addss(&sum, &sumCZAZ, &sumBZCZ);
418                    subss(&sum, &sum, &sumAZBZ);
419                    mulsc(&legCZ->v, &sum, 0.5);
[43d6ecfe]420
[a420b49]421                    nameZ = osnew(prefix);
[be97baf]422                    nameZ->pos = osnew(pos);
[ba84079]423                    nameZ->ident.p = NULL;
[6adb88c]424                    nameZ->shape = 3;
[a420b49]425                    stnZ = osnew(node);
426                    stnZ->name = nameZ;
427                    nameZ->stn = stnZ;
428                    nameZ->up = NULL;
[932f7e9]429                    nameZ->min_export = nameZ->max_export = 0;
[a420b49]430                    unfix(stnZ);
[564f471]431                    add_stn_to_list(&stnlist, stnZ);
[a420b49]432                    legAZ->l.to = stnZ;
433                    legAZ->l.reverse = 0 | FLAG_DATAHERE | FLAG_REPLACEMENTLEG;
434                    legBZ->l.to = stnZ;
435                    legBZ->l.reverse = 1 | FLAG_DATAHERE | FLAG_REPLACEMENTLEG;
436                    legCZ->l.to = stnZ;
437                    legCZ->l.reverse = 2 | FLAG_DATAHERE | FLAG_REPLACEMENTLEG;
438                    stnZ->leg[0] = (linkfor*)osnew(linkrev);
439                    stnZ->leg[1] = (linkfor*)osnew(linkrev);
440                    stnZ->leg[2] = (linkfor*)osnew(linkrev);
441                    stnZ->leg[0]->l.to = stn4;
442                    stnZ->leg[0]->l.reverse = dirn4;
443                    stnZ->leg[1]->l.to = stn5;
444                    stnZ->leg[1]->l.reverse = dirn5;
445                    stnZ->leg[2]->l.to = stn6;
446                    stnZ->leg[2]->l.reverse = dirn6;
[dbb4e19]447                    addto_link(legAZ, stn4->leg[dirn4]);
448                    addto_link(legBZ, stn5->leg[dirn5]);
449                    addto_link(legCZ, stn6->leg[dirn6]);
[a420b49]450                    /* stack stuff */
[37c5191]451                    trav->join[0] = stn4->leg[dirn4];
452                    trav->join[1] = stn5->leg[dirn5];
453                    trav->join[2] = stn6->leg[dirn6];
454                    trav->next = reduction_stack;
[032ed06]455#if PRINT_NETBITS
456                    printf("remove delta*\n");
[a420b49]457#endif
[37c5191]458                    reduction_stack = trav;
[63d4f07]459                    fMore = true;
[cb3d1e2]460
[564f471]461                    remove_stn_from_list(&stnlist, stn);
462                    remove_stn_from_list(&stnlist, stn2);
463                    remove_stn_from_list(&stnlist, stn3);
[a420b49]464                    stn4->leg[dirn4] = legAZ;
465                    stn5->leg[dirn5] = legBZ;
466                    stn6->leg[dirn6] = legCZ;
[66be513]467                  }
468                  break;
469               }
[a420b49]470            }
471         }
472      }
[d1b1380]473
[a420b49]474   }
[d1b1380]475}
476
[5853657]477extern void
[a420b49]478replace_subnets(void)
479{
[eb18f4d]480   node *stn2, *stn3, *stn4;
481   int dirn2, dirn3, dirn4;
[4d695ce3]482
483   /* help to catch bad accesses */
[eb18f4d]484   stn2 = stn3 = stn4 = NULL;
485   dirn2 = dirn3 = dirn4 = 0;
[4d695ce3]486
[a420b49]487   out_current_action(msg(/*Calculating network*/130));
[4d695ce3]488
[37c5191]489   while (reduction_stack != NULL) {
490      /*  printf("replace_subnets() type %d\n", reduction_stack->type);*/
[032ed06]491
492#if PRINT_NETBITS
493      printf("replace_subnets\n");
[37c5191]494      if (reduction_stack->type == TYPE_LOLLIPOP) printf("islollipop\n");
495      if (reduction_stack->type == TYPE_PARALLEL) printf("isparallel\n");
496      if (reduction_stack->type == TYPE_DELTASTAR) printf("isdelta*\n");
[032ed06]497#endif
498
[37c5191]499      if (reduction_stack->type != TYPE_DELTASTAR) {
[eb18f4d]500         linkfor *leg;
[37c5191]501         leg = reduction_stack->join[0]; leg = reverse_leg(leg);
[421b7d2]502         stn3 = leg->l.to; dirn3 = reverse_leg_dirn(leg);
[37c5191]503         leg = reduction_stack->join[1]; leg = reverse_leg(leg);
[421b7d2]504         stn4 = leg->l.to; dirn4 = reverse_leg_dirn(leg);
[cb3d1e2]505
[cfef352]506         if (!fixed(stn3) || !fixed(stn4)) {
507             SVX_ASSERT(!fixed(stn3) && !fixed(stn4));
508             goto skip;
509         }
[4c07c51]510         SVX_ASSERT(data_here(stn3->leg[dirn3]));
[4d695ce3]511      }
[d1b1380]512
[37c5191]513      if (reduction_stack->type == TYPE_LOLLIPOP) {
[eb18f4d]514         node *stn;
[421b7d2]515         delta e;
516         linkfor *leg;
[e6cfe52]517         int zero;
[43d6ecfe]518
[e6cfe52]519         leg = stn3->leg[dirn3];
[37c5191]520         stn2 = reduction_stack->join[0]->l.to;
521         dirn2 = reverse_leg_dirn(reduction_stack->join[0]);
[e6cfe52]522
523         zero = fZeros(&leg->v);
524         if (!zero) {
525            delta tmp;
526            subdd(&e, &POSD(stn4), &POSD(stn3));
527            subdd(&tmp, &e, &leg->d);
528            divds(&e, &tmp, &leg->v);
529         }
[37c5191]530         if (data_here(reduction_stack->join[0])) {
531            adddd(&POSD(stn2), &POSD(stn3), &reduction_stack->join[0]->d);
[e6cfe52]532            if (!zero) {
[eb18f4d]533               delta tmp;
[37c5191]534               mulsd(&tmp, &reduction_stack->join[0]->v, &e);
[e6cfe52]535               adddd(&POSD(stn2), &POSD(stn2), &tmp);
536            }
537         } else {
538            subdd(&POSD(stn2), &POSD(stn3), &stn2->leg[dirn2]->d);
539            if (!zero) {
540               delta tmp;
541               mulsd(&tmp, &stn2->leg[dirn2]->v, &e);
542               adddd(&POSD(stn2), &POSD(stn2), &tmp);
543            }
544         }
545         dirn2 = (dirn2 + 2) % 3; /* point back at stn again */
546         stn = stn2->leg[dirn2]->l.to;
[d1b1380]547#if 0
[37c5191]548         printf("Replacing lollipop with stn...stn4 = \n");
[e6cfe52]549         print_prefix(stn->name); putnl();
550         print_prefix(stn2->name); putnl();
551         print_prefix(stn3->name); putnl();
552         print_prefix(stn4->name); putnl();
[d1b1380]553#endif
[e6cfe52]554         if (data_here(stn2->leg[dirn2]))
555            adddd(&POSD(stn), &POSD(stn2), &stn2->leg[dirn2]->d);
556         else
557            subdd(&POSD(stn), &POSD(stn2), &reverse_leg(stn2->leg[dirn2])->d);
558
[37c5191]559         /* The "stick" of the lollipop is a new articulation. */
[e6cfe52]560         stn2->leg[dirn2]->l.reverse |= FLAG_ARTICULATION;
561         reverse_leg(stn2->leg[dirn2])->l.reverse |= FLAG_ARTICULATION;
562
[bf9faf6]563         add_stn_to_list(&fixedlist, stn);
564         add_stn_to_list(&fixedlist, stn2);
[d1b1380]565
[421b7d2]566         osfree(stn3->leg[dirn3]);
[37c5191]567         stn3->leg[dirn3] = reduction_stack->join[0];
[421b7d2]568         osfree(stn4->leg[dirn4]);
[37c5191]569         stn4->leg[dirn4] = reduction_stack->join[1];
570      } else if (reduction_stack->type == TYPE_PARALLEL) {
[421b7d2]571         /* parallel legs */
[eb18f4d]572         node *stn;
[421b7d2]573         delta e, e2;
574         linkfor *leg;
[e6cfe52]575         int dirn;
[421b7d2]576
[37c5191]577         stn = reduction_stack->join[0]->l.to;
578         stn2 = reduction_stack->join[1]->l.to;
[402c753]579
[37c5191]580         dirn = reverse_leg_dirn(reduction_stack->join[0]);
581         dirn2 = reverse_leg_dirn(reduction_stack->join[1]);
[e6cfe52]582
583         leg = stn3->leg[dirn3];
584
585         if (leg->l.reverse & FLAG_ARTICULATION) {
[37c5191]586            reduction_stack->join[0]->l.reverse |= FLAG_ARTICULATION;
[e6cfe52]587            stn->leg[dirn]->l.reverse |= FLAG_ARTICULATION;
[37c5191]588            reduction_stack->join[1]->l.reverse |= FLAG_ARTICULATION;
[e6cfe52]589            stn2->leg[dirn2]->l.reverse |= FLAG_ARTICULATION;
590         }
591
592         if (fZeros(&leg->v))
593            e[0] = e[1] = e[2] = 0.0;
594         else {
595            delta tmp;
596            subdd(&e, &POSD(stn4), &POSD(stn3));
597            subdd(&tmp, &e, &leg->d);
598            divds(&e, &tmp, &leg->v);
599         }
600
[37c5191]601         if (data_here(reduction_stack->join[0])) {
602            leg = reduction_stack->join[0];
[e6cfe52]603            adddd(&POSD(stn), &POSD(stn3), &leg->d);
604         } else {
605            leg = stn->leg[dirn];
606            subdd(&POSD(stn), &POSD(stn3), &leg->d);
607         }
608         mulsd(&e2, &leg->v, &e);
609         adddd(&POSD(stn), &POSD(stn), &e2);
610
[37c5191]611         if (data_here(reduction_stack->join[1])) {
612            leg = reduction_stack->join[1];
[e6cfe52]613            adddd(&POSD(stn2), &POSD(stn4), &leg->d);
614         } else {
615            leg = stn2->leg[dirn2];
616            subdd(&POSD(stn2), &POSD(stn4), &leg->d);
617         }
618         mulsd(&e2, &leg->v, &e);
619         subdd(&POSD(stn2), &POSD(stn2), &e2);
[d1b1380]620#if 0
[e6cfe52]621         printf("Replacing parallel with stn...stn4 = \n");
622         print_prefix(stn->name); putnl();
623         print_prefix(stn2->name); putnl();
624         print_prefix(stn3->name); putnl();
625         print_prefix(stn4->name); putnl();
[d1b1380]626#endif
[e6cfe52]627
[bf9faf6]628         add_stn_to_list(&fixedlist, stn);
629         add_stn_to_list(&fixedlist, stn2);
[cb3d1e2]630
[421b7d2]631         osfree(stn3->leg[dirn3]);
[37c5191]632         stn3->leg[dirn3] = reduction_stack->join[0];
[421b7d2]633         osfree(stn4->leg[dirn4]);
[37c5191]634         stn4->leg[dirn4] = reduction_stack->join[1];
635      } else if (reduction_stack->type == TYPE_DELTASTAR) {
[421b7d2]636         node *stnZ;
637         node *stn[3];
638         int dirn[3];
639         int i;
640         linkfor *leg;
641
642         /* work out ends as we don't bother stacking them */
[37c5191]643         leg = reverse_leg(reduction_stack->join[0]);
[421b7d2]644         stn[0] = leg->l.to;
645         dirn[0] = reverse_leg_dirn(leg);
646         stnZ = stn[0]->leg[dirn[0]]->l.to;
[4c07c51]647         SVX_ASSERT(fixed(stnZ));
[cfef352]648         if (!fixed(stnZ)) {
649            SVX_ASSERT(!fixed(stn[0]));
650            goto skip;
651         }
[421b7d2]652         stn[1] = stnZ->leg[1]->l.to;
[a420b49]653         dirn[1] = reverse_leg_dirn(stnZ->leg[1]);
[421b7d2]654         stn[2] = stnZ->leg[2]->l.to;
[a420b49]655         dirn[2] = reverse_leg_dirn(stnZ->leg[2]);
[564f471]656         /*print_prefix(stnZ->name);printf(" %p\n",(void*)stnZ);*/
[4d695ce3]657
[e6cfe52]658         for (i = 0; i < 3; i++) {
[4c07c51]659            SVX_ASSERT2(fixed(stn[i]), "stn not fixed for D*");
[1e431a4e]660
[e6cfe52]661            leg = stn[i]->leg[dirn[i]];
[1e431a4e]662
[4c07c51]663            SVX_ASSERT2(data_here(leg), "data not on leg for D*");
664            SVX_ASSERT2(leg->l.to == stnZ, "bad sub-network for D*");
[1e431a4e]665
[37c5191]666            stn2 = reduction_stack->join[i]->l.to;
[1e431a4e]667
[37c5191]668            if (data_here(reduction_stack->join[i])) {
669               adddd(&POSD(stn2), &POSD(stn[i]), &reduction_stack->join[i]->d);
[1e431a4e]670            } else {
[37c5191]671               subdd(&POSD(stn2), &POSD(stn[i]), &reverse_leg(reduction_stack->join[i])->d);
[1e431a4e]672            }
673
[e6cfe52]674            if (!fZeros(&leg->v)) {
675               delta e, tmp;
676               subdd(&e, &POSD(stnZ), &POSD(stn[i]));
677               subdd(&e, &e, &leg->d);
678               divds(&tmp, &e, &leg->v);
[37c5191]679               if (data_here(reduction_stack->join[i])) {
680                  mulsd(&e, &reduction_stack->join[i]->v, &tmp);
[1e431a4e]681               } else {
[37c5191]682                  mulsd(&e, &reverse_leg(reduction_stack->join[i])->v, &tmp);
[1e431a4e]683               }
[e6cfe52]684               adddd(&POSD(stn2), &POSD(stn2), &e);
685            }
[bf9faf6]686            add_stn_to_list(&fixedlist, stn2);
[e6cfe52]687            osfree(leg);
[37c5191]688            stn[i]->leg[dirn[i]] = reduction_stack->join[i];
[e6cfe52]689            /* transfer the articulation status of the radial legs */
690            if (stnZ->leg[i]->l.reverse & FLAG_ARTICULATION) {
[37c5191]691               reduction_stack->join[i]->l.reverse |= FLAG_ARTICULATION;
692               reverse_leg(reduction_stack->join[i])->l.reverse |= FLAG_ARTICULATION;
[e6cfe52]693            }
694            osfree(stnZ->leg[i]);
695            stnZ->leg[i] = NULL;
696         }
697/*printf("---%f %f %f\n",POS(stnZ, 0), POS(stnZ, 1), POS(stnZ, 2));*/
[bf9faf6]698         remove_stn_from_list(&fixedlist, stnZ);
[dbb4e19]699         osfree(stnZ->name);
700         osfree(stnZ);
[4d695ce3]701      } else {
[37c5191]702         BUG("reduction_stack has unknown type");
[4d695ce3]703      }
[d1b1380]704
[226342b]705skip:;
[37c5191]706      reduction *ptrOld = reduction_stack;
707      reduction_stack = reduction_stack->next;
[4d695ce3]708      osfree(ptrOld);
709   }
[d1b1380]710}
Note: See TracBrowser for help on using the repository browser.