Debian Codegraph @

packages/seacas/applications/fastq/intsct.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 INTSCT (X1, Y1, X2, Y2, X3, Y3, X4, Y4, U, W, LCROSS)
8 C***********************************************************************
9
10 C SUBROUTINE INTSCT = CHECKS TO SEE IF THE LINE FROM N1 TO N2
11 C INTERSECTS THE LINE FROM N3 TO N4
12
13 C***********************************************************************
14
15 C NOTE: THIS INTERSECTION ROUTINE IS BASED ON AN ALGORITHM GIVEN
16 C IN THE BOOK "GEOMETRIC MODELING" BY MICHAEL E. MORTENSON ON
17 C PAGES 319 - 320.
18
19 C***********************************************************************
20
21 LOGICAL LCROSS
22
23 LCROSS = .FALSE.
24
25 if (max(x1, x2) .lt. min(x3, x4)) return
26 if (max(y1, y2) .lt. min(y3, y4)) return
27 if (max(x3, x4) .lt. min(x1, x2)) return
28 if (max(y3, y4) .lt. min(y1, y2)) return
29
30 C SET UP THE FIRST LINE'S VECTORS (A AND B)
31
32 XA = X1
33 YA = Y1
34 XB = X2 - X1
35 YB = Y2 - Y1
36
37 C SET UP THE SECOND LINE'S VECTORS (C AND D)
38
39 XC = X3
40 YC = Y3
41 XD = X4 - X3
42 YD = Y4 - Y3
43
44 C NOW USE THE VECTORS AND SOLVE FOR W.
45 C W IS THE PROPORTION OF THE DISTANCE ALONG THE VECTOR D
46 C WHERE THE INTERSECTION OCCURS. LIKEWISE U IS THE PROPORTIONAL
47 C DISTANCE ALONG THE VECTOR B FOR THE INTERSECTION. IF THERE IS
48 C AN INTERSECTION, BOTH U AND W MUST BE BETWEEN 0 AND 1.
49
50 DENOM = (YB * XD) - (XB * YD)
51
52 C CHECK FOR SPECIAL PARALLEL CASE - THE DENOMINATOR IS EQUAL TO ZERO.
53
54 IF (DENOM .NE. 0.) THEN
55
56 C CHECK FOR INTERSECTION
57
58 W = ( (YC * XB) - (XB * YA) - (XC * YB) + (YB * XA) ) / DENOM
59 IF ( (W .LT. 1.) .AND. (W .GT. 0.) ) THEN
60
61 C W INDICATES AN INTERSECTION HAS OCCURRED.
62 C GET THE U VALUE AND CONFIRM.
63
64 IF (XB .NE. 0.) THEN
65 U = ( XC + (W * XD) - XA ) / XB
66 ELSE
67 U = ( YC + (W * YD) - YA ) / YB
68 ENDIF
69 IF ( (U .LT. 1.) .AND. (U .GT. 0.) ) THEN
70 LCROSS = .TRUE.
71 ENDIF
72 ENDIF
73 ENDIF
74
75 RETURN
76
77 END