| 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 LINLEN (MP, COOR, LINKP, KNUM, LNUM, KT, I3, J1, J2, |
| 8 |
& J3, DIST, ERR) |
| 9 |
C*********************************************************************** |
| 10 |
|
| 11 |
C SUBROUTINE LINLEN = CALCULATES THE LENGTH OF A GIVEN LINE |
| 12 |
|
| 13 |
C*********************************************************************** |
| 14 |
|
| 15 |
C VARIABLES USED: |
| 16 |
C NID = AN ARRAY OF UNIQUE NODE IDENTIFIERS. |
| 17 |
C REAL = .TRUE. FOR AN ACTUAL GENERATION |
| 18 |
C = .FALSE. FOR A TRIAL GENERATION |
| 19 |
C ERR = .TRUE. IF AN ERROR WAS ENCOUNTERED |
| 20 |
C J1 = POINTER FOR THE FIRST POINT |
| 21 |
C J2 = POINTER FOR THE SECOND POINT |
| 22 |
C J3 = POINTER FOR THE THIRD POINT |
| 23 |
C MAXNP = MAXIMUM NUMBER OF NODES ON THE PERIMETER |
| 24 |
C NOTE: MAXNP MUST BE ADJUSTED FOR THE CURRENT |
| 25 |
C LOCATION IN X, Y, & NID |
| 26 |
C KT = THE LINE TYPE: |
| 27 |
C = 1 FOR STRAIGHT LINES |
| 28 |
C = 2 FOR CORNER LINES |
| 29 |
C = 3 FOR ARC WITH CENTER GIVEN |
| 30 |
C = 4 FOR ARC WITH THIRD POINT ON THE ARC |
| 31 |
C = 5 FOR PARABOLA |
| 32 |
C = 6 FOR ARC WITH RADIUS GIVEN |
| 33 |
|
| 34 |
C*********************************************************************** |
| 35 |
|
| 36 |
DIMENSION COOR (2, MP), LINKP (2, MP) |
| 37 |
|
| 38 |
LOGICAL ERR |
| 39 |
|
| 40 |
PI = ATAN2(0.0, -1.0) |
| 41 |
|
| 42 |
DIST = 0. |
| 43 |
ERR = .TRUE. |
| 44 |
|
| 45 |
C STRAIGHT LINE GENERATION |
| 46 |
|
| 47 |
IF (KT.EQ.1) THEN |
| 48 |
YDIFF = COOR (2, J2) -COOR (2, J1) |
| 49 |
XDIFF = COOR (1, J2) -COOR (1, J1) |
| 50 |
DIST = SQRT (YDIFF ** 2 + XDIFF ** 2) |
| 51 |
IF (DIST.EQ.0.) THEN |
| 52 |
WRITE (*, 10000) KNUM |
| 53 |
RETURN |
| 54 |
ENDIF |
| 55 |
|
| 56 |
C CORNER GENERATION |
| 57 |
|
| 58 |
ELSEIF (KT.EQ.2) THEN |
| 59 |
XDA = COOR (1, J3) -COOR (1, J1) |
| 60 |
YDA = COOR (2, J3) -COOR (2, J1) |
| 61 |
XDB = COOR (1, J2) -COOR (1, J3) |
| 62 |
YDB = COOR (2, J2) -COOR (2, J3) |
| 63 |
DA = SQRT (XDA ** 2 + YDA ** 2) |
| 64 |
DB = SQRT (XDB ** 2 + YDB ** 2) |
| 65 |
IF ((DA.EQ.0.) .OR. (DB.EQ.0.) )THEN |
| 66 |
WRITE (*, 10000) KNUM |
| 67 |
RETURN |
| 68 |
ENDIF |
| 69 |
DIST = DA+DB |
| 70 |
|
| 71 |
C CIRCULAR ARC |
| 72 |
|
| 73 |
ELSEIF ((KT.EQ.3) .OR. (KT.EQ.4) .OR. (KT.EQ.6) )THEN |
| 74 |
XSTART = COOR (1, J1) |
| 75 |
YSTART = COOR (2, J1) |
| 76 |
CALL ARCPAR (MP, KT, KNUM, COOR, LINKP, J1, J2, J3, I3, |
| 77 |
& XCEN, YCEN, THETA1, THETA2, TANG, R1, R2, ERR, ICCW, ICW, |
| 78 |
& XK, XA) |
| 79 |
|
| 80 |
C GENERATE THE CIRCLE |
| 81 |
|
| 82 |
ANG = THETA1 |
| 83 |
DEL = TANG/30 |
| 84 |
DO 100 I = 2, 29 |
| 85 |
ANG = ANG+DEL |
| 86 |
RADIUS = XA * EXP (XK * ANG) |
| 87 |
XEND = XCEN+COS (ANG) * RADIUS |
| 88 |
YEND = YCEN+SIN (ANG) * RADIUS |
| 89 |
DIST = DIST+SQRT ((XEND-XSTART) ** 2 + (YEND-YSTART) ** 2) |
| 90 |
XSTART = XEND |
| 91 |
YSTART = YEND |
| 92 |
100 CONTINUE |
| 93 |
XEND = COOR (1, J2) |
| 94 |
YEND = COOR (2, J2) |
| 95 |
DIST = DIST+SQRT ((XEND-XSTART) ** 2 + (YEND-YSTART) ** 2) |
| 96 |
|
| 97 |
C ELIPSE |
| 98 |
|
| 99 |
ELSEIF (KT .EQ. 7) THEN |
| 100 |
XSTART = COOR (1, J1) |
| 101 |
YSTART = COOR (2, J1) |
| 102 |
CALL ELPSPR (MP, KT, KNUM, COOR, LINKP, J1, J2, J3, |
| 103 |
& I3, XCEN, YCEN, THETA1, THETA2, TANG, IDUM1, IDUM2, |
| 104 |
& AVALUE, BVALUE, ERR) |
| 105 |
|
| 106 |
C GENERATE THE ELIPSE |
| 107 |
|
| 108 |
ANG = THETA1 |
| 109 |
DEL = TANG/30 |
| 110 |
DO 110 I = 2, 29 |
| 111 |
ANG = ANG+DEL |
| 112 |
RADIUS = SQRT ( (AVALUE **2 * BVALUE **2) / |
| 113 |
& ( (BVALUE **2 * COS (ANG) **2) + |
| 114 |
& (AVALUE **2 * SIN (ANG) **2) ) ) |
| 115 |
XEND = XCEN+COS (ANG) * RADIUS |
| 116 |
YEND = YCEN+SIN (ANG) * RADIUS |
| 117 |
DIST = DIST+SQRT ((XEND-XSTART) ** 2 + (YEND-YSTART) ** 2) |
| 118 |
XSTART = XEND |
| 119 |
YSTART = YEND |
| 120 |
110 CONTINUE |
| 121 |
XEND = COOR (1, J2) |
| 122 |
YEND = COOR (2, J2) |
| 123 |
DIST = DIST+SQRT ((XEND-XSTART) ** 2 + (YEND-YSTART) ** 2) |
| 124 |
|
| 125 |
C PARABOLA |
| 126 |
|
| 127 |
ELSEIF (KT.EQ.5) THEN |
| 128 |
|
| 129 |
C CHECK LEGITIMACY OF DATA |
| 130 |
|
| 131 |
XMID = (COOR (1, J1) +COOR (1, J2) ) * 0.5 |
| 132 |
YMID = (COOR (2, J1) +COOR (2, J2) ) * 0.5 |
| 133 |
DOT = (COOR (1, J2) -COOR (1, J1) ) * (COOR (1, J3) -XMID) |
| 134 |
& + (COOR (2, J2) -COOR (2, J1) ) * (COOR (2, J3) -YMID) |
| 135 |
PERP = SQRT ((COOR (1, J2) -COOR (1, J1) ) ** 2 + |
| 136 |
& (COOR (2, J2) - COOR (2, J1) ) ** 2) * |
| 137 |
& SQRT ((COOR (1, J3) -XMID) ** 2 + (COOR (2, J3) |
| 138 |
& -YMID) ** 2) |
| 139 |
IF (DOT.GE.0.05 * PERP) THEN |
| 140 |
WRITE (*, 10030) KNUM |
| 141 |
RETURN |
| 142 |
ENDIF |
| 143 |
|
| 144 |
C GETARC LENGTH |
| 145 |
|
| 146 |
HALFW = SQRT ((COOR (1, J2) -COOR (1, J1) ) ** 2 + |
| 147 |
& (COOR (2, J2) - COOR (2, J1) ) ** 2 ) * 0.5 |
| 148 |
IF (HALFW.EQ.0.) THEN |
| 149 |
WRITE (*, 10000) KNUM |
| 150 |
RETURN |
| 151 |
ENDIF |
| 152 |
HEIGHT = SQRT ((XMID-COOR (1, J3) ) ** 2 |
| 153 |
& + (YMID-COOR (2, J3) ) ** 2) |
| 154 |
COEF = HEIGHT/HALFW ** 2 |
| 155 |
TCOEF = 2.0 * COEF |
| 156 |
|
| 157 |
C PARC IS A STATEMENT FUNCTION |
| 158 |
|
| 159 |
PLEFT = PARC (-TCOEF * HALFW, TCOEF) |
| 160 |
ARCTOT = 2.0 * PARC (TCOEF * HALFW, TCOEF) |
| 161 |
ARCDEL = ARCTOT/30 |
| 162 |
ARCNXT = ARCDEL |
| 163 |
ARCNOW = 0.0 |
| 164 |
THETA = ATAN2 (COOR (2, J2) -COOR (2, J1) , COOR (1, J2) |
| 165 |
& - COOR (1, J1) ) |
| 166 |
|
| 167 |
C CORRECT FOR ORIENTATION |
| 168 |
|
| 169 |
CROSS = (COOR (1, J3) -XMID) * (COOR (2, J2) -COOR (2, J1) )- |
| 170 |
& (COOR (2, J3) -YMID) * (COOR (1, J2) -COOR (1, J1) ) |
| 171 |
IF (CROSS.LT.0.0) THETA = THETA+PI |
| 172 |
SINT = SIN (THETA) |
| 173 |
COST = COS (THETA) |
| 174 |
|
| 175 |
C FIND POINTS APPROXIMATELY BY INTEGRATION |
| 176 |
|
| 177 |
XL = -HALFW |
| 178 |
FL = SQRT (1.0+ (TCOEF * XL) ** 2) |
| 179 |
KOUNT = 1 |
| 180 |
DELX = 2.0 * HALFW/200.0 |
| 181 |
XSTART = COOR (1, J1) |
| 182 |
YSTART = COOR (2, J1) |
| 183 |
DO 120 I = 1, 100 |
| 184 |
FM = SQRT (1.0+ (TCOEF * (XL+DELX) ) ** 2) |
| 185 |
XR = - HALFW + DBLE(I) * 2.0 * DELX |
| 186 |
FR = SQRT (1.0+ (TCOEF * XR) ** 2) |
| 187 |
ARCOLD = ARCNOW |
| 188 |
ARCNOW = ARCNOW+DELX * (FL+4.0 * FM+FR) / 3.0 |
| 189 |
IF (ARCNOW.GE.ARCNXT) THEN |
| 190 |
|
| 191 |
C COMPUTE POSITION IN LOCAL COORDINATE SYSTEM |
| 192 |
|
| 193 |
FRAC = (ARCNXT-ARCOLD) / (ARCNOW-ARCOLD) |
| 194 |
XK = XL+FRAC * 2.0 * DELX |
| 195 |
YK = COEF * XK ** 2 |
| 196 |
|
| 197 |
C CORRECT FOR ORIENTATION PROBLEM |
| 198 |
|
| 199 |
IF (CROSS.LT.0.0) XK = -XK |
| 200 |
|
| 201 |
C ROTATE IN LINE WITH GLOBAL COORDINATE SYSTEM |
| 202 |
|
| 203 |
ROTX = XK * COST - YK * SINT |
| 204 |
ROTY = YK * COST + XK * SINT |
| 205 |
|
| 206 |
C RESTORE XK |
| 207 |
|
| 208 |
IF (CROSS.LT.0.0) XK = -XK |
| 209 |
|
| 210 |
C TRANSLATE |
| 211 |
|
| 212 |
XEND = ROTX+COOR (1, J3) |
| 213 |
YEND = ROTY+COOR (2, J3) |
| 214 |
DIST = DIST+SQRT ((XEND-XSTART) ** 2 + (YEND-YSTART) **2) |
| 215 |
KOUNT = KOUNT+1 |
| 216 |
XSTART = XEND |
| 217 |
YSTART = YEND |
| 218 |
|
| 219 |
C PREPARE FOR NEXT POINT |
| 220 |
|
| 221 |
IF (KOUNT.GE.29) GOTO 130 |
| 222 |
ARCNXT = ARCNXT+ARCDEL |
| 223 |
|
| 224 |
C RESTART INTEGRATION |
| 225 |
|
| 226 |
XR = XK |
| 227 |
FR = SQRT (1.0+ (TCOEF * XR) ** 2) |
| 228 |
|
| 229 |
C CORRECT FOR INTEGRATION ERROR |
| 230 |
|
| 231 |
ARCNOW = PARC (TCOEF * XR, TCOEF) -PLEFT |
| 232 |
ENDIF |
| 233 |
XL = XR |
| 234 |
FL = FR |
| 235 |
120 CONTINUE |
| 236 |
130 CONTINUE |
| 237 |
XEND = COOR (1, J2) |
| 238 |
YEND = COOR (2, J2) |
| 239 |
DIST = DIST+SQRT ((XEND-XSTART) ** 2+ (YEND-YSTART) ** 2) |
| 240 |
ENDIF |
| 241 |
|
| 242 |
C NORMAL EXIT |
| 243 |
|
| 244 |
ERR = .FALSE. |
| 245 |
RETURN |
| 246 |
|
| 247 |
10000 FORMAT (' ZERO LINE LENGTH ENCOUNTERED FOR LINE', I5) |
| 248 |
10030 FORMAT (' POINTS GIVEN FOR LINE', I5, ' DO NOT DEFINE A PARABOLA') |
| 249 |
|
| 250 |
END |