OCCT

// Created on: 1994-04-05
// Created by: Yves FRICAUD
// Copyright (c) 1994-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 <Bisector_BisecCC.hxx>
#include <Bisector_BisecPC.hxx>
#include <Bisector_Curve.hxx>
#include <Bisector_FunctionInter.hxx>
#include <Geom2d_Curve.hxx>
#include <gp.hxx>
#include <gp_Pnt2d.hxx>
#include <gp_Vec2d.hxx>
#include <Precision.hxx>

//=================================================================================================

Bisector_FunctionInter::Bisector_FunctionInter() = default;

//=================================================================================================

Bisector_FunctionInter::Bisector_FunctionInter(const occ::handle<Geom2d_Curve>&   C,
                                               const occ::handle<Bisector_Curve>& B1,
                                               const occ::handle<Bisector_Curve>& B2)
{
  curve     = C;
  bisector1 = B1;
  bisector2 = B2;
}

//=================================================================================================

void Bisector_FunctionInter::Perform(const occ::handle<Geom2d_Curve>&   C,
                                     const occ::handle<Bisector_Curve>& B1,
                                     const occ::handle<Bisector_Curve>& B2)
{
  curve     = C;
  bisector1 = B1;
  bisector2 = B2;
}

//=================================================================================================

bool Bisector_FunctionInter::Value(const double X, double& F)
{
  gp_Pnt2d PC  = curve->Value(X);
  gp_Pnt2d PB1 = bisector1->Value(X);
  gp_Pnt2d PB2 = bisector2->Value(X);

  F = PC.Distance(PB1) - PC.Distance(PB2);

  return true;
}

//=================================================================================================

bool Bisector_FunctionInter::Derivative(const double X, double& D)
{
  double F;
  return Values(X, F, D);
}

//=================================================================================================

bool Bisector_FunctionInter::Values(const double X, double& F, double& D)
{
  gp_Pnt2d PC, PB1, PB2;
  gp_Vec2d TC, TB1, TB2;
  double   F1, F2, DF1, DF2;

  curve->D1(X, PC, TC);
  bisector1->D1(X, PB1, TB1);
  bisector2->D1(X, PB2, TB2);
  F1 = PC.Distance(PB1);
  F2 = PC.Distance(PB2);
  F  = F1 - F2;
  if (std::abs(F1) < gp::Resolution())
  {
    DF1 = Precision::Infinite();
  }
  else
  {
    DF1 = ((PC.X() - PB1.X()) * (TC.X() - TB1.X()) + (PC.Y() - PB1.Y()) * (TC.Y() - TB1.Y())) / F1;
  }
  if (std::abs(F2) < gp::Resolution())
  {
    DF2 = Precision::Infinite();
  }
  else
  {
    DF2 = ((PC.X() - PB2.X()) * (TC.X() - TB2.X()) + (PC.Y() - PB2.Y()) * (TC.Y() - TB2.Y())) / F2;
  }
  D = DF1 - DF2;

  return true;
}