]> SALOME platform Git repositories - modules/smesh.git/blob - src/Tools/blocFissure/gmu/produitMixte.py
Salome HOME
Merge branch 'V9_2_2_BR'
[modules/smesh.git] / 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