| 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 |