OCCT

// Created on: 1994-04-13
// Created by: Isabelle GRIGNON
// 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 <ChFiKPart_ComputeData_CS.hxx>
#include <gp_Ax3.hxx>
#include <gp_Vec.hxx>
#include <gp_Pnt.hxx>
#include <gp_Dir.hxx>
#include <ElCLib.hxx>

void ChFiKPart_CornerSpine(const occ::handle<Adaptor3d_Surface>& S1,
                           const occ::handle<Adaptor3d_Surface>& S2,
                           const gp_Pnt2d&                       P1S1,
                           const gp_Pnt2d& /*P2S1*/,
                           const gp_Pnt2d& P1S2,
                           const gp_Pnt2d& P2S2,
                           const double    R,
                           gp_Cylinder&    cyl,
                           gp_Circ&        circ,
                           double&         First,
                           double&         Last)

{
  gp_Ax3 ax = S1->Plane().Position();
  gp_Vec V1(ax.XDirection());
  gp_Vec V2(ax.YDirection());
  gp_Pnt P;
  gp_Vec du, dv;
  S2->D1(P1S2.X(), P1S2.Y(), P, du, dv);
  gp_Vec V(P, S1->Value(P1S1.X(), P1S1.Y()));
  V = V.Dot(V1) * V1 + V.Dot(V2) * V2;
  V.Normalize();
  gp_Pnt P2 = S2->Value(P2S2.X(), P2S2.Y());
  gp_Vec Vorien(P, P2);
  gp_Pnt cent;
  gp_Dir dx(V);
  if (V.Dot(Vorien) >= 0.)
  {
    cent.SetCoord(P.X() + R * V.X(), P.Y() + R * V.Y(), P.Z() + R * V.Z());
    dx.Reverse();
  }
  else
  {
    cent.SetCoord(P.X() - R * V.X(), P.Y() - R * V.Y(), P.Z() - R * V.Z());
  }
  gp_Dir dy(gp_Vec(cent, P2));
  dy = (dx ^ dy) ^ dx;
  gp_Ax2 circax2(cent, dx ^ dy, dx);
  gp_Ax3 cylax3(circax2);
  if ((du ^ dv).Dot(dx) < 0.)
  {
    cylax3.ZReverse();
  }
  First = 0.;
  Last  = ElCLib::CircleParameter(circax2, P2);
  circ.SetPosition(circax2);
  circ.SetRadius(R);
  cyl.SetPosition(cylax3);
  cyl.SetRadius(R);
}