Debian Codegraph @

packages/seacas/applications/numbers/nu_point3.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 POINT3 (COORD, NUMNP, DIST, NDIM, P1, TOLER,
8 * NODEL, SORTYP, MAP, ANGLE, SORUP, INUM, OPT, SELECT)
9 DIMENSION COORD (NUMNP,*), DIST(*), P1(*), TOLER(*),
10 * MAP(*), ANGLE(2,*)
11 CHARACTER*(*) NODEL, SORTYP, OPT
12 LOGICAL SORUP, SELECT(*), ISABRT
13 include 'nu_io.blk'
14 PI = ATAN2(0.0, -1.0)
15
16 CALL LOCOUT ('POINT', NDIM, NODEL, TOLER, SORTYP, P1, P1, ' ')
17
18 TEMP = TOLER(1)
19 TOLER(1) = MAX(0.0, TEMP - TOLER(2))
20 TOLER(2) = MAX(0.0, TEMP + TOLER(2))
21
22 X1 = P1(1)
23 Y1 = P1(2)
24 Z1 = P1(3)
25
26 DO 10 I=1, NUMNP
27 IF (SELECT(I)) THEN
28 X0 = COORD(I,1)
29 Y0 = COORD(I,2)
30 Z0 = COORD(I,3)
31
32 DIST(I) = (X1 - X0)**2 + (Y1 - Y0)**2 + (Z1 - Z0)**2
33 END IF
34 10 CONTINUE
35
36 INUM = 0
37 DISMIN = 1.0E38
38 DO 20 I=1, NUMNP
39 IF (SELECT(I)) THEN
40 DISMIN = MIN(DIST(I), ABS(DISMIN-TEMP))
41 IF (DIST(I) .GE. TOLER(1)**2 .AND. DIST(I) .LE. TOLER(2)**2)
42 * THEN
43 DX = COORD(I,1) - P1(1)
44 DY = COORD(I,2) - P1(2)
45 DZ = COORD(I,3) - P1(3)
46 DS = SQRT(DX**2 + DZ**2)
47
48 FIX1 = SIGN(0.5,ABS(DX+DZ)) + SIGN(0.5,-ABS(DX+DZ))
49 FIX2 = SIGN(0.5,ABS(DS+DY)) + SIGN(0.5,-ABS(DS+DY))
50 ANGLE(1,I) = ATAN2(DZ,DX+FIX1) * 180.0 / PI
51 ANGLE(2,I) = ATAN2(DY,DS+FIX2) * 180.0 / PI
52
53 INUM = INUM + 1
54 MAP(INUM) = I
55 END IF
56 END IF
57 20 CONTINUE
58
59 IF (SORTYP .EQ. 'X') THEN
60 CALL INDEXX (COORD(1,1), MAP, INUM, .FALSE.)
61 ELSE IF (SORTYP .EQ. 'Y') THEN
62 CALL INDEXX (COORD(1,2), MAP, INUM, .FALSE.)
63 ELSE IF (SORTYP .EQ. 'Z') THEN
64 CALL INDEXX (COORD(1,3), MAP, INUM, .FALSE.)
65 ELSE IF (SORTYP .EQ. 'THETA') THEN
66 CALL INDEXN (ANGLE, 2, 1, MAP, INUM, .FALSE.)
67 ELSE IF (SORTYP .EQ. 'PHI') THEN
68 CALL INDEXN (ANGLE, 2, 2, MAP, INUM, .FALSE.)
69 ELSE IF (SORTYP .EQ. 'DISTANCE') THEN
70 CALL INDEXX (DIST, MAP, INUM, .FALSE.)
71 END IF
72
73 IF (SORUP) THEN
74 IBEG = 1
75 IEND = INUM
76 IINC = 1
77 ELSE
78 IBEG = INUM
79 IEND = 1
80 IINC = -1
81 END IF
82
83 IF (OPT .EQ. '*' .OR. INDEX(OPT, 'P') .GT. 0) THEN
84 DO 30 IO=IOMIN, IOMAX
85 WRITE (IO, 40) NODEL
86 30 CONTINUE
87 40 FORMAT (/,2X,A8,T16,'X',T26,'Y',T36,'Z',T44,'DISTANCE',
88 * T58,'THETA',T71,'PHI')
89 DO 60 IN = IBEG, IEND, IINC
90 IF (ISABRT()) RETURN
91 I = MAP(IN)
92 DO 50 IO=IOMIN, IOMAX
93 WRITE (IO, 90) I, (COORD(I,J),J=1,3), SQRT(DIST(I)),
94 * ANGLE(1,I), ANGLE(2,I)
95 50 CONTINUE
96 60 CONTINUE
97
98 IF (INUM .EQ. 0) THEN
99 DO 70 IO=IOMIN, IOMAX
100 WRITE (IO, 80) SQRT(DISMIN)
101 70 CONTINUE
102 END IF
103 END IF
104 80 FORMAT (/' None found within range, minimum distance = ',
105 * 1PE12.3,/)
106 90 FORMAT (I10, 3(F10.4), 3(1PE12.3))
107 RETURN
108 END