2014-01-09 14:20:44 +00:00
|
|
|
# -*- coding: utf-8 -*-
|
|
|
|
|
|
|
|
|
|
import logging
|
2017-03-20 13:27:30 +01:00
|
|
|
from .geomsmesh import geompy
|
2014-01-09 14:20:44 +00:00
|
|
|
|
|
|
|
|
# -----------------------------------------------------------------------------
|
|
|
|
|
# --- 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
|
|
|
|
|
|
