src/Tools/blocFissure/gmu/produitMixte.py

   1 # -*- coding: utf-8 -*-
   2
   3 import logging
   4 from .geomsmesh import geompy
   5
   6 # -----------------------------------------------------------------------------
   7 # --- calcul de produit mixte pour orientation
   8
   9 def produitMixte(o, p1, p2, p3):
  10   """
  11   produit mixte de 3 vecteurs a partir d'une origine et 3 points
  12   """
  13   coordo = geompy.PointCoordinates(o)
  14   coordp1 = geompy.PointCoordinates(p1)
  15   coordp2 = geompy.PointCoordinates(p2)
  16   coordp3 = geompy.PointCoordinates(p3)
  17   u = [coordp1[0] - coordo[0], coordp1[1] - coordo[1], coordp1[2] - coordo[2]]
  18   v = [coordp2[0] - coordo[0], coordp2[1] - coordo[1], coordp2[2] - coordo[2]]
  19   w = [coordp3[0] - coordo[0], coordp3[1] - coordo[1], coordp3[2] - coordo[2]]
  20   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])
  21   logging.debug('pm=%s', pm)
  22   return pm
  23