Debian Codegraph @

packages/seacas/applications/fastq/crcsiz.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 CRCSIZ (MAXNP, X, Y, NINT, N, XEND, YEND, XCEN, YCEN,
8 & THETA1, THETA2, TANG, AA, BB, ERR, TEST, XNOLD, YNOLD, NXKOLD,
9 & LINKEG, LISTEG, BMESUR, MLINK, NPNOLD, NPEOLD, NNXK, REMESH,
10 & REXMIN, REXMAX, REYMIN, REYMAX, IDIVIS, SIZMIN, EMAX, EMIN,
11 & GRAPH)
12 C***********************************************************************
13
14 C SUBROUTINE CRCSIZ = GETS INTERVALS ON AN ARC LINE BASED ON ERROR
15 C SIZE
16
17 C***********************************************************************
18
19 DIMENSION X (MAXNP), Y (MAXNP)
20
21 DIMENSION XNOLD(NPNOLD), YNOLD(NPNOLD), NXKOLD(NNXK, NPEOLD)
22 DIMENSION LINKEG(2, MLINK), LISTEG(4 * NPEOLD), BMESUR(NPNOLD)
23
24 LOGICAL GRAPH, REMESH, TEST, ERR, SGRAPH, MOVED
25
26 IF (GRAPH) THEN
27 SGRAPH = .TRUE.
28 ELSE
29 SGRAPH = .FALSE.
30 ENDIF
31
32 ITERAT = 100
33 EPS = .01
34
35 DELANG = 0.
36 ANGNOW = 0.
37 INTNOW = 0
38 IF (GRAPH) THEN
39 CALL SYMBOL (1, X(1), Y(1), 'DIAMND')
40 CALL PLTFLU
41 ENDIF
42 100 CONTINUE
43 INTNOW = INTNOW + 1
44 IF ( ((TANG .GT. 0.) .AND.
45 & (THETA1 + ANGNOW + (DELANG * 1.3) .GT. TANG))
46 & .OR. ((TANG .LT. 0.) .AND.
47 & (THETA1 + ANGNOW + (DELANG * 1.3) .LT. TANG))
48 & ) THEN
49
50 C THE END OF THE LINE (OR CLOSE ENOUGH) HAS BEEN REACHED
51
52 C IF WE ARE TESTING OR THE INTERVALS MATCH, THEN SIMPLY FINISH THE
53 C LINE.
54
55 IF ((TEST) .OR. (INTNOW .EQ. NINT)) THEN
56 NINT = INTNOW
57 N = NINT + 1
58 X(N) = XEND
59 Y(N) = YEND
60 IF (GRAPH) THEN
61 CALL SYMBOL (1, X(INTNOW), Y(INTNOW), 'DIAMND')
62 CALL MPD2VC (1, X(INTNOW), Y(INTNOW),
63 & X(N), Y(N))
64 CALL SYMBOL (1, X(N), Y(N), 'DIAMND')
65 CALL PLTFLU
66 ENDIF
67 ELSE
68
69 C OTHERWISE, MAKE SURE THE INTERVALS ARE ALRIGHT AND ADD THE EXTRA ONE
70
71 EPS = .001
72 IF (INTNOW + 1 .NE. NINT) THEN
73 CALL MESSAGE('** PROBLEMS WITH INTNOW '//
74 & 'IN PLINE **')
75 ERR = .TRUE.
76 GOTO 160
77 ENDIF
78 ANG = THETA1 + ANGNOW +
79 & ((TANG - (THETA1 + ANGNOW)) * .5)
80 RADIUS = BB * EXP (AA * ANG)
81 X (INTNOW + 1) = XCEN + COS (ANG) * RADIUS
82 Y (INTNOW + 1) = YCEN + SIN (ANG) * RADIUS
83 N = NINT + 1
84 X(N) = XEND
85 Y(N) = YEND
86 IF (GRAPH) THEN
87 CALL SYMBOL (1, X(INTNOW + 1), Y(INTNOW + 1),
88 & 'DIAMND')
89 CALL SYMBOL (1, X(N), Y(N),
90 & 'DIAMND')
91 CALL MPD2VC (1, X(INTNOW), Y(INTNOW),
92 & X(INTNOW+1), Y(INTNOW+1))
93 CALL MPD2VC (1, X(INTNOW+1), Y(INTNOW+1),
94 & X(N), Y(N))
95 CALL PLTFLU
96 ENDIF
97 ENDIF
98 ELSE
99
100 C NOT TO THE END YET
101
102 CALL GETSIZ (XNOLD, YNOLD, NXKOLD, LINKEG, LISTEG,
103 & BMESUR, MLINK, NPNOLD, NPEOLD, NNXK, REMESH,
104 & REXMIN, REXMAX, REYMIN, REYMAX, IDIVIS, SIZMIN, EMAX,
105 & EMIN, X(INTNOW), Y(INTNOW), S1)
106 DELANG = S1 / (BB * EXP (AA * (THETA1 + ANGNOW)))
107 IF (TANG .LT. 0.) DELANG = - DELANG
108 ANG1 = ANGNOW + DELANG
109 RAD1 = BB * EXP (AA * (THETA1 + ANG1))
110 XNEW1 = XCEN + COS (THETA1 + ANG1) * RAD1
111 YNEW1 = YCEN + SIN (THETA1 + ANG1) * RAD1
112 CALL GETSIZ (XNOLD, YNOLD, NXKOLD, LINKEG, LISTEG,
113 & BMESUR, MLINK, NPNOLD, NPEOLD, NNXK, REMESH,
114 & REXMIN, REXMAX, REYMIN, REYMAX, IDIVIS, SIZMIN, EMAX,
115 & EMIN, XNEW1, YNEW1, S2)
116 DELANG = ((S1 + S2) * .5) / (BB * EXP (AA * (THETA1 + ANGNOW)))
117 IF (TANG .LT. 0.) DELANG = - DELANG
118 ANG1 = ANGNOW + DELANG
119 RAD1 = BB * EXP (AA * (THETA1 + ANG1))
120 XNEW1 = XCEN + COS (THETA1 + ANG1) * RAD1
121 YNEW1 = YCEN + SIN (THETA1 + ANG1) * RAD1
122 CALL GETSIZ (XNOLD, YNOLD, NXKOLD, LINKEG, LISTEG,
123 & BMESUR, MLINK, NPNOLD, NPEOLD, NNXK, REMESH,
124 & REXMIN, REXMAX, REYMIN, REYMAX, IDIVIS, SIZMIN, EMAX,
125 & EMIN, XNEW1, YNEW1, S3)
126 SIZNOW = (((S1 + S2) * .5) + S3) * .5
127 DELANG = SIZNOW / (BB * EXP (AA * (THETA1 + ANGNOW)))
128 IF (TANG .LT. 0.) DELANG = - DELANG
129 ANGNOW = ANGNOW + DELANG
130 RADIUS = BB * EXP (AA * (THETA1 + ANGNOW))
131 X (INTNOW + 1) = XCEN + COS (THETA1 + ANGNOW) * RADIUS
132 Y (INTNOW + 1) = YCEN + SIN (THETA1 + ANGNOW) * RADIUS
133 IF (GRAPH) THEN
134 CALL SYMBOL (1, X(INTNOW + 1), Y(INTNOW + 1),
135 & 'DIAMND')
136 CALL MPD2VC (1, X(INTNOW), Y(INTNOW),
137 & X(INTNOW+1), Y(INTNOW+1))
138 CALL PLTFLU
139 ENDIF
140 GOTO 100
141 ENDIF
142
143 C ERASE THE LINES FOR SMOOTHING IF NEEDED
144
145 IF ((.NOT. SGRAPH) .AND. (GRAPH)) THEN
146 DO 110 J = 2, NINT
147 CALL LCOLOR ('BLACK')
148 CALL MPD2VC (1, X(J), Y(J), X(J+1), Y(J+1))
149 CALL MPD2VC (1, X(J), Y(J), X(J-1), Y(J-1))
150 CALL SYMBOL (1, X(J), Y(J), 'DIAMND')
151 CALL LCOLOR ('WHITE')
152 CALL PLTFLU
153 110 CONTINUE
154 ENDIF
155
156 C NOW SMOOTH THE NODES ALONG THE LINE
157
158 DO 130 I = 1, ITERAT
159 MOVED = .FALSE.
160 ANGNOW = 0.
161 DO 120 J = 2, NINT
162 CALL GETSIZ (XNOLD, YNOLD, NXKOLD, LINKEG,
163 & LISTEG, BMESUR, MLINK, NPNOLD, NPEOLD, NNXK,
164 & REMESH, REXMIN, REXMAX, REYMIN, REYMAX,
165 & IDIVIS, SIZMIN, EMAX, EMIN, X(J-1), Y(J-1), SIZE1)
166 CALL GETSIZ (XNOLD, YNOLD, NXKOLD, LINKEG,
167 & LISTEG, BMESUR, MLINK, NPNOLD, NPEOLD, NNXK,
168 & REMESH, REXMIN, REXMAX, REYMIN, REYMAX,
169 & IDIVIS, SIZMIN, EMAX, EMIN, X(J), Y(J), SIZE2)
170 CALL GETSIZ (XNOLD, YNOLD, NXKOLD, LINKEG,
171 & LISTEG, BMESUR, MLINK, NPNOLD, NPEOLD, NNXK,
172 & REMESH, REXMIN, REXMAX, REYMIN, REYMAX,
173 & IDIVIS, SIZMIN, EMAX, EMIN, X(J+1), Y(J+1), SIZE3)
174 DIST1 = SQRT ( ((X(J-1) - X(J)) **2) +
175 & ((Y(J-1) - Y(J)) **2) )
176 DIST2 = SQRT ( ((X(J) - X(J+1)) **2) +
177 & ((Y(J) - Y(J+1)) **2) )
178 DTOTAL = DIST1 + DIST2
179 RATIO = DIST1 / DTOTAL
180 DRATIO = ((SIZE1 + SIZE2) * .5) /
181 & ( ((SIZE1 + SIZE2) * .5) +
182 & ((SIZE2 + SIZE3) * .5) )
183 TRATIO = (RATIO + DRATIO) * .5
184 IF (SGRAPH) THEN
185 CALL LCOLOR ('BLACK')
186 CALL MPD2VC (1, X(J), Y(J), X(J+1), Y(J+1))
187 CALL MPD2VC (1, X(J), Y(J), X(J-1), Y(J-1))
188 CALL SYMBOL (1, X(J), Y(J), 'DIAMND')
189 CALL LCOLOR ('WHITE')
190 CALL PLTFLU
191 ENDIF
192 SIZNOW = DTOTAL * TRATIO
193 DELANG = SIZNOW / (BB * EXP (AA * (THETA1 + ANGNOW)))
194 IF (TANG .LT. 0.) DELANG = -DELANG
195 ANGNOW = ANGNOW + DELANG
196 ANG = THETA1 + ANGNOW
197 RADIUS = BB * EXP (AA * ANG)
198 X (J) = XCEN + COS (ANG) * RADIUS
199 Y (J) = YCEN + SIN (ANG) * RADIUS
200 IF (SGRAPH) THEN
201 CALL MPD2VC (1, X(J), Y(J), X(J+1), Y(J+1))
202 CALL MPD2VC (1, X(J), Y(J), X(J-1), Y(J-1))
203 CALL SYMBOL (1, X(J), Y(J), 'DIAMND')
204 CALL PLTFLU
205 ENDIF
206 DX1 = DIST1 / (.5 * (SIZE1 + SIZE2))
207 DX2 = DIST2 / (.5 * (SIZE2 + SIZE3))
208 IF (J .EQ. 2) THEN
209 DXMAX = AMAX1 (DX1, DX2)
210 ELSE
211 DXMAX = AMAX1 (DXMAX, DX1, DX2)
212 ENDIF
213 DT = ABS((TRATIO * DTOTAL) - DIST1)
214 IF (DT/DTOTAL .GT. EPS) MOVED = .TRUE.
215 120 CONTINUE
216 IF (.NOT. MOVED) GOTO 140
217 130 CONTINUE
218 140 CONTINUE
219 IF ((.NOT. SGRAPH) .AND. (GRAPH)) THEN
220 DO 150 J = 2, NINT
221 CALL MPD2VC (1, X(J), Y(J), X(J+1), Y(J+1))
222 CALL MPD2VC (1, X(J), Y(J), X(J-1), Y(J-1))
223 CALL SYMBOL (1, X(J), Y(J), 'DIAMND')
224 CALL PLTFLU
225 150 CONTINUE
226 ENDIF
227
228 160 CONTINUE
229
230 RETURN
231
232 END