Debian Codegraph @

packages/seacas/applications/fastq/closel.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 CLOSEL (MP, ML, N, COOR, ILINE, LTYPE, LCON, LINKP,
8 & LINKL, X, Y, BIFIND, IFIND, ADDCEN, XCHOLD, YCHOLD)
9 C***********************************************************************
10
11 C SUBROUTINE CLOSEL = FINDS CLOSEST PERPENDICULAR BISECTED LINE
12
13 C***********************************************************************
14
15 C SUBROUTINE CALLED BY:
16 C BISECT =
17
18 C***********************************************************************
19
20 C SUBROUTINES CALLED:
21 C DLPARA = DETERMINES LINE PARAMETERS FROM TWO POINTS
22
23 C***********************************************************************
24
25 DIMENSION COOR(2, MP), ILINE(ML), LCON(3, ML), LTYPE(ML), N(29)
26 DIMENSION LINKL(2, ML), LINKP(2, MP)
27
28 LOGICAL BIFIND, BAD, ADDLNK, ADDCEN, ERR
29
30 PI = ATAN2(0.0, -1.0)
31 TWOPI = PI + PI
32
33 C FIND THE CLOSEST LINE ABOVE THE POINT INPUT
34
35 BIFIND = .FALSE.
36 ADDLNK = .FALSE.
37 IFIND = 0
38 DIST = 100000.
39 DO 100 I = 1, N(19)
40 CALL LTSORT (ML, LINKL, I, II, ADDLNK)
41 IF (II .GT. 0) THEN
42 KT = LTYPE(II)
43 CALL LINEPR (ML, MP, LINKP, LCON, II, I1, I2, I3, J1, J2,
44 & J3)
45 IF ((J1 .GT. 0) .AND. (J2 .GT. 0)) THEN
46 IF (KT .EQ. 1) THEN
47
48 C GET THE PARAMETERS FOR THE LINE
49
50 CALL DLPARA (COOR(1, J1), COOR(2, J1), COOR(1, J2),
51 & COOR(2, J2), XM1, B1, BAD)
52
53 C GET DISTANCE FOR VERTICAL LINE
54
55 IF (BAD) THEN
56 DTRY = ABS(COOR(1, J1) - X)
57 XTRY = COOR(1, J1)
58 YTRY = Y
59
60 C GET DISTANCE FOR HORIZONTAL LINE
61
62 ELSE IF (ABS(XM1) .LT. .000001) THEN
63 DTRY = ABS(COOR(2, J1) - Y)
64 XTRY = X
65 YTRY = COOR(2, J1)
66
67 C GET PERPENDICULAR DISTANCE TO ARBITRARY LINE
68
69 ELSE
70 XM2 = -1./XM1
71 B2 = Y - (XM2*X)
72 XTRY = (B2 - B1)/(XM1 - XM2)
73 YTRY = (XM1*XTRY) + B1
74 DTRY = SQRT((X - XTRY)**2 + (Y - YTRY)**2)
75 END IF
76 IF (DTRY .LE. DIST) THEN
77 X1 = MIN(COOR(1, J1), COOR(1, J2))
78 X2 = MAX(COOR(1, J1), COOR(1, J2))
79 Y1 = MIN(COOR(2, J1), COOR(2, J2))
80 Y2 = MAX(COOR(2, J1), COOR(2, J2))
81 IF ((XTRY .GE. X1) .AND. (XTRY .LE. X2) .AND.
82 & (YTRY .GE. Y1) .AND. (YTRY .LE. Y2)) THEN
83 DIST = DTRY
84 XHOLD = XTRY
85 YHOLD = YTRY
86 IFIND = I
87 BIFIND = .TRUE.
88 END IF
89 END IF
90
91 C CHECK DISTANCES TO CIRCULAR ARCS
92
93 ELSE IF ((KT .EQ. 3).OR.(KT .EQ. 4).OR.(KT .EQ. 6)) THEN
94
95 C FIRST GET THETA1, THETA2, THETAT, R1, R2, AND RTRY
96
97 CALL ARCPAR (MP, KT, ILINE(II), COOR, LINKP, J1, J2,
98 & J3, I3, XCEN, YCEN, THETA1, THETA2, TANG, R1, R2,
99 & ERR, ICCW, ICW, XK, XA)
100
101 IF ((Y .EQ. YCEN) .AND. (X .EQ. XCEN)) THEN
102 RTRY = 0.
103 THETAT = (THETA1 + THETA2)*.5
104 ELSE
105 THETAT = ATAN2(Y - YCEN, X - XCEN)
106 RTRY = SQRT( ((X - XCEN)**2) + ((Y - YCEN)**2))
107 END IF
108
109 C SEE IF THE POINT ANGLE IS WITHIN THE BEGINNING AND ENDING ANGLES
110
111 IF ( ((THETAT .LE. THETA2) .AND. (THETAT .GE. THETA1))
112 & .OR. ((THETAT + TWOPI .LE. THETA2) .AND.
113 & (THETAT + TWOPI .GE. THETA1)) ) THEN
114
115 C CALCULATE THE ARC RADIUS AT THAT ANGLE
116
117 RADIUS = XA*EXP(XK*THETAT)
118 DTRY = ABS(RADIUS - RTRY)
119
120 C CHECK TO SEE IF THE ARC IS THE CLOSEST
121
122 IF (DTRY .LE. DIST) THEN
123 DIST = DTRY
124 XHOLD = XCEN + COS(THETAT)*RADIUS
125 YHOLD = YCEN + SIN(THETAT)*RADIUS
126 IFIND = I
127 IF ((KT .EQ. 4).OR.(KT .EQ. 6)) THEN
128 ADDCEN = .TRUE.
129 XCHOLD = XCEN
130 YCHOLD = YCEN
131 ELSE
132 ADDCEN = .FALSE.
133 END IF
134 BIFIND = .TRUE.
135 END IF
136 END IF
137 END IF
138 END IF
139 END IF
140 100 CONTINUE
141 X = XHOLD
142 Y = YHOLD
143
144 RETURN
145 END