| 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 LABOVE (MP,ML,N,IPOINT,COOR,ILINE,LTYPE,LCON, |
| 8 |
+ LINKP,LINKL,X,Y,Y1,Y2,IFIND,INDEX,IFIRST,INEXT) |
| 9 |
C*********************************************************************** |
| 10 |
|
| 11 |
C SUBROUTINE LABOVE = GETS THE CLOSEST LINE ABOVE A GIVEN X,Y |
| 12 |
|
| 13 |
C*********************************************************************** |
| 14 |
|
| 15 |
C VARIABLES USED: |
| 16 |
C IFIND = THE CLOSEST LINE FOUND ABOVE THE X,Y LOCATION |
| 17 |
C IFIRST = THE CCW END OF THE LINE (LEFT END) |
| 18 |
C INEXT = THE CW END OF THE LINE (RIGHT END) |
| 19 |
|
| 20 |
C*********************************************************************** |
| 21 |
|
| 22 |
DIMENSION IPOINT(MP),COOR(2,MP),ILINE(ML),LTYPE(ML),LCON(3,ML) |
| 23 |
DIMENSION LINKP(2,MP),LINKL(2,ML) |
| 24 |
DIMENSION N(29) |
| 25 |
|
| 26 |
LOGICAL BAD,ADDLNK,ERR,UP |
| 27 |
|
| 28 |
PI = ATAN2(0.0, -1.0) |
| 29 |
|
| 30 |
TWOPI=PI+PI |
| 31 |
ADDLNK=.FALSE. |
| 32 |
DIST=Y2-Y1 |
| 33 |
|
| 34 |
DO 100 I=1,N(19) |
| 35 |
CALL LTSORT(ML,LINKL,I,II,ADDLNK) |
| 36 |
IF(II.GT.0)THEN |
| 37 |
I1=LCON(1,II) |
| 38 |
I2=LCON(2,II) |
| 39 |
I3=LCON(3,II) |
| 40 |
CALL LTSORT(MP,LINKP,I1,J1,ADDLNK) |
| 41 |
CALL LTSORT(MP,LINKP,I2,J2,ADDLNK) |
| 42 |
IF(I3.NE.0)THEN |
| 43 |
CALL LTSORT(MP,LINKP,IABS(I3),J3,ADDLNK) |
| 44 |
ELSE |
| 45 |
J3=0 |
| 46 |
ENDIF |
| 47 |
|
| 48 |
C SEE IF LINE EXISTS |
| 49 |
|
| 50 |
IF((J1.GT.0).AND.(J2.GT.0))THEN |
| 51 |
|
| 52 |
C CHECK A STRAIGHT LINE TO SEE IF IT SPANS THE POINT |
| 53 |
|
| 54 |
IF((LTYPE(II).EQ.1).AND. |
| 55 |
+ (((COOR(1,J1).LE.X).AND.(COOR(1,J2).GE.X)).OR. |
| 56 |
+ ((COOR(1,J2).LE.X).AND.(COOR(1,J1).GE.X))))THEN |
| 57 |
|
| 58 |
C SEE IF LINE IS ABOVE |
| 59 |
|
| 60 |
CALL DLPARA(COOR(1,J1),COOR(2,J1),COOR(1,J2), |
| 61 |
+ COOR(2,J2),XM1,B1,BAD) |
| 62 |
IF(.NOT.BAD)THEN |
| 63 |
YTRY=(XM1*X)+B1 |
| 64 |
IF(YTRY.GT.Y)THEN |
| 65 |
|
| 66 |
C CHECK DISTANCE TO THE LINE - RECORD LINE NO. IF CLOSEST |
| 67 |
|
| 68 |
DTRY=YTRY-Y |
| 69 |
IF((DTRY.LE.DIST).OR.(ABS(DIST-DTRY).LT. |
| 70 |
+ .001*DIST))THEN |
| 71 |
DIST=DTRY |
| 72 |
IFIND=I |
| 73 |
INDEX=II |
| 74 |
IF(COOR(1,J1).GT.X)THEN |
| 75 |
IFIRST=I2 |
| 76 |
INEXT=I1 |
| 77 |
ELSE |
| 78 |
IFIRST=I1 |
| 79 |
INEXT=I2 |
| 80 |
ENDIF |
| 81 |
ENDIF |
| 82 |
ENDIF |
| 83 |
ENDIF |
| 84 |
|
| 85 |
C CHECK AN ARC LINE |
| 86 |
|
| 87 |
ELSEIF(((LTYPE(II).EQ.3).OR.(LTYPE(II).EQ.4).OR. |
| 88 |
+ (LTYPE(II).EQ.6)).AND.(J3.GT.0))THEN |
| 89 |
CALL ARCPAR(MP,LTYPE(II),ILINE(II),COOR,LINKP,J1,J2, |
| 90 |
+ J3,I3,XCEN,YCEN,THETA1,THETA2,TANG,R1,R2,ERR, |
| 91 |
+ ICCW,ICW,XK,XA) |
| 92 |
IF(.NOT.ERR)THEN |
| 93 |
|
| 94 |
C SET THE ARC AS EITHER AN UPWARD ARCH OR DOWNWARD ARCH |
| 95 |
C (A CLOSED CIRCLE IS ALWAYS AN UPWARD ARCH) |
| 96 |
|
| 97 |
IF(J1.EQ.J2)THEN |
| 98 |
UP=.TRUE. |
| 99 |
ELSEIF(COOR(1,ICCW).GE.COOR(1,ICW))THEN |
| 100 |
UP=.TRUE. |
| 101 |
ELSE |
| 102 |
UP=.FALSE. |
| 103 |
ENDIF |
| 104 |
|
| 105 |
C THE INPUT POINT IS RIGHT AT THE CENTER OF THE CIRCLE |
| 106 |
|
| 107 |
IF((Y.EQ.YCEN).AND.(X.EQ.XCEN))THEN |
| 108 |
RP=0. |
| 109 |
THETAP=(THETA1+THETA2)*.5 |
| 110 |
ELSE |
| 111 |
THETAP=ATAN2(Y-YCEN,X-XCEN) |
| 112 |
RP=SQRT( ((X-XCEN)**2) + ((Y-YCEN)**2) ) |
| 113 |
ENDIF |
| 114 |
|
| 115 |
C SEE IF THE POINT ANGLE IS WITHIN THE BEGINNING AND ENDING ANGLES |
| 116 |
|
| 117 |
IF( ( (THETAP.LE.THETA2) .AND. (THETAP.GE.THETA1) ) |
| 118 |
& .OR. |
| 119 |
& ( (THETAP+TWOPI.LE.THETA2) .AND. |
| 120 |
& (THETAP+TWOPI.GE.THETA1) ) |
| 121 |
& .OR. |
| 122 |
& ( (THETAP.LE.THETA1) .AND. (THETAP.GE.THETA2) ) |
| 123 |
& .OR. |
| 124 |
& ( (THETAP+TWOPI.LE.THETA1) .AND. |
| 125 |
& (THETAP+TWOPI.GE.THETA2) ) ) THEN |
| 126 |
|
| 127 |
C SEE IF THE POINT TO CENTER DISTANCE IS LESS THAN THE |
| 128 |
C ARC RADIUS AT THAT ANGLE FOR AN UPWARD ARC OR GREATER FOR |
| 129 |
C A DOWNWARD ARC (BELOW THE ARC) |
| 130 |
|
| 131 |
RTEST = XA * EXP ( XK * THETAP ) |
| 132 |
IF( ( (UP) .AND. (RTEST.GE.RP) ) .OR. |
| 133 |
+ ( (.NOT.UP) .AND. (RTEST.LE.RP) ) )THEN |
| 134 |
|
| 135 |
C CHECK Y DISTANCE TO THE LINE - RECORD LINE NO. IF CLOSEST |
| 136 |
|
| 137 |
CALL ARCY(XCEN,YCEN,THETA1,THETA2,XK,XA, |
| 138 |
+ X,YTRY,ERR) |
| 139 |
DTRY=YTRY-Y |
| 140 |
IF( (.NOT.ERR) .AND. |
| 141 |
+ (YTRY .GT. Y) .AND. |
| 142 |
+ ( (DTRY.LE.DIST) .OR. |
| 143 |
+ (ABS(DIST-DTRY).LT..001*DIST)))THEN |
| 144 |
DIST=DTRY |
| 145 |
IFIND=I |
| 146 |
INDEX=II |
| 147 |
IF(UP)THEN |
| 148 |
IFIRST=IPOINT(ICW) |
| 149 |
INEXT=IPOINT(ICCW) |
| 150 |
ELSE |
| 151 |
IFIRST=IPOINT(ICCW) |
| 152 |
INEXT=IPOINT(ICW) |
| 153 |
ENDIF |
| 154 |
ENDIF |
| 155 |
ENDIF |
| 156 |
|
| 157 |
C THE ONLY OTHER ARC POSSIBILITY IS IF THE X FALLS IN THE SPAN |
| 158 |
C BETWEEN THE TWO ENDPOINTS OR BETWEEN END POINTS AND CENTER POINT |
| 159 |
|
| 160 |
ELSEIF ( ((X - COOR(1,J1) ) * |
| 161 |
+ (X - COOR(1,J2) ) .LT.0) |
| 162 |
+ .OR. |
| 163 |
+ ((X - COOR(1,J1) ) * |
| 164 |
+ (X - COOR(1,J3) ) .LT.0) |
| 165 |
+ .OR. |
| 166 |
+ ((X - COOR(1,J2) ) * |
| 167 |
+ (X - COOR(1,J3) ) .LT.0) ) THEN |
| 168 |
|
| 169 |
C CHECK Y DISTANCE TO THE LINE - RECORD LINE NO. IF CLOSEST |
| 170 |
|
| 171 |
CALL ARCY(XCEN,YCEN,THETA1,THETA2,XK,XA, |
| 172 |
+ X,YTRY,ERR) |
| 173 |
DTRY=YTRY-Y |
| 174 |
IF( (.NOT.ERR) .AND. |
| 175 |
+ (YTRY .GT. Y) .AND. |
| 176 |
+ ( (DTRY.LE.DIST) .OR. |
| 177 |
+ (ABS(DIST-DTRY).LT..001*DIST)))THEN |
| 178 |
DIST=DTRY |
| 179 |
IFIND=I |
| 180 |
INDEX=II |
| 181 |
|
| 182 |
C TREAT THE BETWEEN END POINTS DIFFERENTLY THAN BETWEEN |
| 183 |
C ENDPOINT AND CENTER POINT |
| 184 |
|
| 185 |
IF( ((X - COOR(1,J1) ) * |
| 186 |
+ (X - COOR(1,J2) )) .LT.0) THEN |
| 187 |
IF(UP)THEN |
| 188 |
IFIRST=IPOINT(ICW) |
| 189 |
INEXT=IPOINT(ICCW) |
| 190 |
ELSE |
| 191 |
IFIRST=IPOINT(ICCW) |
| 192 |
INEXT=IPOINT(ICW) |
| 193 |
ENDIF |
| 194 |
ELSE |
| 195 |
IF( COOR(2,ICCW) .GT. |
| 196 |
+ COOR(2,ICW) ) THEN |
| 197 |
IFIRST=IPOINT(ICCW) |
| 198 |
INEXT=IPOINT(ICW) |
| 199 |
ELSE |
| 200 |
IFIRST=IPOINT(ICW) |
| 201 |
INEXT=IPOINT(ICCW) |
| 202 |
ENDIF |
| 203 |
ENDIF |
| 204 |
ENDIF |
| 205 |
ENDIF |
| 206 |
ENDIF |
| 207 |
ENDIF |
| 208 |
ENDIF |
| 209 |
ENDIF |
| 210 |
100 CONTINUE |
| 211 |
|
| 212 |
RETURN |
| 213 |
|
| 214 |
END |