OCCT

// Created on: 1992-01-20
// Created by: Remi GILET
// Copyright (c) 1992-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 <Geom2dGcc_CurveTool.hxx>
#include <Geom2dGcc_FunctionTanCuPnt.hxx>
#include <gp_Pnt2d.hxx>
#include <gp_Vec2d.hxx>

//=========================================================================
//  soit P1 le point sur la courbe Geom2dAdaptor_Curve d abscisse u.      +
//  soit C  le point ThePoint.                                            +
//  Nous cherchons donc les zeros de la fonction suivante:                +
//                                                                        +
//                 -->   -->                                              +
//                 CP1 /\ T                                               +
//             ---------------  =  F(u)                                   +
//             ||CP1|| * ||T||                                            +
//                                                                        +
//  La derivee de cette fonction est :                                    +
//            CP1 /\ N        (T.N)*((CP1/\T).((CP1/\T))                  +
//     f(u) = --------  -  --------------------------------               +
//               N.N            N*N*N*CP1*CP1*CP1                         +
//=========================================================================
Geom2dGcc_FunctionTanCuPnt::Geom2dGcc_FunctionTanCuPnt(const Geom2dAdaptor_Curve& C,
                                                       const gp_Pnt2d&            Point)
{
  TheCurv  = C;
  ThePoint = Point;
}

bool Geom2dGcc_FunctionTanCuPnt::Value(const double X, double& Fval)
{
  gp_Pnt2d Point;
  gp_Vec2d Vect;
  Geom2dGcc_CurveTool::D1(TheCurv, X, Point, Vect);
  double   NormeD1 = Vect.Magnitude();
  gp_Vec2d TheDirection(ThePoint, Point);
  double   NormeDir = TheDirection.Magnitude();
  Fval              = TheDirection.Crossed(Vect) / (NormeD1 * NormeDir);
  return true;
}

bool Geom2dGcc_FunctionTanCuPnt::Derivative(const double X, double& Deriv)
{
  gp_Pnt2d Point;
  gp_Vec2d Vec1;
  gp_Vec2d Vec2;
  Geom2dGcc_CurveTool::D2(TheCurv, X, Point, Vec1, Vec2);
  gp_Vec2d TheDirection(ThePoint.XY(), gp_XY(Point.XY()));
  double   NormeD1  = Vec1.Magnitude();
  double   NormeDir = TheDirection.Magnitude();
  Deriv =
    TheDirection.Crossed(Vec2) / (NormeD1 * NormeDir)
    - (TheDirection.Crossed(Vec1) / (NormeD1 * NormeDir))
        * (Vec1.Dot(Vec2) / (NormeD1 * NormeD1) + Vec1.Dot(TheDirection) / (NormeDir * NormeDir));
  return true;
}

bool Geom2dGcc_FunctionTanCuPnt::Values(const double X, double& Fval, double& Deriv)
{
  gp_Pnt2d Point;
  gp_Vec2d Vec1;
  gp_Vec2d Vec2;
  Geom2dGcc_CurveTool::D2(TheCurv, X, Point, Vec1, Vec2);
  gp_Vec2d TheDirection(ThePoint.XY(), gp_XY(Point.XY()));
  double   NormeD1  = Vec1.Magnitude();
  double   NormeDir = TheDirection.Magnitude();
  Fval              = TheDirection.Crossed(Vec1) / (NormeD1 * NormeDir);
  Deriv =
    TheDirection.Crossed(Vec2) / (NormeD1 * NormeDir)
    - (TheDirection.Crossed(Vec1) / (NormeD1 * NormeDir))
        * (Vec1.Dot(Vec2) / (NormeD1 * NormeD1) + Vec1.Dot(TheDirection) / (NormeDir * NormeDir));

  //  std::cout  << "U = "<< X << " F ="<< Fval <<" DF ="<< Deriv<<std::endl;

  return true;
}