OCC22540 Regression: Exception during building of patch by GeomPlate
[occt.git] / src / Extrema / Extrema_GenExtPS.cxx
index 06d3f1f..0cf3008 100755 (executable)
 #include <math_Vector.hxx>
 #include <math_NewtonFunctionSetRoot.hxx>
 #include <GeomAbs_IsoType.hxx>
+#include <Bnd_Sphere.hxx>
+#include <Extrema_HUBTreeOfSphere.hxx>
+#include <Extrema_ExtFlag.hxx>
+#include <Bnd_Array1OfSphere.hxx>
+#include <Bnd_HArray1OfSphere.hxx>
 
+//IMPLEMENT_HARRAY1(Extrema_HArray1OfSphere)
+
+
+class Bnd_SphereUBTreeSelector : public Extrema_UBTreeOfSphere::Selector
+{
+ public:
+
+  Bnd_SphereUBTreeSelector (const Handle(Bnd_HArray1OfSphere)& theSphereArray,
+Bnd_Sphere& theSol)
+    : myXYZ(0,0,0),
+      mySphereArray(theSphereArray),
+      mySol(theSol)
+  {
+    //myXYZ = gp_Pnt(0, 0, 0);    
+  }
+
+  void DefineCheckPoint( const gp_Pnt& theXYZ )
+  { myXYZ = theXYZ; }
+
+  Bnd_Sphere& Sphere() const
+  { return mySol; }
+
+  virtual Standard_Boolean Reject( const Bnd_Sphere &theBnd ) const = 0;
+  
+  virtual Standard_Boolean Accept(const Standard_Integer& theObj) = 0;
+
+ protected:
+  gp_Pnt                      myXYZ;
+  const Handle(Bnd_HArray1OfSphere)& mySphereArray;
+  Bnd_Sphere&                                           mySol;
+
+};
+
+class Bnd_SphereUBTreeSelectorMin : public Bnd_SphereUBTreeSelector
+{
+public:
+  Bnd_SphereUBTreeSelectorMin (const Handle(Bnd_HArray1OfSphere)& theSphereArray,
+               Bnd_Sphere& theSol)
+               : Bnd_SphereUBTreeSelector(theSphereArray, theSol),
+                 myMinDist(RealLast())
+  {}
+  
+  void SetMinDist( const Standard_Real theMinDist )
+  { myMinDist = theMinDist; }
+
+  Standard_Real MinDist() const
+  { return myMinDist; }
+
+  Standard_Boolean Reject( const Bnd_Sphere &theBnd ) const
+  { 
+    Bnd_SphereUBTreeSelectorMin* me =
+      const_cast<Bnd_SphereUBTreeSelectorMin*>(this);
+    // myMinDist is decreased each time a nearer object is found
+    return theBnd.IsOut( myXYZ.XYZ(), me->myMinDist );
+  }
+
+  Standard_Boolean Accept(const Standard_Integer&);
+
+private:
+       Standard_Real   myMinDist;
+};
+
+Standard_Boolean Bnd_SphereUBTreeSelectorMin::Accept(const Standard_Integer& theInd)
+{
+  const Bnd_Sphere& aSph = mySphereArray->Value(theInd);
+  Standard_Real aCurDist;
+
+    if ( (aCurDist = aSph.SquareDistance(myXYZ.XYZ())) < mySol.SquareDistance(myXYZ.XYZ()) )
+    {
+      mySol = aSph;
+      if ( aCurDist < myMinDist ) 
+        myMinDist = aCurDist;
+
+      return Standard_True;
+    }
+
+  return Standard_False;
+}
+
+class Bnd_SphereUBTreeSelectorMax : public Bnd_SphereUBTreeSelector
+{
+public:
+  Bnd_SphereUBTreeSelectorMax (const Handle(Bnd_HArray1OfSphere)& theSphereArray,
+               Bnd_Sphere& theSol)
+               : Bnd_SphereUBTreeSelector(theSphereArray, theSol),
+                 myMaxDist(0)
+  {}
+
+  void SetMaxDist( const Standard_Real theMaxDist )
+  { myMaxDist = theMaxDist; }
+
+  Standard_Real MaxDist() const
+  { return myMaxDist; }
+
+  Standard_Boolean Reject( const Bnd_Sphere &theBnd ) const
+  { 
+    Bnd_SphereUBTreeSelectorMax* me =
+      const_cast<Bnd_SphereUBTreeSelectorMax*>(this);
+    // myMaxDist is decreased each time a nearer object is found
+    return theBnd.IsOut( myXYZ.XYZ(), me->myMaxDist );
+  }
+
+  Standard_Boolean Accept(const Standard_Integer&);
+
+private:
+       Standard_Real   myMaxDist;
+};
+
+Standard_Boolean Bnd_SphereUBTreeSelectorMax::Accept(const Standard_Integer& theInd)
+{
+  const Bnd_Sphere& aSph = mySphereArray->Value(theInd);
+  Standard_Real aCurDist;
+
+    if ( (aCurDist = aSph.SquareDistance(myXYZ.XYZ())) > mySol.SquareDistance(myXYZ.XYZ()) )
+    {
+      mySol = aSph;
+      if ( aCurDist > myMaxDist ) 
+        myMaxDist = aCurDist;
+
+      return Standard_True;
+    }
+
+  return Standard_False;
+}
 
 
 
 //=============================================================================
 
 /*-----------------------------------------------------------------------------
-Fonction:
-   Recherche de toutes les distances extremales entre le point P et la surface
-  S a partir d'un echantillonnage (NbU,NbV).
+Function:
+   Find all extremum distances between point P and surface
+  S using sampling (NbU,NbV).
 
-Methode:
-   L'algorithme part de l'hypothese que l'echantillonnage est suffisamment fin
+Method:
+   The algorithm bases on the hypothesis that sampling is precise enough 
   pour que, s'il existe N distances extremales entre le point et la surface,
   alors il existe aussi N extrema entre le point et la grille.
-  Ainsi, l'algorithme consiste a partir des extrema de la grille pour trouver
-  les extrema de la surface.
-   Les extrema sont calcules par l'algorithme math_FunctionSetRoot avec les
-  arguments suivants:
-  - F: Extrema_FuncExtPS cree a partir de P et S,
-  - UV: math_Vector dont les composantes sont les parametres de l'extremum sur
-    la grille,
-  - Tol: Min(TolU,TolV), (Prov.:math_FunctionSetRoot n'autorise pas un vecteur)
-  - UVinf: math_Vector dont les composantes sont les bornes inferieures de u et
-    v,
-  - UVsup: math_Vector dont les composantes sont les bornes superieures de u et
-    v.
-
-Traitement:
-  a- Constitution du tableau des distances (TbDist(0,NbU+1,0,NbV+1)):
-      Le tableau est volontairement etendu; les lignes 0 et NbU+1 et les
-     colonnes 0 et NbV+1 seront initialisees a RealFirst() ou RealLast()
-     pour simplifier les tests effectues dans l'etape b
-     (on n'a pas besoin de tester si le point est sur un bord de la grille).
-  b- Calcul des extrema:
-      On recherche d'abord les minima et ensuite les maxima. Ces 2 traitements
-     se passent de facon similaire:
-  b.a- Initialisations:
-      - des 'bords' du tableau TbDist (a RealLast() dans le cas des minima
-        et a RealLast() dans le cas des maxima),
-      - du tableau TbSel(0,NbU+1,0,NbV+1) de selection des points pour un
-        calcul d'extremum local (a 0). Lorsqu'un point sera selectionne,
-       il ne sera plus selectionnable, ainsi que ses points adjacents
-       (8 au maximum). Les adresses correspondantes seront mises a 1.
-  b.b- Calcul des minima (ou maxima):
-       On boucle sur toutes les distances du tableau TbDist:
-      - recherche d'un minimum (ou maximum) sur la grille,
-      - calcul de l'extremum sur la surface,
-      - mise a jour du tableau TbSel.
+  So, the algorithm consists in starting from extrema of the grid to find the 
+  extrema of the surface.
+  The extrema are calculated by the algorithm math_FunctionSetRoot with the
+  following arguments:
+  - F: Extrema_FuncExtPS created from P and S,
+  - UV: math_Vector the components which of are parameters of the extremum on the 
+    grid,
+  - Tol: Min(TolU,TolV), (Prov.:math_FunctionSetRoot does not autorize a vector)
+  - UVinf: math_Vector the components which of are lower limits of u and v,
+  - UVsup: math_Vector the components which of are upper limits of u and v.
+
+Processing:
+  a- Creation of the table of distances (TbDist(0,NbU+1,0,NbV+1)):
+     The table is expanded at will; lines 0 and NbU+1 and
+     columns 0 and NbV+1 are initialized at RealFirst() or RealLast()
+     to simplify the tests carried out at stage b
+     (there is no need to test if the point is on border of the grid).
+  b- Calculation of extrema:
+     First the minimums and then the maximums are found. These 2 procedured 
+     pass in a similar way:
+  b.a- Initialization:
+      - 'borders' of table  TbDist (RealLast() in case of minimums
+        and  RealLast() in case of maximums),
+      - table TbSel(0,NbU+1,0,NbV+1) of selection of points for 
+        calculation of local extremum (0). When a point will selected,
+       it will not be selectable, as well as the ajacent points 
+       (8 at least). The corresponding addresses will be set to 1.
+  b.b- Calculation of minimums (or maximums):
+       All distances from table TbDist are parsed in a loop:
+      - search minimum (or maximum) in the grid,
+      - calculate extremum on the surface,
+      - update table TbSel.
 -----------------------------------------------------------------------------*/
 
 static Standard_Boolean IsoIsDeg  (const Adaptor3d_Surface& S,
@@ -117,6 +244,8 @@ Extrema_GenExtPS::Extrema_GenExtPS()
 {
   myDone = Standard_False;
   myInit = Standard_False;
+  myFlag = Extrema_ExtFlag_MINMAX;
+  myAlgo = Extrema_ExtAlgo_Grad;
 }
 
 
@@ -125,8 +254,10 @@ Extrema_GenExtPS::Extrema_GenExtPS (const gp_Pnt&          P,
                              const Standard_Integer NbU, 
                              const Standard_Integer NbV,
                              const Standard_Real    TolU, 
-                             const Standard_Real    TolV) 
-: myF (P,S)
+                              const Standard_Real    TolV,
+                              const Extrema_ExtFlag F,
+                              const Extrema_ExtAlgo A) 
+  : myF (P,S), myFlag(F), myAlgo(A)
 {
   Initialize(S, NbU, NbV, TolU, TolV);
   Perform(P);
@@ -141,8 +272,10 @@ Extrema_GenExtPS::Extrema_GenExtPS (const gp_Pnt&          P,
                              const Standard_Real    Vmin,
                              const Standard_Real    Vsup,
                              const Standard_Real    TolU, 
-                             const Standard_Real    TolV) 
-: myF (P,S)
+                              const Standard_Real    TolV,
+                              const Extrema_ExtFlag F,
+                              const Extrema_ExtAlgo A) 
+  : myF (P,S), myFlag(F), myAlgo(A)
 {
   Initialize(S, NbU, NbV, Umin, Usup, Vmin, Vsup, TolU, TolV);
   Perform(P);
@@ -189,7 +322,35 @@ void Extrema_GenExtPS::Initialize(const Adaptor3d_Surface& S,
 
   myF.Initialize(S);
 
-  mypoints = new TColgp_HArray2OfPnt(0,myusample+1,0,myvsample+1);
+  mySphereUBTree.Nullify();
+
+  if(myAlgo == Extrema_ExtAlgo_Grad)
+  {
+         //If flag was changed and extrema not reinitialized Extrema would fail
+    mypoints = new TColgp_HArray2OfPnt(0,myusample+1,0,myvsample+1);
+  Standard_Real PasU = myusup - myumin;
+  Standard_Real PasV = myvsup - myvmin;
+  Standard_Real U0 = PasU / myusample / 100.;
+  Standard_Real V0 = PasV / myvsample / 100.;
+  gp_Pnt P1;
+  PasU = (PasU - U0) / (myusample - 1);
+  PasV = (PasV - V0) / (myvsample - 1);
+  U0 = U0/2. + myumin;
+  V0 = V0/2. + myvmin;
+
+// Calcul des distances
+
+  Standard_Integer NoU, NoV;
+  Standard_Real U, V;
+  for ( NoU = 1, U = U0; NoU <= myusample; NoU++, U += PasU) {
+    for ( NoV = 1, V = V0; NoV <= myvsample; NoV++, V += PasV) {
+      P1 = myS->Value(U, V);
+      mypoints->SetValue(NoU,NoV,P1);
+    }
+  }
+  }
+
+  //mypoints = new TColgp_HArray2OfPnt(0,myusample+1,0,myvsample+1);
 
 /*
 a- Constitution du tableau des distances (TbDist(0,myusample+1,0,myvsample+1)):
@@ -198,6 +359,15 @@ a- Constitution du tableau des distances (TbDist(0,myusample+1,0,myvsample+1)):
 
 // Parametrage de l echantillon
 
+
+}
+
+void Extrema_GenExtPS::BuildTree()
+{
+  // if tree already exists, assume it is already correctly filled
+  if ( ! mySphereUBTree.IsNull() )
+    return;
+
   Standard_Real PasU = myusup - myumin;
   Standard_Real PasV = myvsup - myvmin;
   Standard_Real U0 = PasU / myusample / 100.;
@@ -208,34 +378,131 @@ a- Constitution du tableau des distances (TbDist(0,myusample+1,0,myvsample+1)):
   U0 = U0/2. + myumin;
   V0 = V0/2. + myvmin;
 
-// Calcul des distances
-
-  Standard_Integer NoU, NoV;
+  // Calcul des distances
+  mySphereUBTree = new Extrema_UBTreeOfSphere;
+  Extrema_UBTreeFillerOfSphere aFiller(*mySphereUBTree);
+  Standard_Integer i = 0;
   Standard_Real U, V;
+  mySphereArray = new Bnd_HArray1OfSphere(0, myusample * myvsample);
+  Standard_Integer NoU, NoV;
   for ( NoU = 1, U = U0; NoU <= myusample; NoU++, U += PasU) {
     for ( NoV = 1, V = V0; NoV <= myvsample; NoV++, V += PasV) {
       P1 = myS->Value(U, V);
-      mypoints->SetValue(NoU,NoV,P1);
+      Bnd_Sphere aSph(P1.XYZ(), 0/*mytolu < mytolv ? mytolu : mytolv*/, NoU, NoV);
+      aFiller.Add(i, aSph);
+      mySphereArray->SetValue( i, aSph );
+      i++;
+    }
+  }
+  aFiller.Fill();
+}
+
+void Extrema_GenExtPS::FindSolution(const gp_Pnt& P, const math_Vector& UV, const Standard_Real PasU, const Standard_Real PasV, const Extrema_ExtFlag f)
+{
+  math_Vector Tol(1,2);
+  Tol(1) = mytolu;
+  Tol(2) = mytolv;
+
+  math_Vector UVinf(1,2), UVsup(1,2);
+  UVinf(1) = myumin;
+  UVinf(2) = myvmin;
+  UVsup(1) = myusup;
+  UVsup(2) = myvsup;
+
+  math_Vector errors(1,2);
+  math_Vector root(1, 2);
+  Standard_Real eps = 1.e-9;
+  Standard_Integer nbsubsample = 11;
+
+  Standard_Integer aNbMaxIter = 100;
+
+  if (myF.HasDegIso())
+    aNbMaxIter = 150;
+
+  math_FunctionSetRoot S (myF,UV,Tol,UVinf,UVsup, aNbMaxIter);
+  if(S.IsDone()) {
+    root = S.Root();
+    myF.Value(root, errors);
+    if(f == Extrema_ExtFlag_MIN) 
+    {
+      if(Abs(errors(1)) > eps || Abs(errors(2)) > eps) {
+        //try to improve solution on subgrid of sample points
+        gp_Pnt PSol = myS->Value(root(1), root(2));
+        Standard_Real DistSol = P.SquareDistance(PSol);
+
+        Standard_Real u1 = Max(UV(1) - PasU, myumin), u2 = Min(UV(1) + PasU, myusup);
+        Standard_Real v1 = Max(UV(2) - PasV, myvmin), v2 = Min(UV(2) + PasV, myvsup);
+
+        if(u2 - u1 < 2.*PasU) {
+          if(Abs(u1 - myumin) < 1.e-9) {
+            u2 = u1 + 2.*PasU;
+            u2 = Min(u2, myusup);
+          }
+          if(Abs(u2 - myusup) < 1.e-9) {
+            u1 = u2 - 2.*PasU;
+            u1 = Max(u1, myumin);
+          }
+        }
+
+        if(v2 - v1 < 2.*PasV) {
+          if(Abs(v1 - myvmin) < 1.e-9) {
+            v2 = v1 + 2.*PasV;
+            v2 = Min(v2, myvsup);
+          }
+          if(Abs(v2 - myvsup) < 1.e-9) {
+            v1 = v2 - 2.*PasV;
+            v1 = Max(v1, myvmin);
+          }
+        }
+
+        Standard_Real du = (u2 - u1)/(nbsubsample-1);
+        Standard_Real dv = (v2 - v1)/(nbsubsample-1);
+        Standard_Real u, v;
+        Standard_Real dist;
+
+        Standard_Boolean NewSolution = Standard_False;
+        Standard_Integer Nu, Nv;
+        for (Nu = 1, u = u1; Nu < nbsubsample; Nu++, u += du) {
+          for (Nv = 1, v = v1; Nv < nbsubsample; Nv++, v += dv) {
+            gp_Pnt Puv = myS->Value(u, v);
+            dist = P.SquareDistance(Puv);
+
+            if(dist < DistSol) {
+              UV(1) = u;
+              UV(2) = v;
+              NewSolution = Standard_True;
+              DistSol = dist;
+            }
+          }
+        }
+
+        if(NewSolution) {
+          //try to precise
+          math_FunctionSetRoot S (myF,UV,Tol,UVinf,UVsup, aNbMaxIter);
+        }
+
+      }
     }
   }
+  myDone = Standard_True;
 }
 
