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