1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28
|
C Copyright (c) 2003-2010 University of Florida
C
C This program is free software; you can redistribute it and/or modify
C it under the terms of the GNU General Public License as published by
C the Free Software Foundation; either version 2 of the License, or
C (at your option) any later version.
C This program is distributed in the hope that it will be useful,
C but WITHOUT ANY WARRANTY; without even the implied warranty of
C MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
C GNU General Public License for more details.
C The GNU General Public License is included in this distribution
C in the file COPYRIGHT.
C CALCULATES THE DISTANCE BETWEEN TWO POINTS IN CARTESIAN SPACE
Double Precision FUNCTION DIST(A,B)
IMPLICIT DOUBLE PRECISION (A-H,O-Z)
DIMENSION A(3),B(3)
cYAU - I warn you, expanding all of these out does not ensure Z is positive.
Z= (A(1)-B(1))**2
Z=Z+(A(2)-B(2))**2
Z=Z+(A(3)-B(3))**2
DIST = SQRT(Z)
RETURN
END
|