OCCT

// Created on: 1995-02-20
// Created by: Jacques GOUSSARD
// Copyright (c) 1995-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 <Draft.hxx>

#include <BRep_Tool.hxx>
#include <BRepTools.hxx>
#include <ElSLib.hxx>
#include <Geom_ConicalSurface.hxx>
#include <Geom_CylindricalSurface.hxx>
#include <Geom_Plane.hxx>
#include <Geom_RectangularTrimmedSurface.hxx>
#include <Geom_Surface.hxx>
#include <gp_Dir.hxx>
#include <Precision.hxx>
#include <Standard_DomainError.hxx>
#include <TopoDS_Face.hxx>

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

double Draft::Angle(const TopoDS_Face& F, const gp_Dir& D)
{

  TopLoc_Location            Lo;
  occ::handle<Geom_Surface>  S     = BRep_Tool::Surface(F, Lo);
  occ::handle<Standard_Type> TypeS = S->DynamicType();
  if (TypeS == STANDARD_TYPE(Geom_RectangularTrimmedSurface))
  {
    S     = occ::down_cast<Geom_RectangularTrimmedSurface>(S)->BasisSurface();
    TypeS = S->DynamicType();
  }

  if (TypeS != STANDARD_TYPE(Geom_Plane) && TypeS != STANDARD_TYPE(Geom_ConicalSurface)
      && TypeS != STANDARD_TYPE(Geom_CylindricalSurface))
  {
    throw Standard_DomainError();
  }

  double Angle;
  S = occ::down_cast<Geom_Surface>(S->Transformed(Lo.Transformation()));
  if (TypeS == STANDARD_TYPE(Geom_Plane))
  {
    gp_Ax3 ax3(occ::down_cast<Geom_Plane>(S)->Pln().Position());
    gp_Vec normale(ax3.Direction());
    if (!ax3.Direct())
    {
      normale.Reverse();
    }
    if (F.Orientation() == TopAbs_REVERSED)
    {
      normale.Reverse();
    }
    Angle = std::asin(normale.Dot(D));
  }
  else if (TypeS == STANDARD_TYPE(Geom_CylindricalSurface))
  {
    gp_Cylinder Cy(occ::down_cast<Geom_CylindricalSurface>(S)->Cylinder());
    double      testdir = D.Dot(Cy.Axis().Direction());
    if (std::abs(testdir) <= 1. - Precision::Angular())
    {
      throw Standard_DomainError();
    }
    Angle = 0.;
  }
  else
  { // STANDARD_TYPE(Geom_ConicalSurface)
    gp_Cone Co(occ::down_cast<Geom_ConicalSurface>(S)->Cone());
    double  testdir = D.Dot(Co.Axis().Direction());
    if (std::abs(testdir) <= 1. - Precision::Angular())
    {
      throw Standard_DomainError();
    }
    double umin, umax, vmin, vmax;
    BRepTools::UVBounds(F, umin, umax, vmin, vmax);
    gp_Pnt ptbid;
    gp_Vec d1u, d1v;
    ElSLib::D1(umin + umax / 2., vmin + vmax / 2., Co, ptbid, d1u, d1v);
    d1u.Cross(d1v);
    d1u.Normalize();
    if (F.Orientation() == TopAbs_REVERSED)
    {
      d1u.Reverse();
    }
    Angle = std::asin(d1u.Dot(D));
  }
  return Angle;
}