PR: add blocFissure plugin

[modules/smesh.git] / src / Tools / blocFissure / gmu / produitMixte.py

diff --git a/src/Tools/blocFissure/gmu/produitMixte.py b/src/Tools/blocFissure/gmu/produitMixte.py
new file mode 100644 (file)
index 0000000..509a758
--- /dev/null
+++ b/src/Tools/blocFissure/gmu/produitMixte.py
@@ -0,0 +1,23 @@
+# -*- coding: utf-8 -*-
+
+import logging
+from geomsmesh import geompy
+
+# -----------------------------------------------------------------------------
+# --- calcul de produit mixte pour orientation
+
+def produitMixte(o, p1, p2, p3):
+  """
+  produit mixte de 3 vecteurs a partir d'une origine et 3 points
+  """
+  coordo = geompy.PointCoordinates(o)
+  coordp1 = geompy.PointCoordinates(p1)
+  coordp2 = geompy.PointCoordinates(p2)
+  coordp3 = geompy.PointCoordinates(p3)
+  u = [coordp1[0] - coordo[0], coordp1[1] - coordo[1], coordp1[2] - coordo[2]]
+  v = [coordp2[0] - coordo[0], coordp2[1] - coordo[1], coordp2[2] - coordo[2]]
+  w = [coordp3[0] - coordo[0], coordp3[1] - coordo[1], coordp3[2] - coordo[2]]
+  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])
+  logging.debug('pm=%s', pm)
+  return pm
+