Debian Codegraph @

packages/seacas/applications/fastq/labove.f

raw
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