Debian Codegraph @

packages/seacas/applications/fastq/filsmo.f

raw
1 C Copyright(C) 1999-2020 National Technology & Engineering Solutions
2 C of Sandia, LLC (NTESS). Under the terms of Contract DE-NA0003525 with
3 C NTESS, the U.S. Government retains certain rights in this software.
4 C
5 C See packages/seacas/LICENSE for details
6
7 SUBROUTINE FILSMO (MXND, MLN, XN, YN, ZN, LXK, KXL, NXL, LXN,
8 & LLL, NNN, NNN2, LNODES, BNSIZE, NLOOP, XMIN, XMAX, YMIN, YMAX,
9 & ZMIN, ZMAX, DEV1, KREG)
10 C***********************************************************************
11
12 C SUBROUTINE FILSMO = MESH SMOOTHING DONE BY ISOPARAMETRIC/EQUAL
13 C ANGULAR SMOOTHING OF THE ADDED INTERIOR (FREE)
14 C BOUNDARY ROW AND THEN A LENGTH-WEIGHTED/EQUAL
15 C ANGULAR BOUNDARY LAPLACIAN OF THE INTERIOR NODES.
16 C THE FREE BOUNDARY IS FINALLY SMOOTHED AGAIN.
17
18 C***********************************************************************
19
20 C VARIABLES USED:
21 C WFAC = WEIGHT (0. = LAPLACIAN, 1. = ISOPARAMETRIC)
22 C NIT = THE MAX NUMBER OF ITERATIONS TO DO.
23 C EPS = MINIMUM DISTANCE NODES MUST MOVE TO CONTINUE ITERATIONS
24 C RO = AN UNDER- OR OVER-RELAXATION FACTOR (NORMALLY 1.0)
25
26 C***********************************************************************
27
28 COMMON /TIMING/ TIMEA, TIMEP, TIMEC, TIMEPC, TIMEAJ, TIMES
29
30 DIMENSION XN(MXND), YN(MXND), ZN(MXND)
31 DIMENSION LXN(4, MXND), NXL(2, 3*MXND)
32 DIMENSION LXK(4, MXND), KXL(2, 3*MXND)
33 DIMENSION LINES(20), LNODES (MLN, MXND), BNSIZE (2, MXND)
34
35 LOGICAL BIG, ERR, GRAPH, DONE
36
37 CHARACTER*3 DEV1
38
39 CALL GETIME (TIME1)
40 GRAPH = .FALSE.
41 DONE = .FALSE.
42 WT = 10.
43
44 NIT = MAX0 (5 * NLOOP, 40)
45 TOL = .03
46 VRO = 1.
47 RO = 1.
48 WFAC = 1.0
49 WFAC2 = .5
50 CALL MNORM (MXND, XN, YN, NXL, LLL, STDLEN)
51 EPS = TOL * STDLEN
52 IF (RO .LT. 0.01) RO = 1.
53 EPS2 = (EPS * RO)**2
54
55 C FIRST SMOOTH THE ADDED ROW
56
57 IF (NLOOP .GT. 0) THEN
58 CALL ROWSMO (MXND, MLN, XN, YN, ZN, LXK, KXL, NXL, LXN, NNN,
59 & WFAC, WFAC2, NIT, EPS, RO, NNN2, LNODES, BNSIZE, LLL,
60 & GRAPH, XMIN, XMAX, YMIN, YMAX, ZMIN, ZMAX, DEV1, KREG)
61 ENDIF
62
63 C NOW SMOOTH THE INTERIOR NODES
64
65 C ITERATION LOOP
66
67 DO 140 IT = 1, NIT
68 BIG = .FALSE.
69
70 C NODE LOOP
71
72 DO 130 NODE = 1, NNN
73 IF ( (LXN (1, NODE) .GT. 0) .AND.
74 & (LXN (2, NODE) .GT. 0) .AND.
75 & (LNODES (4, NODE) .EQ. - 2) ) THEN
76 DONE = .TRUE.
77 FX = 0.
78 FY = 0.
79 SL = 0.
80 VL = 0.
81
82 C LOOP THROUGH ALL LINES CONNECTED TO NODE
83
84 CALL GETLXN (MXND, LXN, NODE, LINES, KOUNT, ERR)
85 IF (ERR) GOTO 150
86 DO 100 IL = 1, KOUNT
87 L = LINES (IL)
88 NEND = NXL (1, L) + NXL (2, L) - NODE
89 DX = XN (NEND) - XN (NODE)
90 DY = YN (NEND) - YN (NODE)
91 AL = SQRT (DX * DX + DY * DY)
92
93 C CHECK FOR A BOUNDARY NODE AT THE OTHER END
94 C OF THE LINE - TRY TO AVERAGE ANGULAR ERRORS WITH THE BOUNDARY WHERE
95 C POSSIBLE - THIS MEANS ADDING IN AN EXTRA VECTOR TO PULL THE NODE
96 C BACK TO WHERE IT OUGHT TO BE TO BE AT EQUAL ANGLES
97
98 IF (LXN (2, NEND) .LT. 0) THEN
99 CALL SETN02 (MXND, NXL, LXK, KXL, L, NEND, NODE,
100 & N0, N2)
101 CALL EQLANG (MXND, XN, YN, LXN, NODE, N0, N2,
102 & NEND, AL, VRO, VXDEL, VYDEL)
103 VL = SQRT (VXDEL * VXDEL + VYDEL * VYDEL)
104 FX = FX + (VXDEL * WT * VL)
105 FY = FY + (VYDEL * WT * VL)
106 SL = SL + VL * WT
107 ENDIF
108 FX = FX + DX * AL
109 FY = FY + DY * AL
110 SL = SL + AL
111 100 CONTINUE
112
113 C MOVE THE NODE
114
115 DELX = RO * FX/SL
116 DELY = RO * FY/SL
117
118 C ERASE THE NODE'S LINES IF GRAPH IS ON
119
120 IF (GRAPH) THEN
121 CALL LCOLOR('BLACK')
122 DO 110 II = 1, KOUNT
123 IDRAW = LINES(II)
124 NODE1 = NXL (1, IDRAW)
125 NODE2 = NXL (2, IDRAW)
126 CALL D2NODE (MXND, XN, YN, NODE1, NODE2)
127 110 CONTINUE
128 CALL LCOLOR ('WHITE')
129 ENDIF
130
131 XN (NODE) = XN (NODE)+DELX
132 YN (NODE) = YN (NODE)+DELY
133
134 C REPLOT THE NODE'S LINES IF GRAPH IS ON
135
136 IF (GRAPH) THEN
137 DO 120 II = 1, KOUNT
138 IDRAW = LINES(II)
139 NODE1 = NXL (1, IDRAW)
140 NODE2 = NXL (2, IDRAW)
141 CALL D2NODE (MXND, XN, YN, NODE1, NODE2)
142 120 CONTINUE
143 CALL SFLUSH
144 ENDIF
145 IF (DELX ** 2 + DELY ** 2 .GT. EPS2) BIG = .TRUE.
146 ENDIF
147 130 CONTINUE
148 IF (.NOT.BIG) GOTO 150
149 140 CONTINUE
150 150 CONTINUE
151
152 C NOW RESMOOTH THE ADDED ROW IF THE MESH HAS CHANGED INTERNALLY
153
154 IF ((NLOOP .GT. 0) .AND. (DONE)) THEN
155 CALL ROWSMO (MXND, MLN, XN, YN, ZN, LXK, KXL, NXL, LXN, NNN,
156 & WFAC, WFAC2, NIT, EPS, RO, NNN2, LNODES, BNSIZE, LLL,
157 & GRAPH, XMIN, XMAX, YMIN, YMAX, ZMIN, ZMAX, DEV1, KREG)
158 ENDIF
159
160 C NOW RESET ALL THE NODES AS BEING SMOOTHED
161
162 DO 160 I = 1, NNN
163 LNODES (4, I) = IABS (LNODES (4, I))
164 160 CONTINUE
165
166 CALL GETIME (TIME2)
167 TIMES = TIMES + TIME2 - TIME1
168 RETURN
169
170 END