+void Extrema_GenExtPS::SetFlag(const Extrema_ExtFlag F)
+{
+  myFlag = F;
+}
 
+void Extrema_GenExtPS::SetAlgo(const Extrema_ExtAlgo A)
+{
+  myAlgo = A;
+}
 
 void Extrema_GenExtPS::Perform(const gp_Pnt& P) 
 {  
+  //BuildTree();
   myDone = Standard_False;
   myF.SetPoint(P);
 
-
-/*
-b- Calcul des minima:
-   -----------------
-   b.a) Initialisations:
-*/
-
-// Parametrage de l echantillon
-
   Standard_Real PasU = myusup - myumin;
   Standard_Real PasV = myvsup - myvmin;
   Standard_Real U, U0 = PasU / myusample / 100.;
@@ -245,211 +512,123 @@ b- Calcul des minima:
   U0 = U0/2.+myumin;
   V0 = V0/2.+myvmin;
 
-//     - generales
-  math_Vector Tol(1, 2);
-  Tol(1) = mytolu;
-  Tol(2) = mytolv;
-  math_Vector UV(1,2), UVinf(1,2), UVsup(1,2);
-  UVinf(1) = myumin;
-  UVinf(2) = myvmin;
-  UVsup(1) = myusup;
-  UVsup(2) = myvsup;
+  //math_Vector Tol(1, 2);
+  math_Vector UV(1,2);
 
-//     - des 'bords' du tableau mytbdist
-  Standard_Integer NoU,NoV;
+  if(myAlgo == Extrema_ExtAlgo_Grad)
+  {
+    Standard_Integer NoU,NoV;
 
-  TColStd_Array2OfReal TheDist(0, myusample+1, 0, myvsample+1);
-  for ( NoU = 1, U = U0; NoU <= myusample; NoU++, U += PasU) {
-    for ( NoV = 1, V = V0; NoV <= myvsample; NoV++, V += PasV) {
-      TheDist(NoU, NoV) = P.SquareDistance(mypoints->Value(NoU, NoV));
+    TColStd_Array2OfReal TheDist(0, myusample+1, 0, myvsample+1);
+    for ( NoU = 1, U = U0; NoU <= myusample; NoU++, U += PasU) {
+      for ( NoV = 1, V = V0; NoV <= myvsample; NoV++, V += PasV) {
+        TheDist(NoU, NoV) = P.SquareDistance(mypoints->Value(NoU, NoV));
+      }
     }
-  }
-  
-  for (NoV = 0; NoV <= myvsample+1; NoV++) {
-    TheDist(0,NoV) = RealLast();
-    TheDist(myusample+1,NoV) = RealLast();
-  }
-  for (NoU = 1; NoU <= myusample; NoU++) {
-    TheDist(NoU,0) = RealLast();
-    TheDist(NoU,myvsample+1) = RealLast();
-  }
 
-//     - du tableau TbSel(0,myusample+1,0,myvsample+1) de selection des points
-  TColStd_Array2OfInteger TbSel(0,myusample+1,0,myvsample+1);
-  TbSel.Init(0);
-/*
-   b.b) Calcul des minima:
-*/
-//     - recherche d un minimum sur la grille
-  math_Vector errors(1,2);
-  math_Vector root(1, 2);
-  Standard_Real eps = 1.e-9;
-  Standard_Integer nbsubsample = 11;
-  Standard_Integer Nu, Nv;
-  Standard_Real Dist;
-  for (NoU = 1; NoU <= myusample; NoU++) {
-    for (NoV = 1; NoV <= myvsample; NoV++) {
-      if (TbSel(NoU,NoV) == 0) {
-       Dist = TheDist(NoU,NoV);
-       if ((TheDist(NoU-1,NoV-1) >= Dist) &&
-           (TheDist(NoU-1,NoV  ) >= Dist) &&
-           (TheDist(NoU-1,NoV+1) >= Dist) &&
-           (TheDist(NoU  ,NoV-1) >= Dist) &&
-           (TheDist(NoU  ,NoV+1) >= Dist) &&
-           (TheDist(NoU+1,NoV-1) >= Dist) &&
-           (TheDist(NoU+1,NoV  ) >= Dist) &&
-           (TheDist(NoU+1,NoV+1) >= Dist)) {
-
-//     - calcul de l extremum sur la surface:
-         UV(1) = U0 + (NoU - 1) * PasU;
-         UV(2) = V0 + (NoV - 1) * PasV;
-//  Modified by skv - Thu Sep 30 15:21:07 2004 OCC593 Begin
-//       math_FunctionSetRoot S (myF,UV,Tol,UVinf,UVsup);
-          // Default value for math_FunctionSetRoot.
-         Standard_Integer aNbMaxIter = 100;
-
-         if (myF.HasDegIso())
-           aNbMaxIter = 150;
-
-         math_FunctionSetRoot S (myF,UV,Tol,UVinf,UVsup, aNbMaxIter);
-         if(S.IsDone()) {
-           root = S.Root();
-           myF.Value(root, errors);
-           if(Abs(errors(1)) > eps || Abs(errors(2)) > eps) {
-             //try to improve solution on subgrid of sample points
-             gp_Pnt PSol = myS->Value(root(1), root(2));
-             Standard_Real DistSol = P.SquareDistance(PSol);
-
-             Standard_Real u1 = Max(UV(1) - PasU, myumin), u2 = Min(UV(1) + PasU, myusup);
-             Standard_Real v1 = Max(UV(2) - PasV, myvmin), v2 = Min(UV(2) + PasV, myvsup);
-             
-             if(u2 - u1 < 2.*PasU) {
-               if(Abs(u1 - myumin) < 1.e-9) {
-                 u2 = u1 + 2.*PasU;
-                 u2 = Min(u2, myusup);
-               }
-               if(Abs(u2 - myusup) < 1.e-9) {
-                 u1 = u2 - 2.*PasU;
-                 u1 = Max(u1, myumin);
-               }
-             }
-
-             if(v2 - v1 < 2.*PasV) {
-               if(Abs(v1 - myvmin) < 1.e-9) {
-                 v2 = v1 + 2.*PasV;
-                 v2 = Min(v2, myvsup);
-               }
-               if(Abs(v2 - myvsup) < 1.e-9) {
-                 v1 = v2 - 2.*PasV;
-                 v1 = Max(v1, myvmin);
-               }
-             }
-
-             Standard_Real du = (u2 - u1)/(nbsubsample-1);
-             Standard_Real dv = (v2 - v1)/(nbsubsample-1);
-             Standard_Real u, v;
-             Standard_Real dist;
-
-             Standard_Boolean NewSolution = Standard_False;
-             for (Nu = 1, u = u1; Nu < nbsubsample; Nu++, u += du) {
-               for (Nv = 1, v = v1; Nv < nbsubsample; Nv++, v += dv) {
-                 gp_Pnt Puv = myS->Value(u, v);
-                 dist = P.SquareDistance(Puv);
-                 
-                 if(dist < DistSol) {
-                   UV(1) = u;
-                   UV(2) = v;
-                   NewSolution = Standard_True;
-                   DistSol = dist;
-                 }
-               }
-             }
-             if(NewSolution) {
-               //try to precise
-               math_FunctionSetRoot S (myF,UV,Tol,UVinf,UVsup, aNbMaxIter);
-             }
-
-           }
-         }
-//  Modified by skv - Thu Sep 30 15:21:07 2004 OCC593 End
-      
-//     - mise a jour du tableau TbSel    
-         for (Nu = NoU-1; Nu <= NoU+1; Nu++) {
-           for (Nv = NoV-1; Nv <= NoV+1; Nv++) {
-             TbSel(Nu,Nv) = 1;
-           }
-         }
-       }
-      } // if (TbSel(NoU,NoV)
-    } // for (NoV = 1; ...
-  } // for (NoU = 1; ...
-/*
-c- Calcul des maxima:
-   -----------------
-   c.a) Initialisations:
-*/
-//     - des 'bords' du tableau mytbdist
-  for (NoV = 0; NoV <= myvsample+1; NoV++) {
-    TheDist(0,NoV) = RealFirst();
-    TheDist(myusample+1,NoV) = RealFirst();
-  }
-  for (NoU = 1; NoU <= myusample; NoU++) {
-    TheDist(NoU,0) = RealFirst();
-    TheDist(NoU,myvsample+1) = RealFirst();
-  }
+    TColStd_Array2OfInteger TbSel(0,myusample+1,0,myvsample+1);
+    TbSel.Init(0);
+
+    Standard_Real Dist;
 
-//     - du tableau TbSel(0,myusample+1,0,myvsample+1) de selection des points
-  for (NoU = 0; NoU <= myusample+1; NoU++) {
-    for (NoV = 0; NoV <= myvsample+1; NoV++) {
-      TbSel(NoU,NoV) = 0;
+    if(myFlag == Extrema_ExtFlag_MIN || myFlag == Extrema_ExtFlag_MINMAX) 
+    {
+      for (NoV = 0; NoV <= myvsample+1; NoV++) {
+        TheDist(0,NoV) = RealLast();
+        TheDist(myusample+1,NoV) = RealLast();
+      }
+      for (NoU = 1; NoU <= myusample; NoU++) {
+        TheDist(NoU,0) = RealLast();
+        TheDist(NoU,myvsample+1) = RealLast();
+      }
+      for (NoU = 1; NoU <= myusample; NoU++) {
+        for (NoV = 1; NoV <= myvsample; NoV++) {
+          if (TbSel(NoU,NoV) == 0) {
+            Dist = TheDist(NoU,NoV);
+            if ((TheDist(NoU-1,NoV-1) >= Dist) &&
+              (TheDist(NoU-1,NoV  ) >= Dist) &&
+              (TheDist(NoU-1,NoV+1) >= Dist) &&
+              (TheDist(NoU  ,NoV-1) >= Dist) &&
+              (TheDist(NoU  ,NoV+1) >= Dist) &&
+              (TheDist(NoU+1,NoV-1) >= Dist) &&
+              (TheDist(NoU+1,NoV  ) >= Dist) &&
+              (TheDist(NoU+1,NoV+1) >= Dist)) {
+                //Create array of UV vectors to calculate min
+                UV(1) = U0 + (NoU - 1) * PasU;
+                UV(2) = V0 + (NoV - 1) * PasV;
+                FindSolution(P, UV, PasU, PasV, Extrema_ExtFlag_MIN);
+            }
+          }
+        }
+      }
+    }
+    
+    if(myFlag == Extrema_ExtFlag_MAX || myFlag == Extrema_ExtFlag_MINMAX)
+    {
+      for (NoV = 0; NoV <= myvsample+1; NoV++) {
+        TheDist(0,NoV) = RealFirst();
+        TheDist(myusample+1,NoV) = RealFirst();
+      }
+      for (NoU = 1; NoU <= myusample; NoU++) {
+        TheDist(NoU,0) = RealFirst();
+        TheDist(NoU,myvsample+1) = RealFirst();
+      }
+      for (NoU = 1; NoU <= myusample; NoU++) {
+        for (NoV = 1; NoV <= myvsample; NoV++) {
+          if (TbSel(NoU,NoV) == 0) {
+            Dist = TheDist(NoU,NoV);
+            if ((TheDist(NoU-1,NoV-1) <= Dist) &&
+              (TheDist(NoU-1,NoV  ) <= Dist) &&
+              (TheDist(NoU-1,NoV+1) <= Dist) &&
+              (TheDist(NoU  ,NoV-1) <= Dist) &&
+              (TheDist(NoU  ,NoV+1) <= Dist) &&
+              (TheDist(NoU+1,NoV-1) <= Dist) &&
+              (TheDist(NoU+1,NoV  ) <= Dist) &&
+              (TheDist(NoU+1,NoV+1) <= Dist)) {
+                //Create array of UV vectors to calculate max
+                UV(1) = U0 + (NoU - 1) * PasU;
+                UV(2) = V0 + (NoV - 1) * PasV;
+                FindSolution(P, UV, PasU, PasV, Extrema_ExtFlag_MAX);
+            }
+          }
+        }
+      }
+    }
+  }
+  else
+  {
+    BuildTree();
+    if(myFlag == Extrema_ExtFlag_MIN || myFlag == Extrema_ExtFlag_MINMAX)
+    {
+      Bnd_Sphere aSol = mySphereArray->Value(0);
+      Bnd_SphereUBTreeSelectorMin aSelector(mySphereArray, aSol);
+      //aSelector.SetMaxDist( RealLast() );
+      aSelector.DefineCheckPoint( P );
+      Standard_Integer aNbSel = mySphereUBTree->Select( aSelector );
+      //TODO: check if no solution in binary tree
+      Bnd_Sphere& aSph = aSelector.Sphere();
+
+      UV(1) = U0 + (aSph.U() - 1) * PasU;
+      UV(2) = V0 + (aSph.V() - 1) * PasV;
+
+      FindSolution(P, UV, PasU, PasV, Extrema_ExtFlag_MIN);
+    }
+    if(myFlag == Extrema_ExtFlag_MAX || myFlag == Extrema_ExtFlag_MINMAX)
+    {
+      Bnd_Sphere aSol = mySphereArray->Value(0);
+      Bnd_SphereUBTreeSelectorMax aSelector(mySphereArray, aSol);
+      //aSelector.SetMaxDist( RealLast() );
+      aSelector.DefineCheckPoint( P );
+      Standard_Integer aNbSel = mySphereUBTree->Select( aSelector );
+      //TODO: check if no solution in binary tree
+      Bnd_Sphere& aSph = aSelector.Sphere();
+
+      UV(1) = U0 + (aSph.U() - 1) * PasU;
+      UV(2) = V0 + (aSph.V() - 1) * PasV;
+
+      FindSolution(P, UV, PasU, PasV, Extrema_ExtFlag_MAX);
     }
   }
-/*
-   c.b) Calcul des maxima:
-*/
-//     - recherche d un maximum sur la grille
-  for (NoU = 1; NoU <= myusample; NoU++) {
-    for (NoV = 1; NoV <= myvsample; NoV++) {
-      if (TbSel(NoU,NoV) == 0) {
-       Dist = TheDist(NoU,NoV);
-       if ((TheDist(NoU-1,NoV-1) <= Dist) &&
-           (TheDist(NoU-1,NoV  ) <= Dist) &&
-           (TheDist(NoU-1,NoV+1) <= Dist) &&
-           (TheDist(NoU  ,NoV-1) <= Dist) &&
-           (TheDist(NoU  ,NoV+1) <= Dist) &&
-           (TheDist(NoU+1,NoV-1) <= Dist) &&
-           (TheDist(NoU+1,NoV  ) <= Dist) &&
-           (TheDist(NoU+1,NoV+1) <= Dist)) {
-
-//     - calcul de l extremum sur la surface:
-         UV(1) = U0 + (NoU - 1) * PasU;
-         UV(2) = V0 + (NoV - 1) * PasV;
-//  Modified by skv - Thu Sep 30 15:21:07 2004 OCC593 Begin
-//       math_FunctionSetRoot S (myF,UV,Tol,UVinf,UVsup);
-          // Default value for math_FunctionSetRoot.
-         Standard_Integer aNbMaxIter = 100;
-
-         if (myF.HasDegIso())
-           aNbMaxIter = 150;
-
-         math_FunctionSetRoot S (myF,UV,Tol,UVinf,UVsup, aNbMaxIter);
-         if(S.IsDone()) {
-           root = S.Root();
-           myF.Value(root, errors);
-         }
-//  Modified by skv - Thu Sep 30 15:21:07 2004 OCC593 End
-      
-//     - mise a jour du tableau TbSel    
-         for (Nu = NoU-1; Nu <= NoU+1; Nu++) {
-           for (Nv = NoV-1; Nv <= NoV+1; Nv++) {
-             TbSel(Nu,Nv) = 1;
-           }
-         }
-       }
-      } // if (TbSel(NoU,NoV))
-    } // for (NoV = 1; ...)
-  } // for (NoU = 1; ...)
-  myDone = Standard_True;
 }
 //=============================================================================
 
@@ -476,4 +655,3 @@ Extrema_POnSurf Extrema_GenExtPS::Point (const Standard_Integer N) const
   return myF.Point(N);
 }
 //=============================================================================
-