Esope source files

   1 : C NORPLA    SOURCE    CHAT      05/01/13    02:00:51     5004           
   2 :       SUBROUTINE NORPLA(PT1,PT2,PT3,PTN,D)
   3 : C--------------------------------------------------------------
   4 : C     Calcul des coef de l'equation canonique d'un plan
   5 : C            passant par trois point (NORPLA)
   6 : C
   7 : C     Entree  PT1,PT2,PT2   Tableau x,y,z des trois points
   8 : C     Sortie  PTN           Tableau x,y,z pour la normale normee
   9 : C             D             Distance au plan
  10 : C
  11 : C     Calcul du vecteur directeur norme de la droite P1 P2 (NORDRO)
  12 : C
  13 : C     Entree  PT1,PT2       Tableau x,y,z des deux points
  14 : C     Sortie  PTN           Tableau x,y,z pour la normale normee
  15 : C
  16 : C     Appele par CONNE1
  17 : C
  18 : C     PP 22/10/92
  19 : C--------------------------------------------------------------
  20 :       IMPLICIT INTEGER(I-N)
  21 :       IMPLICIT REAL*8(A-H,O-Z)
  22 :       DIMENSION PTN(3),PT1(3),PT2(3),PT3(3)
  23 : C
  24 :       A=(PT2(2)-PT1(2))*(PT3(3)-PT1(3))
  25 :      > -(PT3(2)-PT1(2))*(PT2(3)-PT1(3))
  26 :       B=(PT2(3)-PT1(3))*(PT3(1)-PT1(1))
  27 :      > -(PT3(3)-PT1(3))*(PT2(1)-PT1(1))
  28 :       C=(PT2(1)-PT1(1))*(PT3(2)-PT1(2))
  29 :      > -(PT3(1)-PT1(1))*(PT2(2)-PT1(2))
  30 :       D=-A*PT1(1)-B*PT1(2)-C*PT1(3)
  31 : C
  32 :       XNOR=SQRT(A**2+B**2+C**2)
  33 :       PTN(1)=A/XNOR
  34 :       PTN(2)=B/XNOR
  35 :       PTN(3)=C/XNOR
  36 :       D=D/XNOR
  37 : C
  38 :       RETURN
  39 : C--------------------------------------------------------------
  40 :       E N T R Y  NORDRO(PT1,PT2,PTN)
  41 : C
  42 :       A=PT2(1)-PT1(1)
  43 :       B=PT2(2)-PT1(2)
  44 :       C=PT2(3)-PT1(3)
  45 : C
  46 :       XNOR=SQRT(A**2+B**2+C**2)
  47 :       PTN(1)=A/XNOR
  48 :       PTN(2)=B/XNOR
  49 :       PTN(3)=C/XNOR
  50 : C
  51 :       RETURN
  52 : C--------------------------------------------------------------
  53 :       END
  54 :