| 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 EQLANG (MXND, XN, YN, LXN, NODE, N0, N2, NFROM, DIST, |
| 8 |
& VRO, XDEL, YDEL) |
| 9 |
C*********************************************************************** |
| 10 |
|
| 11 |
C SUBROUTINE EQLANG = CALCULATES A VECTOR SUM THAT ATTEMPTS TO |
| 12 |
C MAINTAIN EQUAL ANGLES FOR A NODE |
| 13 |
|
| 14 |
C*********************************************************************** |
| 15 |
|
| 16 |
DIMENSION XN(MXND), YN(MXND), LXN(4, MXND) |
| 17 |
|
| 18 |
LOGICAL EXPAND |
| 19 |
|
| 20 |
PI = ATAN2(0.0, -1.0) |
| 21 |
TWOPI = 2.0 * PI |
| 22 |
|
| 23 |
IF (NFROM .GT. 0) THEN |
| 24 |
|
| 25 |
C TEST FOR THE EXPANSION CASE |
| 26 |
|
| 27 |
IF ( ( ((LXN (4, NFROM) .NE. 0) .AND. |
| 28 |
& (LXN (2, NFROM) .LT. 0)) .OR. |
| 29 |
& ((LXN (4, NFROM) .LT. 0) .AND. |
| 30 |
& (LXN (2, NFROM) .GT. 0)) ) |
| 31 |
& .AND. |
| 32 |
& ((LXN (3, N0) .EQ. 0) .OR. (LXN (3, N2) .EQ. 0)) ) THEN |
| 33 |
EXPAND = .TRUE. |
| 34 |
ELSE |
| 35 |
EXPAND = .FALSE. |
| 36 |
ENDIF |
| 37 |
|
| 38 |
ANG1 = ATAN2 ( YN (N2) - YN (NFROM), XN (N2) - XN (NFROM)) |
| 39 |
IF (ANG1 .LT. 0.) ANG1 = ANG1 + TWOPI |
| 40 |
ANG2 = ATAN2 ( YN (N0) - YN (NFROM), XN (N0) - XN (NFROM)) |
| 41 |
IF (ANG2 .LT. 0.) ANG2 = ANG2 + TWOPI |
| 42 |
ANG3 = ATAN2 ( YN (NODE) - YN (NFROM), XN (NODE) - XN (NFROM)) |
| 43 |
IF (ANG3 .LT. 0.) ANG3 = ANG3 + TWOPI |
| 44 |
|
| 45 |
C GET THE APPROPRIATE ANGLE BETWEEN ANGLE 1 AND 2 |
| 46 |
|
| 47 |
ANG12D = ANG2 - ANG1 |
| 48 |
IF (ANG12D .LT. 0.) ANG12D = ANG12D + TWOPI |
| 49 |
|
| 50 |
C IF THIS IS AN EXPANSION, THEN ADJUST THE ANGLE ACCORDINGLY |
| 51 |
|
| 52 |
IF (EXPAND) THEN |
| 53 |
IF (LXN (3, N2) .EQ. 0) THEN |
| 54 |
ANG12 = ANG1 + (ANG12D * .6) |
| 55 |
ELSEIF (LXN (3, N0) .EQ. 0) THEN |
| 56 |
ANG12 = ANG1 + (ANG12D * .4) |
| 57 |
ELSE |
| 58 |
ANG12 = ANG1 + (ANG12D * .5) |
| 59 |
ENDIF |
| 60 |
ELSE |
| 61 |
ANG12 = ANG1 + (ANG12D * .5) |
| 62 |
ENDIF |
| 63 |
IF (ANG12 .GT. TWOPI) ANG12 = ANG12 - TWOPI |
| 64 |
|
| 65 |
C GET THE AVERAGE ANGLE BETWEEN ANGLE 12 AND 3 |
| 66 |
|
| 67 |
IF (ANG12 .GT. ANG3) THEN |
| 68 |
ANG3D = ANG12 - ANG3 |
| 69 |
IF (ANG3D .GT. PI) THEN |
| 70 |
ANG = ANG12 + ((TWOPI - ANG3D) * .5) |
| 71 |
ELSE |
| 72 |
ANG = ANG12 - (ANG3D * .5) |
| 73 |
ENDIF |
| 74 |
ELSE |
| 75 |
ANG3D = ANG3 - ANG12 |
| 76 |
IF (ANG3D .GT. PI) THEN |
| 77 |
ANG = ANG3 + ((TWOPI - ANG3D) * .5) |
| 78 |
ELSE |
| 79 |
ANG = ANG3 - (ANG3D * .5) |
| 80 |
ENDIF |
| 81 |
ENDIF |
| 82 |
|
| 83 |
C GET THE DISTANCE TO MAKE THE OUTSIDE FLAT AT THIS ANGLE |
| 84 |
|
| 85 |
D1 = SQRT ( ((XN (NFROM) - XN (N0)) ** 2) + |
| 86 |
& ((YN (NFROM) - YN (N0)) ** 2) ) |
| 87 |
D2 = SQRT ( ((XN (N2) - XN (N0)) ** 2) + |
| 88 |
& ((YN (N2) - YN (N0)) ** 2) ) |
| 89 |
D3 = SQRT ( ((XN (NFROM) - XN (N2)) ** 2) + |
| 90 |
& ((YN (NFROM) - YN (N2)) ** 2) ) |
| 91 |
ARG = (SIN (ANG12D) * D1) / D2 |
| 92 |
IF (ARG .GT. 1.0) ARG = 1.0 |
| 93 |
IF (ARG .LT. -1.0) ARG = -1.0 |
| 94 |
BETA = ASIN (ARG) |
| 95 |
D0 = (D3 * SIN (BETA)) / SIN (PI - BETA - (ANG12D * .5)) |
| 96 |
|
| 97 |
IF (D0 .GT. DIST) THEN |
| 98 |
IF (EXPAND) THEN |
| 99 |
DIST0 = D0 |
| 100 |
ELSE |
| 101 |
DIST0 = (DIST + D0) * .5 |
| 102 |
ENDIF |
| 103 |
ELSE |
| 104 |
DIST0 = DIST |
| 105 |
ENDIF |
| 106 |
|
| 107 |
C CALCULATE THE NEW COORDINATES |
| 108 |
|
| 109 |
X0 = XN (NFROM) + (COS (ANG) * DIST0) |
| 110 |
Y0 = YN (NFROM) + (SIN (ANG) * DIST0) |
| 111 |
XDEL = (X0 - XN (NODE)) * VRO |
| 112 |
YDEL = (Y0 - YN (NODE)) * VRO |
| 113 |
|
| 114 |
ELSE |
| 115 |
XDEL = 0. |
| 116 |
YDEL = 0. |
| 117 |
ENDIF |
| 118 |
|
| 119 |
RETURN |
| 120 |
|
| 121 |
END |