[occt.git] / src / HLRBRep / HLRBRep.cxx

// Created on: 1992-08-27
// Created by: Christophe MARION
// 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 <HLRBRep.ixx>
#include <BRepLib_MakeEdge2d.hxx>
#include <Geom2d_BezierCurve.hxx>
#include <Geom2d_BSplineCurve.hxx>
#include <Geom_BSplineCurve.hxx>
#include <Geom_TrimmedCurve.hxx>
#include <TColStd_Array1OfInteger.hxx>
#include <TColStd_Array1OfReal.hxx>
#include <TColgp_Array1OfPnt2d.hxx>
#include <BRep_Tool.hxx>
#include <TopoDS.hxx>
#include <TopExp.hxx>
#include <BRepLib_MakeVertex.hxx>
#include <BRep_Builder.hxx>


//=======================================================================
//function : MakeEdge
//purpose  : 
//=======================================================================

TopoDS_Edge HLRBRep::MakeEdge (const HLRBRep_Curve& ec,
                               const Standard_Real U1,
                               const Standard_Real U2)
{
  TopoDS_Edge Edg;
  const Standard_Real sta = ec.Parameter2d(U1);
  const Standard_Real end = ec.Parameter2d(U2);

  switch (ec.GetType())
  {
  case GeomAbs_Line:
    Edg = BRepLib_MakeEdge2d(ec.Line(),sta,end);
    break;
    
  case GeomAbs_Circle:
    Edg = BRepLib_MakeEdge2d(ec.Circle(),sta,end);
    break;
    
  case GeomAbs_Ellipse:
    Edg = BRepLib_MakeEdge2d(ec.Ellipse(),sta,end);
    break;
    
  case GeomAbs_Hyperbola:
    Edg = BRepLib_MakeEdge2d(ec.Hyperbola(),sta,end);
    break;
    
  case GeomAbs_Parabola:
    Edg = BRepLib_MakeEdge2d(ec.Parabola(),sta,end);
    break;
    
  case GeomAbs_BezierCurve: {
    TColgp_Array1OfPnt2d Poles(1,ec.NbPoles());
    Handle(Geom2d_BezierCurve) ec2d;
    if (ec.IsRational()) {
      TColStd_Array1OfReal Weights(1,ec.NbPoles());
      ec.PolesAndWeights(Poles,Weights);
      ec2d = new Geom2d_BezierCurve(Poles,Weights);
    }
    else {
      ec.Poles(Poles);
      ec2d = new Geom2d_BezierCurve(Poles);
    }
    BRepLib_MakeEdge2d mke2d(ec2d,sta,end);
    if (mke2d.IsDone())
      Edg = mke2d.Edge();
    break;
  }
    
  case GeomAbs_BSplineCurve: {
    Handle(Geom2d_BSplineCurve) ec2d;
    GeomAdaptor_Curve GAcurve = ec.GetCurve().Curve();
    TopoDS_Edge anEdge = ec.GetCurve().Edge();
    Standard_Real fpar, lpar;
    Handle(Geom_Curve) aCurve = BRep_Tool::Curve(anEdge, fpar, lpar);
    if (aCurve->DynamicType() == STANDARD_TYPE(Geom_TrimmedCurve))
      aCurve = (Handle(Geom_TrimmedCurve)::DownCast(aCurve))->BasisCurve();
    Handle(Geom_BSplineCurve) BSplCurve (Handle(Geom_BSplineCurve)::DownCast(aCurve));
    Handle(Geom_BSplineCurve) theCurve = Handle(Geom_BSplineCurve)::DownCast(BSplCurve->Copy());
    if (theCurve->IsPeriodic() && !GAcurve.IsClosed())
    {
      theCurve->Segment(sta, end);
      TColgp_Array1OfPnt2d    Poles(1, theCurve->NbPoles());
      TColStd_Array1OfReal    knots(1, theCurve->NbKnots());
      TColStd_Array1OfInteger mults(1, theCurve->NbKnots());
      //-- ec.KnotsAndMultiplicities(knots,mults);
      theCurve->Knots(knots);
      theCurve->Multiplicities(mults);
      if (theCurve->IsRational()) {
        TColStd_Array1OfReal Weights(1, theCurve->NbPoles());
        ec.PolesAndWeights(theCurve, Poles, Weights);
        ec2d = new Geom2d_BSplineCurve(Poles, Weights, knots, mults,
                                       theCurve->Degree(), theCurve->IsPeriodic());
      }
      else {
        ec.Poles(theCurve, Poles);
        ec2d = new Geom2d_BSplineCurve(Poles, knots, mults,
                                       theCurve->Degree(), theCurve->IsPeriodic());
      }
    }
    else
    {
      TColgp_Array1OfPnt2d    Poles(1,ec.NbPoles());
      TColStd_Array1OfReal    knots(1,ec.NbKnots());
      TColStd_Array1OfInteger mults(1,ec.NbKnots());
      //-- ec.KnotsAndMultiplicities(knots,mults);
      ec.Knots(knots);
      ec.Multiplicities(mults);
      if (ec.IsRational()) {
        TColStd_Array1OfReal Weights(1,ec.NbPoles());
        ec.PolesAndWeights(Poles,Weights);
        ec2d = new Geom2d_BSplineCurve(Poles,Weights,knots,mults,ec.Degree(),ec.IsPeriodic());
      }
      else {
        ec.Poles(Poles);
        ec2d = new Geom2d_BSplineCurve(Poles,knots,mults,ec.Degree(),ec.IsPeriodic());
      }
    }
    BRepLib_MakeEdge2d mke2d(ec2d, sta, end);
    if (mke2d.IsDone())
      Edg = mke2d.Edge();
    break;
  }
  default: {
    const Standard_Integer nbPnt = 15;
    TColgp_Array1OfPnt2d    Poles(1,nbPnt);
    TColStd_Array1OfReal    knots(1,nbPnt);
    TColStd_Array1OfInteger mults(1,nbPnt);
    mults.Init(1);
    mults(1    ) = 2;
    mults(nbPnt) = 2;
    const Standard_Real step = (U2-U1)/(nbPnt-1);
    Standard_Real par3d = U1;
    for (Standard_Integer i = 1; i < nbPnt; i++) {
      Poles(i) = ec.Value(par3d);
      knots(i) = par3d;
      par3d += step;
    }
    Poles(nbPnt) = ec.Value(U2);
    knots(nbPnt) = U2;
    
    Handle(Geom2d_BSplineCurve) ec2d = new Geom2d_BSplineCurve(Poles,knots,mults,1);
    BRepLib_MakeEdge2d mke2d(ec2d,sta,end);
    if (mke2d.IsDone())
      Edg = mke2d.Edge();
  }
  }
  return Edg;
}

