Debian Codegraph @

packages/seacas/applications/fastq/vinter.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 VINTER (MXND, XN, YN, N1, N2, N3, XOLD, YOLD,
8 & XNEW, YNEW, VCROSS)
9 C***********************************************************************
10
11 C SUBROUTINE VINTER = FINDS WHERE A VECTOR FROM N1 TO N2
12 C INTERSECTS THE VECTOR FROM N3 TO (XOLD, YOLD)
13
14 C***********************************************************************
15
16 C NOTE: THIS INTERSECTION ROUTINE IS BASED ON AN ALGORITHM GIVEN
17 C IN THE BOOK "GEOMETRIC MODELING" BY MICHAEL E. MORTENSON ON
18 C PAGES 319 - 320.
19
20 C***********************************************************************
21
22 DIMENSION XN (MXND), YN (MXND)
23
24 LOGICAL VCROSS
25
26 VCROSS = .FALSE.
27
28 C SET UP THE FIRST LINE'S VECTORS (A AND B)
29
30 XA = XN (N1)
31 YA = YN (N1)
32 XB = XN (N2) - XN (N1)
33 YB = YN (N2) - YN (N1)
34
35 C SET UP THE SECOND LINE'S VECTORS (C AND D)
36
37 XC = XN (N3)
38 YC = YN (N3)
39 XD = XOLD - XN (N3)
40 YD = YOLD - YN (N3)
41
42 C NOW USE THE VECTORS AND SOLVE FOR W.
43 C W IS THE PROPORTION OF THE DISTANCE ALONG THE VECTOR D
44 C WHERE THE INTERSECTION OCCURS. LIKEWISE U IS THE PROPORTIONAL
45 C DISTANCE ALONG THE VECTOR B FOR THE INTERSECTION.
46
47 DENOM = (YB * XD) - (XB * YD)
48
49 C CHECK FOR SPECIAL PARALLEL CASE - THE DENOMINATOR IS EQUAL TO ZERO.
50
51 IF (DENOM .NE. 0.) THEN
52
53 C GET INTERSECTION LOCATION
54
55 W = ( (YC * XB) - (XB * YA) - (XC * YB) + (YB * XA) ) / DENOM
56
57 C GET THE U VALUE TO CONFIRM.
58
59 IF (XB .NE. 0.) THEN
60 U = ( XC + (W * XD) - XA ) / XB
61 ELSE
62 U = ( YC + (W * YD) - YA ) / YB
63 ENDIF
64
65 C CALCULATE THE INTERSECTION POINT BASED ON SIMILAR TRIANGLES
66
67 XNEW = ( (XA + (XB * U)) + (XC + (XD * W)) ) * .5
68 YNEW = ( (YA + (YB * U)) + (YC + (YD * W)) ) * .5
69 VCROSS = .TRUE.
70 ENDIF
71
72 RETURN
73
74 END