| 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 ELPSPR (MP, KT, KNUM, COOR, LINKP, IPNTR1, IPNTR2, |
| 8 |
& IPNTR3, IP3, XCEN, YCEN, THETA1, THETA2, TANG, ICCW, ICW, |
| 9 |
& AVALUE, BVALUE, ERR) |
| 10 |
C*********************************************************************** |
| 11 |
|
| 12 |
C SUBROUTINE ELPSPR = THIS ROUTINE CALCULATES THE ELIPSE 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 |
|
| 33 |
TWOPI = PI + PI |
| 34 |
ERR = .FALSE. |
| 35 |
|
| 36 |
C ELIPSE GOES FROM 1ST POINT TO 2ND IN *COUNTER-CLOCKWISE* DIRECTION. |
| 37 |
|
| 38 |
XCEN = COOR (1, IPNTR3) |
| 39 |
YCEN = COOR (2, IPNTR3) |
| 40 |
|
| 41 |
C CHECK TO MAKE SURE THAT THE BEGINNING AND ENDING RADIUS EXIST |
| 42 |
|
| 43 |
IF (( (COOR (1, IPNTR1) .EQ. XCEN).AND. |
| 44 |
& (COOR (2,IPNTR1) .EQ. YCEN)).OR. |
| 45 |
& ((COOR (1, IPNTR2) .EQ. XCEN).AND. |
| 46 |
& (COOR (2, IPNTR2) .EQ. YCEN)))THEN |
| 47 |
CALL PLTFLU |
| 48 |
WRITE (*, 10000)ABS (KNUM) |
| 49 |
ERR = .TRUE. |
| 50 |
GOTO 100 |
| 51 |
ENDIF |
| 52 |
THETA1 = ATAN2 (COOR (2, IPNTR1) - YCEN, COOR (1, IPNTR1) - XCEN) |
| 53 |
THETA2 = ATAN2 (COOR (2, IPNTR2) - YCEN, COOR (1, IPNTR2) - XCEN) |
| 54 |
|
| 55 |
C NOW CALCULATE THE MAJOR AXIS (AVALUE) AND THE MINOR AXIS (BVALUE) |
| 56 |
|
| 57 |
X1 = COOR (1, IPNTR1) - XCEN |
| 58 |
Y1 = COOR (2, IPNTR1) - YCEN |
| 59 |
X2 = COOR (1, IPNTR2) - XCEN |
| 60 |
Y2 = COOR (2, IPNTR2) - YCEN |
| 61 |
|
| 62 |
C CHOOSE THE APPROPRIATE ELIPSE DEFINITION |
| 63 |
|
| 64 |
IF (Y1 * Y1 .EQ. Y2 * Y2) THEN |
| 65 |
AVALUE = SQRT (X1 * X1 + Y1 * Y1) |
| 66 |
BVALUE = AVALUE |
| 67 |
ELSEIF ((Y1 .EQ. 0.) .AND. (X2 .EQ. 0.)) THEN |
| 68 |
AVALUE = X1 |
| 69 |
BVALUE = Y2 |
| 70 |
ELSEIF ((Y2 .EQ. 0.) .AND. (X1 .EQ. 0.)) THEN |
| 71 |
AVALUE = X2 |
| 72 |
BVALUE = Y1 |
| 73 |
ELSE |
| 74 |
RATIO = SQRT (ABS ( (X1 * X1 - X2 * X2) / |
| 75 |
& (Y1 * Y1 - Y2 * Y2) )) |
| 76 |
IF (RATIO .EQ. 0.) THEN |
| 77 |
AVALUE = SQRT (X1 * X1 + Y1 * Y1) |
| 78 |
BVALUE = AVALUE |
| 79 |
ELSEIF (RATIO .EQ. 1.0) THEN |
| 80 |
AVALUE = SQRT (X1 * X1 + Y1 * Y1) |
| 81 |
BVALUE = AVALUE |
| 82 |
ELSE |
| 83 |
IF ((Y2 .EQ. 0.) .OR. ((X2 .EQ. 0.) .AND. (Y1 .NE. 0.)) ) |
| 84 |
& THEN |
| 85 |
IF (RATIO .GT. 1.) THEN |
| 86 |
VX = 1. |
| 87 |
VY = - (1./RATIO**2) * (X1 / Y1) |
| 88 |
ELSE |
| 89 |
VX = 1. |
| 90 |
VY = - (RATIO**2) * (X1 / Y1) |
| 91 |
ENDIF |
| 92 |
D0 = SQRT (X1 * X1 + Y1 * Y1) |
| 93 |
A8 = ACOS ( ((X1 * VX) + (Y1 * VY)) / |
| 94 |
& (D0 * SQRT (VX * VX + VY * VY)) ) |
| 95 |
A7 = PI - A8 |
| 96 |
A2 = ABS (ATAN2 (Y1, X1)) |
| 97 |
THETA1 = ABS(ATAN2 (VY, 1.)) |
| 98 |
ELSE |
| 99 |
IF (RATIO .GT. 1.) THEN |
| 100 |
VX = 1. |
| 101 |
VY = - (1./RATIO**2) * (X2 / Y2) |
| 102 |
ELSE |
| 103 |
VX = 1. |
| 104 |
VY = - (RATIO**2) * (X2 / Y2) |
| 105 |
ENDIF |
| 106 |
D0 = SQRT (X2 * X2 + Y2 * Y2) |
| 107 |
A8 = ACOS ( ((X2 * VX) + (Y2 * VY)) / |
| 108 |
& (D0 * SQRT (VX * VX + VY * VY)) ) |
| 109 |
A7 = PI - A8 |
| 110 |
A2 = ABS (ATAN2 (Y2, X2)) |
| 111 |
THETA1 = ABS(ATAN2 (VY, 1.)) |
| 112 |
ENDIF |
| 113 |
|
| 114 |
RADMAX = MAX(A7,A8) |
| 115 |
CALL ETHETA (A7, A8, A2, THETA1, RADMAX, THETA, ERR) |
| 116 |
IF (ERR) THEN |
| 117 |
WRITE (*, 10010) ABS (KNUM) |
| 118 |
GOTO 100 |
| 119 |
ENDIF |
| 120 |
|
| 121 |
CVALUE = D0 * SIN (A8 - THETA) / SIN (A2 - A8 + THETA) |
| 122 |
BVALUE = SQRT (ABS (CVALUE **2 / (RATIO **2 - 1)) ) |
| 123 |
AVALUE = BVALUE * RATIO |
| 124 |
ENDIF |
| 125 |
ENDIF |
| 126 |
|
| 127 |
C NOW GET THE ANGLES GOING THE RIGHT WAY |
| 128 |
|
| 129 |
THETA1 = ATAN2 (COOR (2, IPNTR1) - YCEN, COOR (1, IPNTR1) - XCEN) |
| 130 |
THETA2 = ATAN2 (COOR (2, IPNTR2) - YCEN, COOR (1, IPNTR2) - XCEN) |
| 131 |
IF (IPNTR1 .EQ. IPNTR2) THEN |
| 132 |
THETA2 = THETA1 + TWOPI |
| 133 |
ELSEIF ( (IP3 .GE. 0) .AND. (THETA2 .LE. THETA1) ) THEN |
| 134 |
THETA2 = THETA2+TWOPI |
| 135 |
ELSEIF ( (IP3 .LT. 0) .AND. (THETA1 .LE. THETA2) ) THEN |
| 136 |
THETA1 = THETA1+TWOPI |
| 137 |
ENDIF |
| 138 |
TANG = THETA2 - THETA1 |
| 139 |
IF (IP3 .LT. 0) THEN |
| 140 |
ICCW = IPNTR2 |
| 141 |
ICW = IPNTR1 |
| 142 |
ELSE |
| 143 |
ICCW = IPNTR1 |
| 144 |
ICW = IPNTR2 |
| 145 |
ENDIF |
| 146 |
|
| 147 |
100 CONTINUE |
| 148 |
|
| 149 |
RETURN |
| 150 |
|
| 151 |
10000 FORMAT (' CENTER POINT FOR LINE', I5, ' LIES ON ONE OF', |
| 152 |
& ' THE ENDPOINTS') |
| 153 |
10010 FORMAT (' POINTS GIVEN FOR LINE', I5, ' DO NOT DEFINE AN ELIPSE') |
| 154 |
|
| 155 |
END |