//=======================================================================
//function : MakeEdge3d
//purpose  : 
//=======================================================================

TopoDS_Edge HLRBRep::MakeEdge3d(const HLRBRep_Curve& ec,
                                const Standard_Real U1,
                                const Standard_Real U2)
{
  TopoDS_Edge Edg;
  //const Standard_Real sta = ec.Parameter2d(U1);
  //const Standard_Real end = ec.Parameter2d(U2);

  TopoDS_Edge anEdge = ec.GetCurve().Edge();
  Standard_Real fpar, lpar;
  //BRep_Tool::Range(anEdge, fpar, lpar);
  //Handle(Geom_Curve) aCurve = BRep_Tool::Curve(anEdge, fpar, lpar);
  BRepAdaptor_Curve BAcurve(anEdge);
  fpar = BAcurve.FirstParameter();
  lpar = BAcurve.LastParameter();
  
  Edg = TopoDS::Edge(anEdge.EmptyCopied());
  Edg.Orientation(TopAbs_FORWARD);
  BRep_Builder BB;
  BB.Range(Edg, U1, U2);

  //Share vertices if possible
  TopoDS_Vertex V1, V2, V1new, V2new;
  TopExp::Vertices(anEdge, V1, V2);

  Standard_Real Tol = Precision::PConfusion();
  if (Abs(fpar - U1) <= Tol)
    V1new = V1;
  else
  {
    gp_Pnt aPnt = BAcurve.Value(U1);
    V1new = BRepLib_MakeVertex(aPnt);
  }
  if (Abs(lpar - U2) <= Tol)
    V2new = V2;
  else
  {
    gp_Pnt aPnt = BAcurve.Value(U2);
    V2new = BRepLib_MakeVertex(aPnt);
  }

  V1new.Orientation(TopAbs_FORWARD);
  V2new.Orientation(TopAbs_REVERSED);
  BB.Add(Edg, V1new);
  BB.Add(Edg, V2new);
  return Edg;
}

