Debian Codegraph @

packages/seacas/applications/fastq/invmap.f

raw
1 C Copyright(C) 1999-2021 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 INVMAP (X0, Y0, X1, Y1, X2, Y2, X3, Y3, X4, Y4, SXI,
8 & SETA, INSIDE)
9 C***********************************************************************
10
11 C THIS IS A TEST OF THE INVERTED MAPPING OF AN ELEMENT
12
13 C***********************************************************************
14
15 REAL AX, BX, CX, DX, AY, BY, CY, DY
16 REAL ALPHA, BETA, GAMMA, RAD
17 REAL XI, ETA, XI1, ETA1, XI2, ETA2
18
19 LOGICAL INSIDE
20
21 EPS = 1.E-3
22 EPS2 = 1.E-10
23
24 C GET THE A, B, C, AND D VALUES FOR X AND Y.
25
26 AX = X1 - X0
27 BX = X2 - X1
28 CX = X1 - X2 + X3 -X4
29 DX = X4 - X1
30 AY = Y1 - Y0
31 BY = Y2 - Y1
32 CY = Y1 - Y2 + Y3 -Y4
33 DY = Y4 - Y1
34
35 C CALCULATE THE ALPHA, BETA, AND GAMMA VALUES.
36
37 ALPHA = (CY * DX) - (CX * DY)
38 BETA = (AX * CY) - (AY * CX) + (BY * DX) - (BX * DY)
39 GAMMA = (AX * BY) - (AY * BX)
40
41 C CALCULATE THE XI AND ETA VALUES.
42
43 IF (ALPHA .EQ. 0.) THEN
44 ETA = -GAMMA / BETA
45 IF ((ETA .EQ. 0) .AND. (BX .EQ. 0)) THEN
46 XI = (Y0 - Y1) / (Y2 - Y1)
47 ELSE IF ((BX .EQ. -CX) .AND. (ETA .EQ. 1.)) THEN
48 XI = (Y0 - Y3)/(Y4 - Y3)
49 ELSE IF (BX .EQ. (-CX * ETA)) THEN
50 XI = -1000.
51 ELSE
52 XI = (- AX - (DX * ETA)) / (BX + (CX * ETA))
53 ENDIF
54 ELSE
55 RAD = BETA**2 - (4. * ALPHA * GAMMA)
56 IF (RAD .LT. 0.) THEN
57
58 C** NEGATIVE RADICAL PROBLEM AS IT APPEARS THAT
59 C** THIS MAY OCCUR - IT JUST MEANS THAT THE POINT
60 C** TRULY IS NOT IN THE ELEMENT.
61
62 C CALL MESSAGE('** ERROR - NEGATIVE RADICAL IN INVMAP **')
63 INSIDE = .FALSE.
64 GOTO 100
65 ENDIF
66 RAD = SQRT (RAD)
67 ETA1 = (- BETA + RAD) / (2. * ALPHA)
68 ETA2 = (- BETA - RAD) / (2. * ALPHA)
69
70 IF ((ABS(ETA1) .LT. EPS2) .AND. (ABS(BX) .LT. EPS2)) THEN
71 XI1 = (Y0 - Y1) / (Y2 - Y1)
72 ELSE IF ((BX .EQ. -CX) .AND. (ETA1 .EQ. 1.)) THEN
73 XI1 = (Y0 - Y3)/(Y4 - Y3)
74 ELSE IF (BX .EQ. (-CX * ETA1)) THEN
75 XI1 = -1000.
76 ELSE
77 XI1 = (- AX - (DX * ETA1)) / (BX + (CX * ETA1))
78 ENDIF
79
80 IF ((ABS(ETA2) .LT. EPS2) .AND. (ABS(BX) .LT. EPS2)) THEN
81 XI2 = (Y0 - Y1) / (Y2 - Y1)
82 ELSE IF ((BX .EQ. -CX) .AND. (ETA2 .EQ. 1.)) THEN
83 XI2 = (Y0 - Y3)/(Y4 - Y3)
84 ELSE IF (BX .EQ. (-CX * ETA2)) THEN
85 XI2 = -1000.
86 ELSE
87 XI2 = (- AX - (DX * ETA2)) / (BX + (CX * ETA2))
88 ENDIF
89
90 D1 = SQRT (ETA1*ETA1 + XI1*XI1)
91 D2 = SQRT (ETA2*ETA2 + XI2*XI2)
92 IF (D1 .LT. D2) THEN
93 ETA = ETA1
94 XI = XI1
95 ELSE
96 ETA = ETA2
97 XI = XI2
98 ENDIF
99 END IF
100
101 C CHECK TO SEE IF ETA AND XI ARE WITHIN THE ELEMENT
102
103 IF (.NOT. ((ETA .LE. 1.0 + EPS) .AND.
104 & (ETA .GE. 0.0 - EPS)) ) THEN
105 INSIDE = .FALSE.
106 GOTO 100
107 ELSE IF (.NOT. ((XI .LE. 1.0 + EPS) .AND.
108 & (XI .GE. 0.0 - EPS)) ) THEN
109 INSIDE = .FALSE.
110 GOTO 100
111 ELSE
112 INSIDE = .TRUE.
113 ENDIF
114 SXI = XI
115 SETA = ETA
116
117 100 CONTINUE
118 RETURN
119
120 END