OCCT

// Created on: 1994-06-27
// Created by: Laurent BOURESCHE
// 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 <Adaptor3d_Surface.hxx>
#include <ChFiDS_SurfData.hxx>
#include <ChFiKPart_ComputeData.hxx>
#include <ChFiKPart_ComputeData_Fcts.hxx>
#include <ElCLib.hxx>
#include <ElSLib.hxx>
#include <Geom2d_Circle.hxx>
#include <Geom2d_Line.hxx>
#include <Geom_Circle.hxx>
#include <Geom_ToroidalSurface.hxx>
#include <gp.hxx>
#include <gp_Ax2.hxx>
#include <gp_Ax3.hxx>
#include <gp_Ax22d.hxx>
#include <gp_Dir.hxx>
#include <gp_Dir2d.hxx>
#include <gp_Pln.hxx>
#include <gp_Pnt.hxx>
#include <gp_Pnt2d.hxx>
#include <gp_Vec.hxx>
#include <IntAna_QuadQuadGeo.hxx>
#include <Precision.hxx>
#include <TopOpeBRepDS_DataStructure.hxx>

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

bool ChFiKPart_MakeRotule(TopOpeBRepDS_DataStructure&         DStr,
                          const occ::handle<ChFiDS_SurfData>& Data,
                          const gp_Pln&                       pl,
                          const gp_Pln&                       pl1,
                          const gp_Pln&                       pl2,
                          const TopAbs_Orientation            opl,
                          const TopAbs_Orientation            opl1,
                          const TopAbs_Orientation            opl2,
                          const double                        r,
                          const TopAbs_Orientation            ofpl)
{

  // calcul du tore.
  //---------------
  gp_Ax3 pos    = pl.Position();
  gp_Dir dpl    = pos.XDirection().Crossed(pos.YDirection());
  gp_Dir dfpl   = dpl;
  gp_Dir dplnat = dpl;
  if (opl == TopAbs_REVERSED)
  {
    dpl.Reverse();
  }
  if (ofpl == TopAbs_REVERSED)
  {
    dfpl.Reverse();
  }
  pos         = pl1.Position();
  gp_Dir dpl1 = pos.XDirection().Crossed(pos.YDirection());
  if (opl1 == TopAbs_REVERSED)
  {
    dpl1.Reverse();
  }
  pos         = pl2.Position();
  gp_Dir dpl2 = pos.XDirection().Crossed(pos.YDirection());
  if (opl2 == TopAbs_REVERSED)
  {
    dpl2.Reverse();
  }

  double alpha = dpl1.Angle(dpl2);

  IntAna_QuadQuadGeo LInt(pl1, pl2, Precision::Angular(), Precision::Confusion());
  gp_Pnt             ptor, pcirc;
  if (LInt.IsDone())
  {

    pcirc = ElCLib::Value(ElCLib::Parameter(LInt.Line(1), pl.Location()), LInt.Line(1));
    ptor.SetCoord(pcirc.X() + r * dpl.X(), pcirc.Y() + r * dpl.Y(), pcirc.Z() + r * dpl.Z());
  }
  else
  {
    return false;
  }

  gp_Ax3 ppos(ptor, dpl.Reversed(), dpl1);
  if (ppos.YDirection().Dot(dpl2) < 0.)
  {
    ppos.YReverse();
  }
  occ::handle<Geom_ToroidalSurface> gtor = new Geom_ToroidalSurface(ppos, r, r);
  Data->ChangeSurf(ChFiKPart_IndexSurfaceInDS(gtor, DStr));

  // on compare l orientation du tore a celle de la face en bout.
  //------------------------------------------------------------
  gp_Pnt pp;
  gp_Vec du, dv;
  ElSLib::TorusD1(0., M_PI / 2, ppos, r, r, pp, du, dv);
  gp_Dir drot(du.Crossed(dv));
  bool   reversecur = (drot.Dot(dplnat) <= 0.);
  bool   reversefil = (drot.Dot(dfpl) <= 0.);
  if (reversefil)
  {
    Data->ChangeOrientation() = TopAbs_REVERSED;
  }
  else
  {
    Data->ChangeOrientation() = TopAbs_FORWARD;
  }

  // on charge les FaceInterferences avec les pcurves et courbes 3d.
  //-----------------------------------------------------------------

  // du cote du plan
  //---------------
  gp_Ax2 circAx2 = ppos.Ax2();
  circAx2.SetLocation(pcirc);
  occ::handle<Geom_Circle> GC = new Geom_Circle(circAx2, r);
  double                   u, v;
  ElSLib::Parameters(pl, pcirc, u, v);
  gp_Pnt2d p2dcirc(u, v);
  gp_Dir2d dx2d(dpl1.Dot(pl.Position().XDirection()), dpl1.Dot(pl.Position().YDirection()));
  gp_Dir2d dy2d(ppos.YDirection().Dot(pl.Position().XDirection()),
                ppos.YDirection().Dot(pl.Position().YDirection()));
  gp_Ax22d circ2dax(p2dcirc, dx2d, dy2d);
  occ::handle<Geom2d_Circle> GC2d = new Geom2d_Circle(circ2dax, r);
  gp_Pnt2d                   p2dlin(0., M_PI / 2);
  occ::handle<Geom2d_Line>   GL2d  = new Geom2d_Line(p2dlin, gp::DX2d());
  TopAbs_Orientation         trans = TopAbs_REVERSED;
  if (reversecur)
  {
    trans = TopAbs_FORWARD;
  }
  Data->ChangeInterferenceOnS1().SetInterference(ChFiKPart_IndexCurveInDS(GC, DStr),
                                                 trans,
                                                 GC2d,
                                                 GL2d);

  // du cote pointu
  //--------------
  occ::handle<Geom_Curve>   bid;
  occ::handle<Geom2d_Curve> bid2d;
  p2dlin.SetCoord(0., M_PI);
  occ::handle<Geom2d_Line> GL2dcoin = new Geom2d_Line(p2dlin, gp::DX2d());
  Data->ChangeInterferenceOnS2().SetInterference(ChFiKPart_IndexCurveInDS(bid, DStr),
                                                 trans,
                                                 bid2d,
                                                 GL2dcoin);

  // et les points
  //-------------
  Data->ChangeVertexFirstOnS1().SetPoint(pp);
  ElSLib::TorusD0(alpha, M_PI / 2, ppos, r, r, pp);
  Data->ChangeVertexLastOnS1().SetPoint(pp);
  Data->ChangeInterferenceOnS1().SetFirstParameter(0.);
  Data->ChangeInterferenceOnS1().SetLastParameter(alpha);
  Data->ChangeInterferenceOnS2().SetFirstParameter(0.);
  Data->ChangeInterferenceOnS2().SetLastParameter(alpha);

  return true;
}