//=======================================================================
//function : PolyHLRAngleAndDeflection
//purpose  : 
//=======================================================================

void 
HLRBRep::PolyHLRAngleAndDeflection (const Standard_Real InAngl,
				    Standard_Real& OutAngl,
				    Standard_Real& OutDefl)
{
  static Standard_Real HAngMin =  1*M_PI/180;
  static Standard_Real HAngLim =  5*M_PI/180;
  static Standard_Real HAngMax = 35*M_PI/180;

  OutAngl = InAngl;
  if (OutAngl < HAngMin) OutAngl = HAngMin;
  if (OutAngl > HAngMax) OutAngl = HAngMax;
  OutAngl = HAngLim + sqrt((OutAngl - HAngMin) * (HAngMax - HAngLim) *
			   (HAngMax - HAngLim) / (HAngMax - HAngMin));
  OutDefl = OutAngl * OutAngl * 0.5;
}
Commit	Line	Data
b311480e	1	// Created on: 1992-08-27
	2	// Created by: Christophe MARION
	3	// Copyright (c) 1992-1999 Matra Datavision
973c2be1	4	// Copyright (c) 1999-2014 OPEN CASCADE SAS
b311480e	5	//
973c2be1	6	// This file is part of Open CASCADE Technology software library.
b311480e	7	//
d5f74e42	8	// This library is free software; you can redistribute it and/or modify it under
d5f74e42	9	// the terms of the GNU Lesser General Public License version 2.1 as published
973c2be1	10	// by the Free Software Foundation, with special exception defined in the file
	11	// OCCT_LGPL_EXCEPTION.txt. Consult the file LICENSE_LGPL_21.txt included in OCCT
	12	// distribution for complete text of the license and disclaimer of any warranty.
b311480e	13	//
973c2be1	14	// Alternatively, this file may be used under the terms of Open CASCADE
973c2be1	15	// commercial license or contractual agreement.
7fd59977	16
	17	#include <HLRBRep.ixx>
	18	#include <BRepLib_MakeEdge2d.hxx>
	19	#include <Geom2d_BezierCurve.hxx>
	20	#include <Geom2d_BSplineCurve.hxx>
0a768f56	21	#include <Geom_BSplineCurve.hxx>
c0ade4c6	22	#include <Geom_TrimmedCurve.hxx>
7fd59977	23	#include <TColStd_Array1OfInteger.hxx>
	24	#include <TColStd_Array1OfReal.hxx>
	25	#include <TColgp_Array1OfPnt2d.hxx>
0a768f56	26	#include <BRep_Tool.hxx>
	27	#include <TopoDS.hxx>
	28	#include <TopExp.hxx>
	29	#include <BRepLib_MakeVertex.hxx>
	30	#include <BRep_Builder.hxx>
	31
