OCCT

// Created on: 1997-11-06
// Created by: Roman BORISOV
// Copyright (c) 1997-1999 Matra Datavision
// Copyright (c) 1999-2014 OPEN CASCADE SAS
//
// This file is part of Open CASCADE Technology software library.
//
// This library is free software; you can redistribute it and/or modify it under
// the terms of the GNU Lesser General Public License version 2.1 as published
// by the Free Software Foundation, with special exception defined in the file
// OCCT_LGPL_EXCEPTION.txt. Consult the file LICENSE_LGPL_21.txt included in OCCT
// distribution for complete text of the license and disclaimer of any warranty.
//
// Alternatively, this file may be used under the terms of Open CASCADE
// commercial license or contractual agreement.

#include <Adaptor3d_Surface.hxx>
#include <gp_Pnt2d.hxx>
#include <math_FunctionSetRoot.hxx>
#include <math_NewtonFunctionSetRoot.hxx>
#include <ProjLib_PrjFunc.hxx>
#include <ProjLib_PrjResolve.hxx>
#include <Standard_ConstructionError.hxx>
#include <StdFail_NotDone.hxx>

ProjLib_PrjResolve::ProjLib_PrjResolve(const Adaptor3d_Curve&   C,
                                       const Adaptor3d_Surface& S,
                                       const int                Fix)
    : myDone(false),
      myFix(Fix)
{
  if (myFix > 3 || myFix < 1)
  {
    throw Standard_ConstructionError();
  }
  mySolution = gp_Pnt2d(0., 0.);
  myCurve    = &C;
  mySurface  = &S;
}

// void ProjLib_PrjResolve::Perform(const double t, const double U, const
// double  V, const gp_Pnt2d& Tol2d, const gp_Pnt2d& Inf, const gp_Pnt2d& Sup, const
// double FuncTol, const bool StrictInside)
void ProjLib_PrjResolve::Perform(const double    t,
                                 const double    U,
                                 const double    V,
                                 const gp_Pnt2d& Tol2d,
                                 const gp_Pnt2d& Inf,
                                 const gp_Pnt2d& Sup,
                                 const double    FuncTol,
                                 const bool)
{

  myDone             = false;
  double      FixVal = 0.;
  gp_Pnt2d    ExtInf(0., 0.), ExtSup(0., 0.);
  double      ExtU = 10 * Tol2d.X(), ExtV = 10 * Tol2d.Y();
  math_Vector Tol(1, 2), Start(1, 2), BInf(1, 2), BSup(1, 2);

  ExtInf.SetCoord(Inf.X() - ExtU, Inf.Y() - ExtV);
  ExtSup.SetCoord(Sup.X() + ExtU, Sup.Y() + ExtV);
  BInf(1) = ExtInf.X();
  BInf(2) = ExtInf.Y();
  BSup(1) = ExtSup.X();
  BSup(2) = ExtSup.Y();
  Tol(1)  = Tol2d.X();
  Tol(2)  = Tol2d.Y();

  switch (myFix)
  {
    case 1:
      Start(1) = U;
      Start(2) = V;
      FixVal   = t;
      break;
    case 2:
      Start(1) = t;
      Start(2) = V;
      FixVal   = U;
      break;
    case 3:
      Start(1) = t;
      Start(2) = U;
      FixVal   = V;
  }

  ProjLib_PrjFunc F(myCurve, FixVal, mySurface, myFix);

  //  int option = 1;//2;
  //  if (option == 1) {
  //    math_FunctionSetRoot S1 (F, Start,Tol, BInf, BSup);
  //    if (!S1.IsDone()) { return; }
  //  }
  //  else {
  math_NewtonFunctionSetRoot SR(F, Tol, FuncTol);
  SR.Perform(F, Start, BInf, BSup);
  //    if (!SR.IsDone()) { return; }
  if (!SR.IsDone())
  {
    math_FunctionSetRoot S1(F, Tol);
    S1.Perform(F, Start, BInf, BSup);

    if (!S1.IsDone())
    {
      return;
    }
  }

  mySolution.SetXY(F.Solution().XY());

  // computation of myDone
  myDone = true;

  double ExtraU, ExtraV;
  //  if(!StrictInside) {
  ExtraU = 2. * Tol2d.X();
  ExtraV = 2. * Tol2d.Y();
  //  }
  if (mySolution.X() > Inf.X() - Tol2d.X() && mySolution.X() < Inf.X())
  {
    mySolution.SetX(Inf.X());
  }
  if (mySolution.X() > Sup.X() && mySolution.X() < Sup.X() + Tol2d.X())
  {
    mySolution.SetX(Sup.X());
  }
  if (mySolution.Y() > Inf.Y() - Tol2d.Y() && mySolution.Y() < Inf.Y())
  {
    mySolution.SetY(Inf.Y());
  }
  if (mySolution.Y() > Sup.Y() && mySolution.Y() < Sup.Y() + Tol2d.Y())
  {
    mySolution.SetY(Sup.Y());
  }
  if (mySolution.X() < Inf.X() - ExtraU || mySolution.X() > Sup.X() + ExtraU
      || mySolution.Y() < Inf.Y() - ExtraV || mySolution.Y() > Sup.Y() + ExtraV)
  {
    myDone = false;
  }
  else if (FuncTol > 0)
  {
    math_Vector X(1, 2, 0.), FVal(1, 2, 0.);
    X(1) = mySolution.X();
    X(2) = mySolution.Y();

    F.Value(X, FVal);

    if (!SR.IsDone())
    {
      if ((FVal(1) * FVal(1) + FVal(2) * FVal(2)) > FuncTol)
      {
        myDone = false;
      }
    }
  }
}

bool ProjLib_PrjResolve::IsDone() const
{
  return myDone;
}

gp_Pnt2d ProjLib_PrjResolve::Solution() const
{
  if (!IsDone())
  {
    throw StdFail_NotDone();
  }
  return mySolution;
}