| 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 |
C======================================================================= |
| 8 |
SUBROUTINE PAINTF (CNTR0, CNTR1, VARNP, NLNKF, LINKF1, |
| 9 |
& XN, YN, ZN, XF, YF, ZF) |
| 10 |
C======================================================================= |
| 11 |
|
| 12 |
C --*** PAINTF *** (DETOUR) Paint face contour for a face |
| 13 |
C -- Modified by John H. Glick - 10/26/88 |
| 14 |
C -- Written by Amy Gilkey - revised 10/22/87 |
| 15 |
C -- |
| 16 |
C --PAINTF paints a contour section for a face. The contour algorithm |
| 17 |
C --assumes that the elements do not contain internal nodes. |
| 18 |
C --The element interpolation field is approximated by logically drawing |
| 19 |
C --lines from each node to the element center and, thusly, dividing the |
| 20 |
C --element into triangles. Contour sections are then drawn by connecting |
| 21 |
C --the intersection points of the sub-element edges and the contour |
| 22 |
C --plane. |
| 23 |
C -- |
| 24 |
C --Parameters: |
| 25 |
C -- CNTR0, CNTR1 - the contour values delimiting the contour section |
| 26 |
C -- VARNP - IN - the contour function values |
| 27 |
C -- NLNKF - IN - the number of nodes per face |
| 28 |
C -- LINKF1 - IN - the connectivity for the face |
| 29 |
C -- XN, YN, ZN - IN - the nodal coordinates |
| 30 |
C -- XF, YF, ZF - IN - the face center coordinates |
| 31 |
C -- |
| 32 |
C --Common Variables: |
| 33 |
C -- Uses IS3DIM of /D3NUMS/ |
| 34 |
|
| 35 |
PARAMETER (KDONE=0, KERR1=-1, KERR2=-2, KERR3=-3, |
| 36 |
& KCORNR=1, KISIDE=2, KMIDDL=3, KOSIDE=4, KFINDS=5) |
| 37 |
|
| 38 |
include 'd3nums.blk' |
| 39 |
|
| 40 |
REAL VARNP(*) |
| 41 |
INTEGER LINKF1(NLNKF) |
| 42 |
REAL XN(*), YN(*), ZN(*) |
| 43 |
|
| 44 |
LOGICAL INTERP_BL |
| 45 |
LOGICAL INTERC, INTEQC |
| 46 |
LOGICAL ISDONE(8) |
| 47 |
REAL XPTS(24), YPTS(24) |
| 48 |
|
| 49 |
ICNVS (I) = MOD (I+NNPF-1, NNPF) + 1 |
| 50 |
C --ICNVS converts out of range side numbers (1..NLNKF) |
| 51 |
|
| 52 |
INTERC (CN, C0, C1) = (C0 .LT. CN) .AND. (CN .LT. C1) |
| 53 |
C --INTERC returns true iff corner is within two contours |
| 54 |
INTEQC (CN, CNN, C0, C1) = (CN .EQ. CNN) |
| 55 |
& .AND. ((CN .EQ. C0) .OR. (CN .EQ. C1)) |
| 56 |
C --INTEQC returns true iff corners are equal to each other and a contour |
| 57 |
|
| 58 |
if (nlnkf .eq. 4) then |
| 59 |
C -- Most common case for 3D |
| 60 |
C -- Compute center function value and coordinates |
| 61 |
|
| 62 |
FM = (varnp(linkf1(1)) + varnp(linkf1(2)) + varnp(linkf1(3)) + |
| 63 |
* varnp(linkf1(4))) / 4.0 |
| 64 |
XM = XF |
| 65 |
YM = YF |
| 66 |
NTRI = NLNKF |
| 67 |
NNPF = NLNKF |
| 68 |
MAXPT = 12 |
| 69 |
|
| 70 |
else IF (NLNKF .EQ. 3) THEN |
| 71 |
|
| 72 |
C --Special case - triangle element |
| 73 |
|
| 74 |
N = LINKF1(2) |
| 75 |
FM = VARNP(N) |
| 76 |
XM = XN(N) |
| 77 |
YM = YN(N) |
| 78 |
IFL = 0 |
| 79 |
NTRI = 1 |
| 80 |
NNPF = NLNKF |
| 81 |
|
| 82 |
ELSE IF ((.NOT. IS3DIM) .AND. (NLNKF .EQ. 8)) THEN |
| 83 |
|
| 84 |
C --Compute center function value and coordinates |
| 85 |
|
| 86 |
FM = -0.25 * (varnp(linkf1(1)) + varnp(linkf1(3)) + |
| 87 |
* varnp(linkf1(5)) + varnp(linkf1(7))) + 0.5 * |
| 88 |
* (varnp(linkf1(2)) + varnp(linkf1(4)) + |
| 89 |
* varnp(linkf1(6)) + varnp(linkf1(8))) |
| 90 |
FM = FM |
| 91 |
XM = XF |
| 92 |
YM = YF |
| 93 |
NTRI = NLNKF |
| 94 |
NNPF = NLNKF |
| 95 |
MAXPT = 24 |
| 96 |
|
| 97 |
ELSE IF ((.NOT. IS3DIM) .AND. (NLNKF .EQ. 9)) THEN |
| 98 |
|
| 99 |
C --Compute center function value and coordinates |
| 100 |
|
| 101 |
FM = VARNP(LINKF1(9)) |
| 102 |
XM = XN(LINKF1(9)) |
| 103 |
YM = YN(LINKF1(9)) |
| 104 |
NTRI = NLNKF - 1 |
| 105 |
NNPF = NLNKF - 1 |
| 106 |
MAXPT = 24 |
| 107 |
|
| 108 |
ELSE |
| 109 |
|
| 110 |
C --Compute center function value and coordinates |
| 111 |
|
| 112 |
FM = 0.0 |
| 113 |
DO 120 K = 1, NLNKF |
| 114 |
FM = FM + VARNP(LINKF1(K)) |
| 115 |
120 CONTINUE |
| 116 |
FM = FM / NLNKF |
| 117 |
XM = XF |
| 118 |
YM = YF |
| 119 |
NTRI = NLNKF |
| 120 |
NNPF = NLNKF |
| 121 |
MAXPT = 12 |
| 122 |
END IF |
| 123 |
|
| 124 |
C --Special check to paint the triangle formed by two adjacent nodes |
| 125 |
C --equal to each other, the middle value, and CNTR0 |
| 126 |
|
| 127 |
IF ((NTRI .GT. 1) .AND. (CNTR0 .EQ. FM)) THEN |
| 128 |
IFL = 0 |
| 129 |
FLAST = VARNP(LINKF1(NNPF)) |
| 130 |
DO 130 K = 1, NNPF |
| 131 |
FTHIS = VARNP(LINKF1(K)) |
| 132 |
IF ((FLAST .EQ. FTHIS) .AND. (FTHIS .EQ. FM)) IFL = K |
| 133 |
FLAST = FTHIS |
| 134 |
130 CONTINUE |
| 135 |
|
| 136 |
IF (IFL .GT. 0) THEN |
| 137 |
|
| 138 |
XPTS(1) = XM |
| 139 |
YPTS(1) = YM |
| 140 |
N1 = LINKF1(IFL) |
| 141 |
XPTS(2) = XN(N1) |
| 142 |
YPTS(2) = YN(N1) |
| 143 |
N = LINKF1(ICNVS(IFL-1)) |
| 144 |
XPTS(3) = XN(N) |
| 145 |
YPTS(3) = YN(N) |
| 146 |
CALL MPD2PG (3, XPTS, YPTS, 'S') |
| 147 |
END IF |
| 148 |
END IF |
| 149 |
|
| 150 |
CALL INILOG (NTRI, .FALSE., ISDONE) |
| 151 |
|
| 152 |
NPTS = 0 |
| 153 |
DO 150 ISIDE = 1, NTRI |
| 154 |
|
| 155 |
C --Check each side of the face, looking for a corner in the |
| 156 |
C --contour area or a dividing line in the contour area |
| 157 |
|
| 158 |
IF (ISDONE(ISIDE)) GOTO 150 |
| 159 |
|
| 160 |
IS = ISIDE |
| 161 |
N = LINKF1(IS) |
| 162 |
N1 = LINKF1(ICNVS(IS+1)) |
| 163 |
ISTART = IS |
| 164 |
|
| 165 |
ISTATE = KDONE |
| 166 |
IF (INTERC (VARNP(N), CNTR0, CNTR1)) THEN |
| 167 |
ICNTR = -1 |
| 168 |
ISTATE = KCORNR |
| 169 |
ELSE IF ((INTERP_BL (CNTR0, VARNP(N), VARNP(N1), PSI)) |
| 170 |
& .AND. (VARNP(N1) .GT. CNTR0)) THEN |
| 171 |
ICNTR = 0 |
| 172 |
CNTR = CNTR0 |
| 173 |
ISTATE = KISIDE |
| 174 |
END IF |
| 175 |
|
| 176 |
140 CONTINUE |
| 177 |
IF ((ISTATE .GT. KDONE) .AND. (NPTS .LT. MAXPT)) THEN |
| 178 |
|
| 179 |
IF (ISTATE .EQ. KCORNR) THEN |
| 180 |
|
| 181 |
C --Corner is within the contour area, goto side-1 |
| 182 |
|
| 183 |
NPTS = NPTS + 1 |
| 184 |
XPTS(NPTS) = XN(N) |
| 185 |
YPTS(NPTS) = YN(N) |
| 186 |
ISDONE(IS) = .TRUE. |
| 187 |
IS = ICNVS(IS-1) |
| 188 |
ISDONE(IS) = .TRUE. |
| 189 |
N = LINKF1(IS) |
| 190 |
N1 = LINKF1(ICNVS(IS+1)) |
| 191 |
ISTATE = KFINDS |
| 192 |
IF (IS .EQ. ISTART) ISTATE = KDONE |
| 193 |
|
| 194 |
ELSE IF (ISTATE .EQ. KISIDE) THEN |
| 195 |
|
| 196 |
C --Side crossing starts a contour area delimiter, find |
| 197 |
C --direction and follow contour line |
| 198 |
|
| 199 |
NPTS = NPTS + 1 |
| 200 |
XPTS(NPTS) = XN(N) * (1.-PSI) + XN(N1) * PSI |
| 201 |
YPTS(NPTS) = YN(N) * (1.-PSI) + YN(N1) * PSI |
| 202 |
ISDONE(IS) = .TRUE. |
| 203 |
|
| 204 |
C --Find the direction to follow this contour line through |
| 205 |
C --the face center |
| 206 |
|
| 207 |
ISTATE = KERR3 |
| 208 |
IF (INTERP_BL (CNTR, VARNP(N1), FM, PSI)) THEN |
| 209 |
IDIR = +1 |
| 210 |
I = N1 |
| 211 |
ISTATE = KMIDDL |
| 212 |
ELSE IF (INTERP_BL (CNTR, VARNP(N), FM, PSI)) THEN |
| 213 |
IDIR = -1 |
| 214 |
I = N |
| 215 |
ISTATE = KMIDDL |
| 216 |
END IF |
| 217 |
|
| 218 |
ELSE IF (ISTATE .EQ. KMIDDL) THEN |
| 219 |
|
| 220 |
C --Crossing through the middle, continue following line |
| 221 |
C --to the side or through the middle |
| 222 |
|
| 223 |
NPTS = NPTS + 1 |
| 224 |
XPTS(NPTS) = XN(I) * (1.-PSI) + XM * PSI |
| 225 |
YPTS(NPTS) = YN(I) * (1.-PSI) + YM * PSI |
| 226 |
ISDONE(IS) = .TRUE. |
| 227 |
IS = ICNVS(IS+IDIR) |
| 228 |
ISDONE(IS) = .TRUE. |
| 229 |
N = LINKF1(IS) |
| 230 |
N1 = LINKF1(ICNVS(IS+1)) |
| 231 |
|
| 232 |
ISTATE = KERR1 |
| 233 |
IF (IDIR .EQ. +1) THEN |
| 234 |
I = N1 |
| 235 |
ELSE |
| 236 |
I = N |
| 237 |
END IF |
| 238 |
IF (INTERP_BL (CNTR, VARNP(N), VARNP(N1), PSI)) THEN |
| 239 |
ISTATE = KOSIDE |
| 240 |
C --If the corner is exactly on the contour range, check |
| 241 |
C --if the line is moving away from the corner; if so, go |
| 242 |
C --through the middle to prevent cycling on this corner |
| 243 |
IF (INTERP_BL (CNTR, VARNP(I), FM, PSIX)) THEN |
| 244 |
IF (((IDIR .EQ. +1) .AND. (VARNP(N) .EQ. CNTR)) |
| 245 |
& .OR. |
| 246 |
& ((IDIR .EQ. -1) .AND. (VARNP(N1) .EQ. CNTR))) |
| 247 |
& THEN |
| 248 |
PSI = PSIX |
| 249 |
ISTATE = KMIDDL |
| 250 |
END IF |
| 251 |
END IF |
| 252 |
ELSE IF (INTERP_BL (CNTR, VARNP(I), FM, PSI)) THEN |
| 253 |
ISTATE = KMIDDL |
| 254 |
END IF |
| 255 |
|
| 256 |
ELSE IF (ISTATE .EQ. KOSIDE) THEN |
| 257 |
|
| 258 |
C --Contour line is intersecting the side, ending the line; |
| 259 |
C --search for enclosing corners/lines |
| 260 |
|
| 261 |
NPTS = NPTS + 1 |
| 262 |
XPTS(NPTS) = XN(N) * (1.-PSI) + XN(N1) * PSI |
| 263 |
YPTS(NPTS) = YN(N) * (1.-PSI) + YN(N1) * PSI |
| 264 |
ISDONE(IS) = .TRUE. |
| 265 |
IF (VARNP(N) .EQ. CNTR) ISDONE(ICNVS(IS-1)) = .TRUE. |
| 266 |
IF (VARNP(N1) .EQ. CNTR) ISDONE(ICNVS(IS+1)) = .TRUE. |
| 267 |
|
| 268 |
ISTATE = KFINDS |
| 269 |
IF (IS .EQ. ISTART) ISTATE = KDONE |
| 270 |
IF (VARNP(N) .EQ. CNTR) THEN |
| 271 |
IF ((IDIR .EQ. -1) .OR. |
| 272 |
& ((ICNTR .EQ. 0) .AND. (IDIR .EQ. +1))) THEN |
| 273 |
C --If the line exits at the corner, and enclosing area, |
| 274 |
C --adjust side to be adjacent side |
| 275 |
IS = ICNVS(IS-1) |
| 276 |
ISDONE(IS) = .TRUE. |
| 277 |
N = LINKF1(IS) |
| 278 |
N1 = LINKF1(ICNVS(IS+1)) |
| 279 |
IF (IS .EQ. ISTART) ISTATE = KDONE |
| 280 |
END IF |
| 281 |
END IF |
| 282 |
END IF |
| 283 |
|
| 284 |
IF (ISTATE .EQ. KFINDS) THEN |
| 285 |
|
| 286 |
C --Search for corner or first side crossing; the side can be |
| 287 |
C --a CNTR0 crossing if the last crossing was a corner or a |
| 288 |
C --CNTR1 crossing; it can be a CNTR1 crossing if the last |
| 289 |
C --crossing was a corner or a CNTR0 crossing |
| 290 |
|
| 291 |
ISTATE = KERR2 |
| 292 |
IF (INTERC (VARNP(N), CNTR0, CNTR1) .OR. |
| 293 |
& INTEQC (VARNP(N), VARNP(N1), CNTR0, CNTR1)) THEN |
| 294 |
ICNTR = MIN (-1, ICNTR-1) |
| 295 |
ISTATE = KCORNR |
| 296 |
ELSE IF ((ICNTR .EQ. -2) .AND. |
| 297 |
& INTERP_BL (CNTR0, VARNP(N), VARNP(N1), PSI)) THEN |
| 298 |
ICNTR = 0 |
| 299 |
CNTR = CNTR0 |
| 300 |
ISTATE = KISIDE |
| 301 |
ELSE IF ((ICNTR .NE. 1) .AND. |
| 302 |
& INTERP_BL (CNTR1, VARNP(N), VARNP(N1), PSI)) THEN |
| 303 |
ICNTR = 1 |
| 304 |
CNTR = CNTR1 |
| 305 |
ISTATE = KISIDE |
| 306 |
ELSE IF ((ICNTR .NE. 0) .AND. |
| 307 |
& INTERP_BL (CNTR0, VARNP(N), VARNP(N1), PSI)) THEN |
| 308 |
ICNTR = 0 |
| 309 |
CNTR = CNTR0 |
| 310 |
ISTATE = KISIDE |
| 311 |
END IF |
| 312 |
END IF |
| 313 |
|
| 314 |
GOTO 140 |
| 315 |
END IF |
| 316 |
|
| 317 |
IF (ISTATE .NE. KDONE) THEN |
| 318 |
C --State will be <0 if error occurred, >0 if too many points |
| 319 |
CALL PLTFLU |
| 320 |
WRITE (*, 10000) ISTATE, IS, ICNTR, IDIR, |
| 321 |
& (VARNP(LINKF1(I)), I=1,NLNKF), CNTR0, CNTR1 |
| 322 |
10000 FORMAT (' PAINT ERROR - please contact', |
| 323 |
& ' [email protected] with this information:', |
| 324 |
& /, 3X, 3I3, SP, I3, |
| 325 |
& 2X, SP, 4 (1X, E9.2), 2X, 2 (1X, E9.2), /) |
| 326 |
END IF |
| 327 |
|
| 328 |
C --Paint enclosed area |
| 329 |
|
| 330 |
IF (NPTS .GT. 2) THEN |
| 331 |
CALL MPD2PG (NPTS, XPTS, YPTS, 'S') |
| 332 |
NPTS = 0 |
| 333 |
END IF |
| 334 |
150 CONTINUE |
| 335 |
|
| 336 |
RETURN |
| 337 |
END |