src/Tools/blocFissure/gmu/projettePointSurCourbe.py

   1 # -*- coding: utf-8 -*-
   2
   3 from geomsmesh import geompy
   4 import logging
   5 import math
   6
   7 # -----------------------------------------------------------------------------
   8 # --- projection d'un point sur une courbe.
   9
  10 def projettePointSurCourbe(pt, edge):
  11   """
  12   projection d'un point p sur une courbe c
  13   on suppose que la distance (c(u), p) passe par un minimum quand u varie entre 0 et 1
  14   et qu'elle presente pas de minimum local
  15   """
  16   #logging.debug("start")
  17
  18   dist = []
  19   nbSlices = 50
  20   du = 1.0/nbSlices
  21   for i in range(nbSlices + 1):
  22     p = geompy.MakeVertexOnCurve(edge, du*i)
  23     d = geompy.MinDistance(p,pt)
  24     dist.append((d,i))
  25   dist.sort()
  26   #logging.debug("dist %s", dist)
  27   umin = du*dist[0][1]
  28   umax = du*dist[1][1]
  29   #umin = 0.0
  30   #umax = 1.0
  31   tol = 1.e-8
  32   pmin = geompy.MakeVertexOnCurve(edge, umin)
  33   pmax = geompy.MakeVertexOnCurve(edge, umax)
  34   dmin = geompy.MinDistance(pmin,pt)
  35   dmax = geompy.MinDistance(pmax,pt)
  36   dext = geompy.MinDistance(pmin,pmax)
  37   i=0
  38   while dext > tol and i < 100 :
  39     i = i+1
  40     utest = (umax + umin) / 2.0
  41     ptest = geompy.MakeVertexOnCurve(edge, utest)
  42     dtest = geompy.MinDistance(ptest,pt)
  43     if dmin < dmax:
  44       umax = utest
  45       pmax = ptest
  46       dmax = dtest
  47     else:
  48       umin = utest
  49       pmin = ptest
  50       dmin = dtest
  51     dext = geompy.MinDistance(pmin,pmax)
  52     #logging.debug('umin=%s umax=%s dmin=%s dmax=%s dtest=%s dext=%s', umin,umax,dmin,dmax,dtest,dext)
  53   if abs(utest) < 1.e-7:
  54     utest = 0.0
  55   if abs(1.0-utest) < 1.e-7:
  56     utest = 1.0
  57   logging.debug('u=%s, nbiter=%s dtest=%s dext=%s',utest,i,dtest,dext)
  58   return utest
  59