#include <ShapeConstruct_Curve.ixx>

#include <Standard_ErrorHandler.hxx>
#include <Standard_Failure.hxx>

#include <gp_Vec.hxx>
#include <gp_Dir.hxx>
#include <gp_Lin.hxx>

#include <ElCLib.hxx>
#include <Precision.hxx>

#include <Geom_BSplineCurve.hxx>
#include <Geom_BezierCurve.hxx>
#include <Geom_TrimmedCurve.hxx>
#include <Geom_Line.hxx>

#include <Geom2d_BSplineCurve.hxx>
#include <Geom2d_BezierCurve.hxx>
#include <Geom2d_TrimmedCurve.hxx>
#include <Geom2d_Line.hxx>

#include <GeomConvert.hxx>
#include <GeomAdaptor_HCurve.hxx>
#include <Approx_Curve3d.hxx>

#include <Geom2dConvert.hxx>
#include <Geom2dAdaptor_HCurve.hxx>
#include <Approx_Curve2d.hxx>

//sln 29.12.2001 OCC90 : Method FixKnots was added

//=======================================================================
//function : AdjustCurve
//purpose  : 
//=======================================================================

Standard_Boolean ShapeConstruct_Curve::AdjustCurve(const Handle(Geom_Curve)& C3D,const gp_Pnt& P1,const gp_Pnt& P2,const Standard_Boolean take1,const Standard_Boolean take2) const
{
  if (!take1 && !take2) return Standard_True;

  if (C3D->IsKind(STANDARD_TYPE(Geom_BSplineCurve))) {
    Handle(Geom_BSplineCurve) BSPL = Handle(Geom_BSplineCurve)::DownCast(C3D);
    if (take1) BSPL->SetPole (1,P1);
    if (take2) BSPL->SetPole (BSPL->NbPoles(),P2);
    return Standard_True;
  }

  if (C3D->IsKind(STANDARD_TYPE(Geom_Line))) {
    Handle(Geom_Line) L3D = Handle(Geom_Line)::DownCast(C3D);
//   ATTENTION, P1 et P2 sont supposes tous deux pertinents ...
    gp_Vec avec (P1,P2);  gp_Dir adir (avec);  gp_Lin alin (P1,adir);
    Standard_Real theParam = ElCLib::Parameter(alin, L3D->Lin().Location());
    alin.SetLocation (ElCLib::Value(theParam, alin));
    L3D->SetLin (alin);
    return Standard_True;
  }

  return Standard_False;
}

//=======================================================================
//function : AdjustCurveSegment
//purpose  : 
//=======================================================================

Standard_Boolean ShapeConstruct_Curve::AdjustCurveSegment(const Handle(Geom_Curve)& C3D,const gp_Pnt& P1,const gp_Pnt& P2,const Standard_Real U1,const Standard_Real U2) const
{
  if (C3D->IsKind(STANDARD_TYPE(Geom_BSplineCurve))) {
    Handle(Geom_BSplineCurve) BSPL = Handle(Geom_BSplineCurve)::DownCast(C3D);
//    Forcer l extremite c est bien
//    Propager sur le reste, c est pas mal non plus
    if (U1 >= U2) return Standard_False;
    Standard_Real UU1 = Max (U1,BSPL->FirstParameter());
    Standard_Real UU2 = Min (U2,BSPL->LastParameter());
    BSPL->Segment (UU1,UU2);
    BSPL->SetPole (1,P1);
    BSPL->SetPole (BSPL->NbPoles(),P2);
    return Standard_True;
  }
    
  if (C3D->IsKind(STANDARD_TYPE(Geom_Line))) {
    Handle(Geom_Line) L3D = Handle(Geom_Line)::DownCast(C3D);
//   ATTENTION, P1 et P2 sont supposes tous deux pertinents ...
//   NB : on ne s aide pas de U1 et U2
    gp_Vec avec (P1,P2);  gp_Dir adir (avec);  gp_Lin alin (P1,adir);
    Standard_Real theParam = ElCLib::Parameter(alin, L3D->Lin().Location());
    alin.SetLocation (ElCLib::Value(theParam, alin));
    L3D->SetLin (alin);
    return Standard_True;
  }

  return Standard_False;
}

//=======================================================================
//function : AdjustCurve2d
//purpose  : 
//=======================================================================

