Debian Codegraph @

packages/seacas/applications/fastq/snappt.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 SNAPPT (MSNAP, SNAPDX, NSNAP, X, Y)
8 C***********************************************************************
9
10 C SUBROUTINE SNAPPT = GETS THE X, Y TO THE CLOSEST GRID POINT
11
12 C***********************************************************************
13
14 C VARIABLES USED:
15 C SNAPDX = SNAP GRID LINE ARRAY
16 C NSNAP = ARRAY OF GRID LINE COUNTERS
17 C MSNAP = THE DIMENSION OF THE GRID LINE ARRAY
18 C XMID = .TRUE. IF THE X VALUE FALLS BETWEEN TWO X GRID LINES
19 C YMID = .TRUE. IF THE Y VALUE FALLS BETWEEN TWO Y GRID LINES
20
21 C***********************************************************************
22
23 DIMENSION SNAPDX (2, MSNAP), NSNAP (2)
24
25 LOGICAL XMID, YMID
26
27 XMID = .FALSE.
28 YMID = .FALSE.
29
30 C GET THE BOUNDING X SNAP LINES
31
32 IF (X .LE. SNAPDX (1, 1)) THEN
33 XP = SNAPDX (1, 1)
34 ELSEIF (X .GE. SNAPDX (1, NSNAP (1))) THEN
35 XP = SNAPDX (1, NSNAP (1))
36 ELSE
37 XMID = .TRUE.
38 DO 100 I = 2, NSNAP (1)
39 IF (X .LE. SNAPDX (1, I)) THEN
40 XP1 = SNAPDX (1, I - 1)
41 XP2 = SNAPDX (1, I)
42 GOTO 110
43 ENDIF
44 100 CONTINUE
45 110 CONTINUE
46 ENDIF
47
48 C GET THE BOUNDING Y SNAP LINES
49
50 IF (Y .LE. SNAPDX (2, 1)) THEN
51 YP = SNAPDX (2, 1)
52 ELSEIF (Y .GE. SNAPDX (2, NSNAP (2))) THEN
53 YP = SNAPDX (2, NSNAP (2))
54 ELSE
55 YMID = .TRUE.
56 DO 120 I = 2, NSNAP (2)
57 IF (Y .LE. SNAPDX (2, I)) THEN
58 YP1 = SNAPDX (2, I - 1)
59 YP2 = SNAPDX (2, I)
60 GOTO 130
61 ENDIF
62 120 CONTINUE
63 130 CONTINUE
64 ENDIF
65
66 C NOW GET THE APPROPRIATE COMBINATION OF XLOW, XHIGH, XMID, YLOW, ETC.
67
68 C FIRST THE MOST COMMON CASE OF FITTING BETWEEN X AND Y GRIDS
69
70 IF ( (YMID) .AND. (XMID)) THEN
71
72 C GET THE SHORTEST DISTANCE TO THIS COMBINATION
73
74 DIST1 = SQRT ( ( (XP1 - X) ** 2) + ( (YP1 - Y) ** 2))
75 DIST2 = SQRT ( ( (XP1 - X) ** 2) + ( (YP2 - Y) ** 2))
76 DIST3 = SQRT ( ( (XP2 - X) ** 2) + ( (YP1 - Y) ** 2))
77 DIST4 = SQRT ( ( (XP2 - X) ** 2) + ( (YP2 - Y) ** 2))
78
79 IF (DIST1 .LE. AMIN1 (DIST2, DIST3, DIST4)) THEN
80 X = XP1
81 Y = YP1
82 ELSEIF (DIST2 .LE. AMIN1 (DIST1, DIST3, DIST4)) THEN
83 X = XP1
84 Y = YP2
85 ELSEIF (DIST3 .LE. AMIN1 (DIST1, DIST2, DIST4)) THEN
86 X = XP2
87 Y = YP1
88 ELSE
89 X = XP2
90 Y = YP2
91 ENDIF
92
93 C NOW THE CORNER CASES OF XLOW, XHIGH, YLOW, AND YHIGH COMBINATIONS
94
95 ELSEIF ( (.NOT.XMID) .AND. (.NOT.YMID)) THEN
96 X = XP
97 Y = YP
98
99 C NOW THE EDGE CASES OF XLOW OR XHIGH AND YMID
100
101 ELSEIF (.NOT.XMID) THEN
102 X = XP
103 DIST1 = SQRT ( ( (XP - X) ** 2) + ( (YP1 - Y) ** 2))
104 DIST2 = SQRT ( ( (XP - X) ** 2) + ( (YP2 - Y) ** 2))
105 IF (DIST1 .LT. DIST2) THEN
106 Y = YP1
107 ELSE
108 Y = YP2
109 ENDIF
110
111 C NOW THE EDGE CASES OF XMID AND YHIGH OR YLOW
112
113 ELSEIF (.NOT.YMID) THEN
114 Y = YP
115 DIST1 = SQRT ( ( (XP1 - X) ** 2) + ( (YP - Y) ** 2))
116 DIST2 = SQRT ( ( (XP2 - X) ** 2) + ( (YP - Y) ** 2))
117 IF (DIST1 .LT. DIST2) THEN
118 X = XP1
119 ELSE
120 X = XP2
121 ENDIF
122
123 C NOW A CHECK TO MAKE SURE THAT SOMETHING DIDN'T FALL THROUGH
124
125 ELSE
126 CALL MESSAGE(' ** ERROR - IMPOSSIBLE CASE IN SNAPPT ** ')
127 CALL PLTBEL
128 ENDIF
129
130 RETURN
131
132 END