Debian Codegraph @

packages/seacas/applications/fastq/csmang.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 c
8 C
9 C C* FILE: [.QMESH]CSMANG.FOR
10 C C* MODIFIED BY: TED BLACKER
11 C C* MODIFICATION DATE: 7/6/90
12 C C* MODIFICATION: COMPLETED HEADER INFORMATION
13 C
14 SUBROUTINE CSMANG (N, X, Y, ANGLE, NSANG, SMANG, INDEX)
15 C***********************************************************************
16 C
17 C SUBROUTINE CSMANG = CALCULATES THE "NSANG" SMALLEST ANGLES
18 C AND PLACES THEM IN THE SMANG ARRAY WITH
19 C THE INDICES BEING PLACED IN THE INDEX ARRAY
20 C
21 C***********************************************************************
22 C
23 C OBSERVATION: - IT DOES NOT MATTER THE ANGLE ORIENTATION.
24 C - THE ANGLES ARE STORE IN THE ANGLE ARRAY AS THEY
25 C APPEAR.
26 C - THE SMALLEST ANGLES ARE IN ASCENDING ORDER.
27 C - THE INDEX ARRAY RETURNS THE SMALLEST ANGLE POSITION
28 C IN ASCENDING ORDER.
29 C
30 C
31 C MODIFIED BY : HORACIO RECALDE DATE:JAN 1988
32 C***********************************************************************
33 C
34 DIMENSION X(N), Y(N), ANGLE(N)
35 DIMENSION SMANG (NSANG + 1), INDEX (NSANG + 1)
36
37 PI = ATAN2(0.0, -1.0)
38 TWOPI = 2.0 * PI
39 C
40 C FORM THE LIST OF SMALLEST ANGLES
41 C
42 NSA = NSANG
43 DO I = 1,NSA
44 SMANG(I) = 10.
45 INDEX(I) = 0
46 end do
47 C
48 AGOLD = ATAN2 (Y (1) - Y(N), X (1) - X (N))
49 C
50 DO J = 1, N
51 C
52 C GET THE ANGLE FORMED BY THIS SET OF POINTS
53 C
54 NEXT = J + 1
55 IF (NEXT .GT. N) NEXT = 1
56 AGNEW = ATAN2 (Y (NEXT) - Y (J), X (NEXT) - X (J))
57 DIFF = AGNEW - AGOLD
58 IF (DIFF .GT. PI) DIFF = DIFF - TWOPI
59 IF (DIFF .LT. -PI) DIFF = DIFF + TWOPI
60 ANGLE (J) = PI - DIFF
61 AGOLD = AGNEW
62 C
63 C SORT THIS ANGLE AGAINST PREVIOUS ANGLES TO SEE IF IT IS ONE OF
64 C THE SMALLEST
65 C
66 SMANG (NSA + 1) = ANGLE (J)
67 INDEX (NSA + 1) = J
68 DO II = 1, NSA
69 I = NSA + 1 - II
70 IF (SMANG (I + 1) .GE. SMANG (I)) GO TO 120
71 TEMP = SMANG(I)
72 ITEMP = INDEX(I)
73 SMANG (I) = SMANG (I + 1)
74 INDEX (I) = INDEX (I + 1)
75 SMANG (I + 1) = TEMP
76 INDEX (I + 1) = ITEMP
77 end do
78 120 CONTINUE
79 C
80 end do
81 C
82 RETURN
83 C
84 END