Standard_Boolean ShapeConstruct_Curve::AdjustCurve2d(const Handle(Geom2d_Curve)& C2D,const gp_Pnt2d& P1,const gp_Pnt2d& P2,const Standard_Boolean take1,const Standard_Boolean take2) const
{
  if (!take1 && !take2) return Standard_True;

  if (C2D->IsKind(STANDARD_TYPE(Geom2d_BSplineCurve))) {
    Handle(Geom2d_BSplineCurve) BSPL = Handle(Geom2d_BSplineCurve)::DownCast(C2D);
    if (take1) BSPL->SetPole (1,P1);
    if (take2) BSPL->SetPole (BSPL->NbPoles(),P2);
    return Standard_True;
  }

  if (C2D->IsKind(STANDARD_TYPE(Geom2d_Line))) {
    Handle(Geom2d_Line) L2D = Handle(Geom2d_Line)::DownCast(C2D);
//   ATTENTION, P1 et P2 sont supposes tous deux pertinents ...
    gp_Vec2d avec (P1,P2);  gp_Dir2d adir (avec);  gp_Lin2d alin (P1,adir);
    Standard_Real theParam = ElCLib::Parameter(alin, L2D->Lin2d().Location());
    alin.SetLocation (ElCLib::Value(theParam, alin));
    L2D->SetLin2d (alin);
    return Standard_True;
  }

  return Standard_False;
}

//=======================================================================
//function : ConvertToBSpline
//purpose  : 
//=======================================================================

Handle(Geom_BSplineCurve) ShapeConstruct_Curve::ConvertToBSpline (const Handle(Geom_Curve) &C,
								  const Standard_Real first, 
								  const Standard_Real last,
								  const Standard_Real prec) const
{
  Handle(Geom_BSplineCurve) bspl;
  
  if ( C->IsKind(STANDARD_TYPE(Geom_BSplineCurve)) ) {
    bspl = Handle(Geom_BSplineCurve)::DownCast ( C );
  }
  else if ( C->IsKind(STANDARD_TYPE(Geom_BezierCurve)) ||
	    C->IsKind(STANDARD_TYPE(Geom_Line)) ) {
    Handle(Geom_Curve) tc = new Geom_TrimmedCurve ( C, first, last );
    try {
      OCC_CATCH_SIGNALS
      bspl = GeomConvert::CurveToBSplineCurve(tc);
    }
    catch ( Standard_Failure ) {
#ifdef DEB 
      cout << "Warning: ShapeConstruct_Curve::ConvertToBSpline(): Exception in GeomConvert: ";
      Standard_Failure::Caught()->Print(cout); cout << endl;
#endif
    }
  }

  if ( ! bspl.IsNull() ) {
    // take segment if trim and range differ
    Standard_Real fbsp = bspl->FirstParameter(), lbsp = bspl->LastParameter();
    Standard_Boolean segment = Standard_False;
    if ( first > fbsp + Precision::PConfusion() ) { fbsp = first; segment = Standard_True; }
    if ( last  < lbsp - Precision::PConfusion() ) { lbsp = last;  segment = Standard_True; }
    if ( ! segment ) return bspl;
    try {
      OCC_CATCH_SIGNALS
      bspl = Handle(Geom_BSplineCurve)::DownCast ( bspl->Copy() );
      bspl->Segment ( fbsp, lbsp );
      return bspl;
    }
    catch ( Standard_Failure ) {
#ifdef DEB 
      cout << "Warning: ShapeConstruct_Curve::ConvertToBSpline(): Exception in Segment: ";
      Standard_Failure::Caught()->Print(cout); cout << endl;
#endif
    }
  }

  // Approx is used for conics and when ordinary methods fail
  Handle(Geom_Curve) newc = C;
  if ( ! bspl.IsNull() ) { newc = bspl; bspl.Nullify(); }
  try {
    OCC_CATCH_SIGNALS
    Approx_Curve3d Conv ( new GeomAdaptor_HCurve(newc,first,last),
			  prec, GeomAbs_C1, 9, 1000 );
    if ( Conv.IsDone() || Conv.HasResult() ) 
      bspl = Conv.Curve();
  }
  catch ( Standard_Failure ) {
#ifdef DEB 
    cout << "Warning: ShapeConstruct_Curve::ConvertToBSpline(): Exception in Approx_Curve3d: ";
    Standard_Failure::Caught()->Print(cout); cout << endl;
#endif
  }
  return bspl;
}

//=======================================================================
//function : ConvertToBSpline
//purpose  : 
//=======================================================================

