| 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 ENDTAN (MP, ML, N, IPOINT, COOR, LTYPE, LCON, LINKP, |
| 8 |
& LINKL, LNUM, LPNTR, NP, THETA, ERR) |
| 9 |
C*********************************************************************** |
| 10 |
|
| 11 |
C SUBROUTINE ENDTAN = GETS THE ANGLE FOR THE TANGENT AT THE END OF |
| 12 |
C A LINE |
| 13 |
|
| 14 |
C*********************************************************************** |
| 15 |
|
| 16 |
C VARIABLES USED: LNUM = LINE NUMBER |
| 17 |
C LPNTR = LINE POINTER |
| 18 |
C VECTX = X VECTOR |
| 19 |
C VECTY = Y VECTOR |
| 20 |
C ICCW = THE POINTER TO THE CCW END OF THE LINE |
| 21 |
C ICW = THE POINTER TO THE CW END OF THE LINE |
| 22 |
C I1 = THE FIRST POINT NUMBER OF THE LINE |
| 23 |
C I2 = THE SECOND POINT NUMBER OF THE LINE |
| 24 |
C I3 = THE THIRD POINT NUMBER OF THE LINE |
| 25 |
C J1 = THE FIRST POINT NUMBER INDEX |
| 26 |
C J2 = THE SECOND POINT NUMBER INDEX |
| 27 |
C J3 = THE THIRD POINT NUMBER INDEX |
| 28 |
|
| 29 |
C*********************************************************************** |
| 30 |
|
| 31 |
DIMENSION IPOINT (MP), COOR (2, MP), LTYPE (ML), LCON (3, ML) |
| 32 |
DIMENSION LINKP (2, MP), LINKL (2, ML) |
| 33 |
DIMENSION N (29) |
| 34 |
|
| 35 |
LOGICAL ADDLNK, ERR |
| 36 |
|
| 37 |
PI = ATAN2(0.0, -1.0) |
| 38 |
|
| 39 |
TWOPI = PI + PI |
| 40 |
ADDLNK = .FALSE. |
| 41 |
ERR = .FALSE. |
| 42 |
|
| 43 |
C GET THE POINTERS TO THE POINTS THAT DEFINE THE LINE |
| 44 |
|
| 45 |
I1 = LCON (1, LPNTR) |
| 46 |
I2 = LCON (2, LPNTR) |
| 47 |
I3 = LCON (3, LPNTR) |
| 48 |
CALL LTSORT (MP, LINKP, I1, J1, ADDLNK) |
| 49 |
CALL LTSORT (MP, LINKP, I2, J2, ADDLNK) |
| 50 |
IF ( (J1 .LE. 0) .OR. (J2 .LE. 0))RETURN |
| 51 |
IF (I3 .NE. 0) THEN |
| 52 |
CALL LTSORT (MP, LINKP, IABS (I3), J3, ADDLNK) |
| 53 |
IF (J3 .LE. 0)RETURN |
| 54 |
ELSE |
| 55 |
J3 = 0 |
| 56 |
ENDIF |
| 57 |
|
| 58 |
C STRAIGHT LINE END TANGENT |
| 59 |
|
| 60 |
IF (LTYPE (LPNTR) .EQ. 1) THEN |
| 61 |
IF (I1 .EQ. NP) THEN |
| 62 |
VECTX = COOR (1, J2) - COOR (1, J1) |
| 63 |
VECTY = COOR (2, J2) - COOR (2, J1) |
| 64 |
ELSEIF (I2 .EQ. NP) THEN |
| 65 |
VECTX = COOR (1, J1) - COOR (1, J2) |
| 66 |
VECTY = COOR (2, J1) - COOR (2, J2) |
| 67 |
ELSE |
| 68 |
ERR = .TRUE. |
| 69 |
RETURN |
| 70 |
ENDIF |
| 71 |
THETA = ATAN2 (VECTY, VECTX) |
| 72 |
|
| 73 |
C ARC LINE END TANGENT |
| 74 |
|
| 75 |
ELSEIF (LTYPE (LPNTR) .NE. 5) THEN |
| 76 |
CALL ARCPAR (MP, LTYPE (LPNTR), LNUM, COOR, LINKP, |
| 77 |
& J1, J2, J3, I3, XCEN, YCEN, THETA1, THETA2, TANG, |
| 78 |
& R1, R2, ERR, ICCW, ICW, XK, XA) |
| 79 |
|
| 80 |
C CHECK FOR THE A CLOSED ARC |
| 81 |
|
| 82 |
IF (IPOINT (ICCW) .EQ. IPOINT (ICW)) THEN |
| 83 |
THETA = THETA2 + (PI * .5) |
| 84 |
ELSEIF (NP .EQ. IPOINT (ICCW)) THEN |
| 85 |
THETA = THETA1 + (PI * .5) + XK |
| 86 |
ELSEIF (NP .EQ. IPOINT (ICW)) THEN |
| 87 |
THETA = THETA2 - ( (PI * .5) - XK ) |
| 88 |
ELSE |
| 89 |
ERR = .TRUE. |
| 90 |
RETURN |
| 91 |
ENDIF |
| 92 |
|
| 93 |
C NO OTHER LINES SUPPORTED |
| 94 |
|
| 95 |
ELSE |
| 96 |
ERR = .TRUE. |
| 97 |
CALL MESSAGE('UNSUPPORTED LINE TYPE IN ENDTAN') |
| 98 |
RETURN |
| 99 |
ENDIF |
| 100 |
|
| 101 |
C MAKE SURE THAT THETA IS BETWEEN 0 AND 2PI |
| 102 |
|
| 103 |
IF (THETA .LT. 0) THEN |
| 104 |
THETA = THETA + TWOPI |
| 105 |
ELSEIF (THETA .GT. TWOPI) THEN |
| 106 |
THETA = THETA - TWOPI |
| 107 |
ENDIF |
| 108 |
|
| 109 |
RETURN |
| 110 |
|
| 111 |
END |