7fd59977	32
	33	//=======================================================================
	34	//function : MakeEdge
	35	//purpose :
	36	//=======================================================================
	37
	38	TopoDS_Edge HLRBRep::MakeEdge (const HLRBRep_Curve& ec,
5c953701	39	const Standard_Real U1,
5c953701	40	const Standard_Real U2)
7fd59977	41	{
7fd59977	42	TopoDS_Edge Edg;
5c953701	43	const Standard_Real sta = ec.Parameter2d(U1);
	44	const Standard_Real end = ec.Parameter2d(U2);
	45
	46	switch (ec.GetType())
	47	{
0a768f56	48	case GeomAbs_Line:
	49	Edg = BRepLib_MakeEdge2d(ec.Line(),sta,end);
	50	break;
	51
	52	case GeomAbs_Circle:
	53	Edg = BRepLib_MakeEdge2d(ec.Circle(),sta,end);
	54	break;
	55
	56	case GeomAbs_Ellipse:
	57	Edg = BRepLib_MakeEdge2d(ec.Ellipse(),sta,end);
	58	break;
	59
	60	case GeomAbs_Hyperbola:
	61	Edg = BRepLib_MakeEdge2d(ec.Hyperbola(),sta,end);
	62	break;
	63
	64	case GeomAbs_Parabola:
	65	Edg = BRepLib_MakeEdge2d(ec.Parabola(),sta,end);
	66	break;
	67
	68	case GeomAbs_BezierCurve: {
	69	TColgp_Array1OfPnt2d Poles(1,ec.NbPoles());
	70	Handle(Geom2d_BezierCurve) ec2d;
	71	if (ec.IsRational()) {
	72	TColStd_Array1OfReal Weights(1,ec.NbPoles());
	73	ec.PolesAndWeights(Poles,Weights);
	74	ec2d = new Geom2d_BezierCurve(Poles,Weights);
	75	}
	76	else {
	77	ec.Poles(Poles);
	78	ec2d = new Geom2d_BezierCurve(Poles);
	79	}
	80	BRepLib_MakeEdge2d mke2d(ec2d,sta,end);
	81	if (mke2d.IsDone())
	82	Edg = mke2d.Edge();
	83	break;
	84	}
	85
	86	case GeomAbs_BSplineCurve: {
	87	Handle(Geom2d_BSplineCurve) ec2d;
	88	GeomAdaptor_Curve GAcurve = ec.GetCurve().Curve();
	89	TopoDS_Edge anEdge = ec.GetCurve().Edge();
	90	Standard_Real fpar, lpar;
	91	Handle(Geom_Curve) aCurve = BRep_Tool::Curve(anEdge, fpar, lpar);
c0ade4c6	92	if (aCurve->DynamicType() == STANDARD_TYPE(Geom_TrimmedCurve))
c0ade4c6	93	aCurve = (Handle(Geom_TrimmedCurve)::DownCast(aCurve))->BasisCurve();
c5f3a425	94	Handle(Geom_BSplineCurve) BSplCurve (Handle(Geom_BSplineCurve)::DownCast(aCurve));
0a768f56	95	Handle(Geom_BSplineCurve) theCurve = Handle(Geom_BSplineCurve)::DownCast(BSplCurve->Copy());
	96	if (theCurve->IsPeriodic() && !GAcurve.IsClosed())
	97	{
	98	theCurve->Segment(sta, end);
	99	TColgp_Array1OfPnt2d Poles(1, theCurve->NbPoles());
	100	TColStd_Array1OfReal knots(1, theCurve->NbKnots());
	101	TColStd_Array1OfInteger mults(1, theCurve->NbKnots());
	102	//-- ec.KnotsAndMultiplicities(knots,mults);
	103	theCurve->Knots(knots);
	104	theCurve->Multiplicities(mults);
	105	if (theCurve->IsRational()) {
	106	TColStd_Array1OfReal Weights(1, theCurve->NbPoles());
	107	ec.PolesAndWeights(theCurve, Poles, Weights);
	108	ec2d = new Geom2d_BSplineCurve(Poles, Weights, knots, mults,
	109	theCurve->Degree(), theCurve->IsPeriodic());
5c953701	110	}
5c953701	111	else {
0a768f56	112	ec.Poles(theCurve, Poles);
	113	ec2d = new Geom2d_BSplineCurve(Poles, knots, mults,
	114	theCurve->Degree(), theCurve->IsPeriodic());
5c953701	115	}
7fd59977	116	}
0a768f56	117	else
0a768f56	118	{
5c953701	119	TColgp_Array1OfPnt2d Poles(1,ec.NbPoles());
	120	TColStd_Array1OfReal knots(1,ec.NbKnots());
	121	TColStd_Array1OfInteger mults(1,ec.NbKnots());
	122	//-- ec.KnotsAndMultiplicities(knots,mults);
	123	ec.Knots(knots);
	124	ec.Multiplicities(mults);
5c953701	125	if (ec.IsRational()) {
	126	TColStd_Array1OfReal Weights(1,ec.NbPoles());
	127	ec.PolesAndWeights(Poles,Weights);
0a768f56	128	ec2d = new Geom2d_BSplineCurve(Poles,Weights,knots,mults,ec.Degree(),ec.IsPeriodic());
5c953701	129	}
	130	else {
	131	ec.Poles(Poles);
0a768f56	132	ec2d = new Geom2d_BSplineCurve(Poles,knots,mults,ec.Degree(),ec.IsPeriodic());
5c953701	133	}
7fd59977	134	}
0a768f56	135	BRepLib_MakeEdge2d mke2d(ec2d, sta, end);
	136	if (mke2d.IsDone())
	137	Edg = mke2d.Edge();
	138	break;
	139	}
	140	default: {
	141	const Standard_Integer nbPnt = 15;
	142	TColgp_Array1OfPnt2d Poles(1,nbPnt);
	143	TColStd_Array1OfReal knots(1,nbPnt);
	144	TColStd_Array1OfInteger mults(1,nbPnt);
	145	mults.Init(1);
	146	mults(1 ) = 2;
	147	mults(nbPnt) = 2;
	148	const Standard_Real step = (U2-U1)/(nbPnt-1);
	149	Standard_Real par3d = U1;
	150	for (Standard_Integer i = 1; i < nbPnt; i++) {
	151	Poles(i) = ec.Value(par3d);
	152	knots(i) = par3d;
	153	par3d += step;
7fd59977	154	}
0a768f56	155	Poles(nbPnt) = ec.Value(U2);
	156	knots(nbPnt) = U2;
	157
	158	Handle(Geom2d_BSplineCurve) ec2d = new Geom2d_BSplineCurve(Poles,knots,mults,1);
	159	BRepLib_MakeEdge2d mke2d(ec2d,sta,end);
	160	if (mke2d.IsDone())
	161	Edg = mke2d.Edge();
	162	}
7fd59977	163	}
	164	return Edg;
	165	}
	166
