src/Tools/blocFissure/gmu/produitMixte.py

   1 # -*- coding: utf-8 -*-
   2 # Copyright (C) 2014-2019  CEA/DEN, EDF R&D
   3 #
   4 # This library is free software; you can redistribute it and/or
   5 # modify it under the terms of the GNU Lesser General Public
   6 # License as published by the Free Software Foundation; either
   7 # version 2.1 of the License, or (at your option) any later version.
   8 #
   9 # This library is distributed in the hope that it will be useful,
  10 # but WITHOUT ANY WARRANTY; without even the implied warranty of
  11 # MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  12 # Lesser General Public License for more details.
  13 #
  14 # You should have received a copy of the GNU Lesser General Public
  15 # License along with this library; if not, write to the Free Software
  16 # Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
  17 #
  18 # See http://www.salome-platform.org/ or email : webmaster.salome@opencascade.com
  19 #
  20
  21 import logging
  22 from .geomsmesh import geompy
  23
  24 # -----------------------------------------------------------------------------
  25 # --- calcul de produit mixte pour orientation
  26
  27 def produitMixte(o, p1, p2, p3):
  28   """
  29   produit mixte de 3 vecteurs a partir d'une origine et 3 points
  30   """
  31   coordo = geompy.PointCoordinates(o)
  32   coordp1 = geompy.PointCoordinates(p1)
  33   coordp2 = geompy.PointCoordinates(p2)
  34   coordp3 = geompy.PointCoordinates(p3)
  35   u = [coordp1[0] - coordo[0], coordp1[1] - coordo[1], coordp1[2] - coordo[2]]
  36   v = [coordp2[0] - coordo[0], coordp2[1] - coordo[1], coordp2[2] - coordo[2]]
  37   w = [coordp3[0] - coordo[0], coordp3[1] - coordo[1], coordp3[2] - coordo[2]]
  38   pm = (u[0]*v[1]*w[2] + v[0]*w[1]*u[2] + w[0]*u[1]*v[2]) - (u[0]*w[1]*v[2] + v[0]*u[1]*w[2] + w[0]*v[1]*u[2])
  39   logging.debug('pm=%s', pm)
  40   return pm
  41