Handle(Geom2d_BSplineCurve) ShapeConstruct_Curve::ConvertToBSpline (const Handle(Geom2d_Curve) &C,
								    const Standard_Real first, 
								    const Standard_Real last,
								    const Standard_Real prec) const
{
  Handle(Geom2d_BSplineCurve) bspl;
  
  if ( C->IsKind(STANDARD_TYPE(Geom2d_BSplineCurve)) ) {
    bspl = Handle(Geom2d_BSplineCurve)::DownCast ( C );
  }
  else if ( C->IsKind(STANDARD_TYPE(Geom2d_BezierCurve)) ||
	    C->IsKind(STANDARD_TYPE(Geom2d_Line)) ) {
    Handle(Geom2d_Curve) tc = new Geom2d_TrimmedCurve ( C, first, last );
    try {
      OCC_CATCH_SIGNALS
      bspl = Geom2dConvert::CurveToBSplineCurve(tc);
    }
    catch ( Standard_Failure ) {
#ifdef DEB 
      cout << "Warning: ShapeConstruct_Curve::ConvertToBSpline(): Exception in Geom2dConvert: ";
      Standard_Failure::Caught()->Print(cout); cout << endl;
#endif
    }
  }

  if ( ! bspl.IsNull() ) {
    // take segment if trim and range differ
    Standard_Real fbsp = bspl->FirstParameter(), lbsp = bspl->LastParameter();
    Standard_Boolean segment = Standard_False;
    if ( first > fbsp + Precision::PConfusion() ) { fbsp = first; segment = Standard_True; }
    if ( last  < lbsp - Precision::PConfusion() ) { lbsp = last;  segment = Standard_True; }
    if ( ! segment ) return bspl;
    try {
      OCC_CATCH_SIGNALS
      bspl = Handle(Geom2d_BSplineCurve)::DownCast ( bspl->Copy() );
      bspl->Segment ( fbsp, lbsp );
      return bspl;
    }
    catch ( Standard_Failure ) {
#ifdef DEB 
      cout << "Warning: ShapeConstruct_Curve::ConvertToBSpline(): Exception in Segment: ";
      Standard_Failure::Caught()->Print(cout); cout << endl;
#endif
    }
  }

  // Approx is used for conics and when ordinary methods fail
  Handle(Geom2d_Curve) newc = C;
  if ( ! bspl.IsNull() ) { newc = bspl; bspl.Nullify(); }
  try {
    OCC_CATCH_SIGNALS
    Approx_Curve2d Conv ( new Geom2dAdaptor_HCurve(newc,first,last),
			  first, last,
			  prec, prec, GeomAbs_C1, 9, 1000 );
    if ( Conv.IsDone() || Conv.HasResult() ) 
      bspl = Conv.Curve();
  }
  catch ( Standard_Failure ) {
#ifdef DEB 
    cout << "Warning: ShapeConstruct_Curve::ConvertToBSpline(): Exception in Approx_Curve3d: ";
    Standard_Failure::Caught()->Print(cout); cout << endl;
#endif
  }
  return bspl;
}

//=======================================================================
//function : FixKnots
//purpose  : Fix coincided knots
//=======================================================================
Standard_Boolean ShapeConstruct_Curve::FixKnots (Handle(TColStd_HArray1OfReal) &knots) 
{
  Standard_Boolean Fixed = Standard_False;
  Standard_Integer nbKnots = knots->Length();
  Standard_Real knotVal = knots->Value(1);
  for ( Standard_Integer i=2; i <= nbKnots; i++ ) {
    Standard_Real knotNext = knots->Value(i);
    if ( knotNext - knotVal <= Epsilon(knotVal) ) {
      knotNext = knotVal + 2. * Epsilon(knotVal);
      knots->SetValue ( i, knotNext );
      Fixed = Standard_True;
    }
    knotVal = knotNext;
  }
  return Fixed;
}

//=======================================================================
//function : FixKnots
//purpose  : Fix coincided knots
//=======================================================================
Standard_Boolean ShapeConstruct_Curve::FixKnots (TColStd_Array1OfReal& knots) 
{
  Standard_Boolean Fixed = Standard_False;
  Standard_Integer nbKnots = knots.Length();
  Standard_Real knotVal = knots.Value(1);
  for ( Standard_Integer i=2; i <= nbKnots; i++ ) {
    Standard_Real knotNext = knots.Value(i);
    if ( knotNext - knotVal <= Epsilon(knotVal) ) {
      knotNext = knotVal + 2. * Epsilon(knotVal);
      knots.SetValue ( i, knotNext );
      Fixed = Standard_True;
    }
    knotVal = knotNext;
  }
  return Fixed;
}