bda83605	167	//=======================================================================
	168	//function : MakeEdge3d
	169	//purpose :
	170	//=======================================================================
	171
	172	TopoDS_Edge HLRBRep::MakeEdge3d(const HLRBRep_Curve& ec,
	173	const Standard_Real U1,
	174	const Standard_Real U2)
	175	{
	176	TopoDS_Edge Edg;
	177	//const Standard_Real sta = ec.Parameter2d(U1);
	178	//const Standard_Real end = ec.Parameter2d(U2);
	179
	180	TopoDS_Edge anEdge = ec.GetCurve().Edge();
	181	Standard_Real fpar, lpar;
	182	//BRep_Tool::Range(anEdge, fpar, lpar);
	183	//Handle(Geom_Curve) aCurve = BRep_Tool::Curve(anEdge, fpar, lpar);
	184	BRepAdaptor_Curve BAcurve(anEdge);
	185	fpar = BAcurve.FirstParameter();
	186	lpar = BAcurve.LastParameter();
	187
	188	Edg = TopoDS::Edge(anEdge.EmptyCopied());
	189	Edg.Orientation(TopAbs_FORWARD);
	190	BRep_Builder BB;
	191	BB.Range(Edg, U1, U2);
	192
	193	//Share vertices if possible
	194	TopoDS_Vertex V1, V2, V1new, V2new;
	195	TopExp::Vertices(anEdge, V1, V2);
	196
	197	Standard_Real Tol = Precision::PConfusion();
	198	if (Abs(fpar - U1) <= Tol)
	199	V1new = V1;
	200	else
	201	{
	202	gp_Pnt aPnt = BAcurve.Value(U1);
	203	V1new = BRepLib_MakeVertex(aPnt);
	204	}
	205	if (Abs(lpar - U2) <= Tol)
	206	V2new = V2;
	207	else
	208	{
	209	gp_Pnt aPnt = BAcurve.Value(U2);
	210	V2new = BRepLib_MakeVertex(aPnt);
	211	}
	212
	213	V1new.Orientation(TopAbs_FORWARD);
	214	V2new.Orientation(TopAbs_REVERSED);
	215	BB.Add(Edg, V1new);
	216	BB.Add(Edg, V2new);
	217	return Edg;
	218	}
	219
7fd59977	220	//=======================================================================
	221	//function : PolyHLRAngleAndDeflection
	222	//purpose :
	223	//=======================================================================
	224
	225	void
	226	HLRBRep::PolyHLRAngleAndDeflection (const Standard_Real InAngl,
	227	Standard_Real& OutAngl,
	228	Standard_Real& OutDefl)
	229	{
c6541a0c D	230	static Standard_Real HAngMin = 1*M_PI/180;
	231	static Standard_Real HAngLim = 5*M_PI/180;
	232	static Standard_Real HAngMax = 35*M_PI/180;
7fd59977	233
	234	OutAngl = InAngl;
	235	if (OutAngl < HAngMin) OutAngl = HAngMin;
	236	if (OutAngl > HAngMax) OutAngl = HAngMax;
	237	OutAngl = HAngLim + sqrt((OutAngl - HAngMin) * (HAngMax - HAngLim) *
	238	(HAngMax - HAngLim) / (HAngMax - HAngMin));
	239	OutDefl = OutAngl * OutAngl * 0.5;
	240	}