| 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 ARCPAR (MP, KT, KNUM, COOR, LINKP, IPNTR1, IPNTR2, |
| 8 |
& IPNTR3, IP3, XCEN, YCEN, THETA1, THETA2, TANG, R1, R2, ERR, |
| 9 |
& ICCW, ICW, XK, XA) |
| 10 |
C*********************************************************************** |
| 11 |
|
| 12 |
C SUBROUTINE ARCPAR = THIS ROUTINE CALCULATES THE ARC PARAMETERS |
| 13 |
|
| 14 |
C*********************************************************************** |
| 15 |
|
| 16 |
C VARIABLES USED: |
| 17 |
C TANG = TOTAL ANGLE SCRIBED BY THE ARC |
| 18 |
C THETA1 = FIRST CCW ANGLE OF THE ARC |
| 19 |
C THETA2 = SECOND CCW ANGLE OF THE ARC |
| 20 |
C IPNTR1 = POINTER TO FIRST COORDINATE VALUE |
| 21 |
C IPNTR2 = POINTER TO SECOND COORDINATE VALUE |
| 22 |
C IPNTR3 = POINTER TO THIRD COORDINATE VALUE |
| 23 |
C IP3 = THE THIRD POINT NUMBER (CAN BE NEGATED) |
| 24 |
|
| 25 |
C*********************************************************************** |
| 26 |
|
| 27 |
DIMENSION COOR (2, MP), LINKP (2, MP) |
| 28 |
|
| 29 |
LOGICAL ERR |
| 30 |
|
| 31 |
PI = ATAN2(0.0, -1.0) |
| 32 |
TWOPI = PI + PI |
| 33 |
ERR = .FALSE. |
| 34 |
|
| 35 |
C ARC WITH CENTER GIVEN |
| 36 |
C ARC GOES FROM 1ST POINT TO 2ND IN *COUNTER-CLOCKWISE* DIRECTION. |
| 37 |
|
| 38 |
IF (KT .EQ. 3) THEN |
| 39 |
XCEN = COOR (1, IPNTR3) |
| 40 |
YCEN = COOR (2, IPNTR3) |
| 41 |
|
| 42 |
C CIRCLE WITH THIRD POINT ON ARC |
| 43 |
|
| 44 |
ELSEIF (KT .EQ. 4) THEN |
| 45 |
THETA1 = ATAN2 (COOR (2, IPNTR3) - COOR (2, IPNTR1), |
| 46 |
& COOR (1, IPNTR3) - COOR (1, IPNTR1)) + PI / 2.0 |
| 47 |
THETA2 = ATAN2 (COOR (2, IPNTR3) - COOR (2, IPNTR2), |
| 48 |
& COOR (1, IPNTR3) - COOR (1, IPNTR2)) + PI / 2.0 |
| 49 |
DET = - COS (THETA1) * SIN (THETA2) + |
| 50 |
& COS (THETA2) * SIN (THETA1) |
| 51 |
X11 = 0.5 * (COOR (1, IPNTR1) + COOR (1, IPNTR3)) |
| 52 |
Y11 = 0.5 * (COOR (2, IPNTR1) + COOR (2, IPNTR3)) |
| 53 |
X21 = 0.5 * (COOR (1, IPNTR2) + COOR (1, IPNTR3)) |
| 54 |
Y21 = 0.5 * (COOR (2, IPNTR2) + COOR (2, IPNTR3)) |
| 55 |
R = ( - SIN (THETA2) * (X21 - X11) + |
| 56 |
& COS (THETA2) * (Y21 - Y11)) / DET |
| 57 |
XCEN = X11 + R * COS (THETA1) |
| 58 |
YCEN = Y11 + R * SIN (THETA1) |
| 59 |
|
| 60 |
C CIRCLE WITH RADIUS GIVEN |
| 61 |
|
| 62 |
ELSEIF (KT .EQ. 6) THEN |
| 63 |
DX = 0.5 * (COOR (1, IPNTR2) - COOR (1, IPNTR1)) |
| 64 |
DY = 0.5 * (COOR (2, IPNTR2) - COOR (2, IPNTR1)) |
| 65 |
CHORD = SQRT (DX * DX + DY * DY) |
| 66 |
R = ABS (COOR (1, IPNTR3)) |
| 67 |
IF (R .LE. CHORD) THEN |
| 68 |
XCEN = 0.5 * (COOR (1, IPNTR1) + COOR (1, IPNTR2)) |
| 69 |
YCEN = 0.5 * (COOR (2, IPNTR1) + COOR (2, IPNTR2)) |
| 70 |
ELSE |
| 71 |
ARM = SQRT (R * R - CHORD * CHORD) |
| 72 |
IF (IP3.LT.0) THEN |
| 73 |
XCEN = COOR (1, IPNTR1) + DX + ARM * DY / CHORD |
| 74 |
YCEN = COOR (2, IPNTR1) + DY - ARM * DX / CHORD |
| 75 |
ELSE |
| 76 |
XCEN = COOR (1, IPNTR1) + DX - ARM * DY / CHORD |
| 77 |
YCEN = COOR (2, IPNTR1) + DY + ARM * DX / CHORD |
| 78 |
ENDIF |
| 79 |
ENDIF |
| 80 |
ENDIF |
| 81 |
|
| 82 |
C CHECK TO MAKE SURE THAT THE BEGINNING AND ENDING RADIUS EXIST |
| 83 |
|
| 84 |
IF ((( COOR (1, IPNTR1) .EQ. XCEN) .AND. |
| 85 |
& (COOR (2, IPNTR1) .EQ. YCEN)) .OR. |
| 86 |
& ((COOR (1, IPNTR2) .EQ. XCEN) .AND. |
| 87 |
& (COOR (2, IPNTR2) .EQ. YCEN))) THEN |
| 88 |
CALL PLTFLU |
| 89 |
WRITE (*, 10000) ABS (KNUM) |
| 90 |
ERR = .TRUE. |
| 91 |
GOTO 100 |
| 92 |
ENDIF |
| 93 |
R1 = SQRT ( (COOR (1, IPNTR1) - XCEN) **2 + (COOR (2, IPNTR1) - |
| 94 |
& YCEN) **2) |
| 95 |
R2 = SQRT ( (COOR (1, IPNTR2) - XCEN) **2 + (COOR (2, IPNTR2) - |
| 96 |
& YCEN) **2) |
| 97 |
THETA1 = ATAN2 (COOR (2, IPNTR1) - YCEN, COOR (1, IPNTR1) - XCEN) |
| 98 |
THETA2 = ATAN2 (COOR (2, IPNTR2) - YCEN, COOR (1, IPNTR2) - XCEN) |
| 99 |
|
| 100 |
C ARC WITH THE CENTER GIVEN |
| 101 |
|
| 102 |
IF (KT .EQ. 3) THEN |
| 103 |
IF (IPNTR1 .EQ. IPNTR2) THEN |
| 104 |
THETA2 = THETA1 + TWOPI |
| 105 |
ELSEIF ((IP3 .GE. 0) .AND. (THETA2 .LE. THETA1)) THEN |
| 106 |
THETA2 = THETA2 + TWOPI |
| 107 |
ELSEIF ((IP3 .LT. 0) .AND. (THETA1 .LE. THETA2)) THEN |
| 108 |
THETA1 = THETA1 + TWOPI |
| 109 |
ENDIF |
| 110 |
TANG = THETA2 - THETA1 |
| 111 |
IF (IP3 .LT. 0) THEN |
| 112 |
ICCW = IPNTR2 |
| 113 |
ICW = IPNTR1 |
| 114 |
ELSE |
| 115 |
ICCW = IPNTR1 |
| 116 |
ICW = IPNTR2 |
| 117 |
ENDIF |
| 118 |
|
| 119 |
C CIRCULAR ARC WITH 3RD POINT ON ARC - CLOCKWISE OR COUNTER-CLOCKWISE |
| 120 |
|
| 121 |
ELSEIF (KT .EQ. 4) THEN |
| 122 |
THETA3 = ATAN2 (COOR (2, IPNTR3) - YCEN, COOR (1, IPNTR3) - |
| 123 |
& XCEN) |
| 124 |
IF (THETA2 .LE. THETA1) THETA2 = THETA2 + TWOPI |
| 125 |
IF (THETA3 .LE. THETA1) THETA3 = THETA3 + TWOPI |
| 126 |
TANG = THETA2 - THETA1 |
| 127 |
IF (THETA3 .GT. THETA2) THEN |
| 128 |
TANG = - (TWOPI - TANG) |
| 129 |
ICCW = IPNTR2 |
| 130 |
ICW = IPNTR1 |
| 131 |
ELSE |
| 132 |
ICCW = IPNTR1 |
| 133 |
ICW = IPNTR2 |
| 134 |
ENDIF |
| 135 |
|
| 136 |
C CIRRCULAR ARC WITH RADIUS GIVEN - CLOCKWISE OR COUNTER-CLOCKWISE |
| 137 |
|
| 138 |
ELSEIF (KT .EQ. 6) THEN |
| 139 |
IF ( (IP3 .GE. 0) .AND. (THETA2 .LE. THETA1)) |
| 140 |
& THETA2 = THETA2 + TWOPI |
| 141 |
IF ( (IP3 .LT. 0) .AND. (THETA1 .LE. THETA2)) |
| 142 |
& THETA1 = THETA1 + TWOPI |
| 143 |
TANG = THETA2 - THETA1 |
| 144 |
IF (IP3 .GE. 0) THEN |
| 145 |
ICCW = IPNTR1 |
| 146 |
ICW = IPNTR2 |
| 147 |
ELSE |
| 148 |
ICCW = IPNTR2 |
| 149 |
ICW = IPNTR1 |
| 150 |
ENDIF |
| 151 |
ENDIF |
| 152 |
|
| 153 |
C DEFINE THE SPIRAL PARAMETERS (R = XA * EXP (XK * THETA)) |
| 154 |
|
| 155 |
XK = (LOG (R2 / R1)) / (THETA2 - THETA1) |
| 156 |
DIVID = EXP (XK * THETA2) |
| 157 |
IF (DIVID .GT. 0.) THEN |
| 158 |
XA = R2 / DIVID |
| 159 |
ELSE |
| 160 |
WRITE (*, 10010) IABS (KNUM) |
| 161 |
ERR = .TRUE. |
| 162 |
GOTO 100 |
| 163 |
ENDIF |
| 164 |
|
| 165 |
100 CONTINUE |
| 166 |
|
| 167 |
RETURN |
| 168 |
|
| 169 |
10000 FORMAT (' CENTER POINT FOR LINE', I5, ' LIES ON ONE OF', |
| 170 |
& ' THE ENDPOINTS') |
| 171 |
10010 FORMAT (' DEFINITION FOR ARC LINE', I5, ' IS INVLAID') |
| 172 |
|
| 173 |
END |