| 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 |