#include <Adaptor3d_OffsetCurve.ixx>

#include <Adaptor3d_HOffsetCurve.hxx>
#include <GeomAbs_SurfaceType.hxx>
#include <Standard_NoSuchObject.hxx>
#include <Standard_NotImplemented.hxx>
#include <gp_VectorWithNullMagnitude.hxx>
#include <Precision.hxx>
#include <gp_Ax22d.hxx>
#include <gp_Dir2d.hxx>
#include <gp.hxx>

//=======================================================================
//function : Adaptor3d_OffsetCurve
//purpose  : 
//=======================================================================

Adaptor3d_OffsetCurve::Adaptor3d_OffsetCurve() :
       myOffset( 0.)
{}

//=======================================================================
//function : Adaptor3d_OffsetCurve
//purpose  : 
//=======================================================================

Adaptor3d_OffsetCurve::Adaptor3d_OffsetCurve(const Handle(Adaptor2d_HCurve2d)& C)
{
  Load(C);
}

//=======================================================================
//function : Adaptor3d_OffsetCurve
//purpose  : 
//=======================================================================

Adaptor3d_OffsetCurve::Adaptor3d_OffsetCurve(const Handle(Adaptor2d_HCurve2d)& C,
					 const Standard_Real Offset) 
{
  Load(C);
  Load(Offset);
}

//=======================================================================
//function : Adaptor3d_OffsetCurve
//purpose  : 
//=======================================================================

Adaptor3d_OffsetCurve::Adaptor3d_OffsetCurve(const Handle(Adaptor2d_HCurve2d)& C,
				   const Standard_Real Offset,
				   const Standard_Real WFirst,
				   const Standard_Real WLast)
{
  Load(C);
  Load(Offset,WFirst,WLast);
}

//=======================================================================
//function : Load
//purpose  : 
//=======================================================================

void Adaptor3d_OffsetCurve::Load(const Handle(Adaptor2d_HCurve2d)& C ) 
{
  myCurve = C;
  myOffset = 0.;
}

//=======================================================================
//function : Load
//purpose  : 
//=======================================================================

void Adaptor3d_OffsetCurve::Load( const Standard_Real Offset)
{
  myOffset = Offset;
  myFirst = myCurve->FirstParameter();
  myLast = myCurve->LastParameter();
  
}

//=======================================================================
//function : Load
//purpose  : 
//=======================================================================

void Adaptor3d_OffsetCurve::Load(const Standard_Real Offset,
			       const Standard_Real WFirst,
			       const Standard_Real WLast) 
{
  myOffset = Offset;
  myFirst = WFirst;
  myLast = WLast;
}

//=======================================================================
//function : Continuity
//purpose  : 
//=======================================================================

GeomAbs_Shape Adaptor3d_OffsetCurve::Continuity() const
{
  switch (myCurve->Continuity()) {
  case GeomAbs_CN: return GeomAbs_CN;
  case GeomAbs_C3: return GeomAbs_C2;
  case GeomAbs_C2: return GeomAbs_G2;
  case GeomAbs_G2: return GeomAbs_C1;
  case GeomAbs_C1: return GeomAbs_G1;
  case GeomAbs_G1: return GeomAbs_C0;
  case GeomAbs_C0:
// No Continuity !!
    Standard_TypeMismatch::Raise("Adaptor3d_OffsetCurve::IntervalContinuity");
    break;
  }

  //portage WNT
  return GeomAbs_C0;
}

//=======================================================================
//function : NbIntervals
//purpose  : 
//=======================================================================

Standard_Integer Adaptor3d_OffsetCurve::NbIntervals(const GeomAbs_Shape S) const
{
  GeomAbs_Shape Sh;
  if ( S >= GeomAbs_C2)  Sh = GeomAbs_CN;
  else 
    Sh = (GeomAbs_Shape)((Standard_Integer)S + 2);

  Standard_Integer nbInter = myCurve->NbIntervals(Sh);

  if(nbInter == 1) return nbInter;

  TColStd_Array1OfReal T(1,nbInter+1);

  myCurve->Intervals(T,Sh);

  Standard_Integer first = 1;
  while (T(first) <= myFirst) first++;
  Standard_Integer last = nbInter+1;
  while (T(last) >= myLast) last--;
  return (last - first + 2);
}

//=======================================================================
//function : Intervals
//purpose  : 
//=======================================================================

void Adaptor3d_OffsetCurve::Intervals(TColStd_Array1OfReal& TI, 
				      const GeomAbs_Shape S) const 
{
  GeomAbs_Shape Sh;
  if ( S >= GeomAbs_C2)  Sh = GeomAbs_CN;
  else 
    Sh = (GeomAbs_Shape)((Standard_Integer)S + 2);

  Standard_Integer nbInter = myCurve->NbIntervals(Sh);


  if(nbInter == 1) {
    TI(TI.Lower()) = myFirst ;
    TI(TI.Lower() + 1) = myLast ;
    return;
  }

  TColStd_Array1OfReal T(1,nbInter+1);
  myCurve->Intervals(T,Sh);

  Standard_Integer first = 1;
  while (T(first) <= myFirst) first++;
  Standard_Integer last = nbInter+1;
  while (T(last) >= myLast) last--;

  Standard_Integer i = TI.Lower(), j;
  for (j = first-1; j <= last+1; j++) {
    TI(i) = T(j);
    i++;
  }

  TI(TI.Lower()) = myFirst ;
  TI(TI.Lower() + last-first + 2) = myLast ; 

}


//=======================================================================
//function : Trim
//purpose  : 
//=======================================================================

Handle(Adaptor2d_HCurve2d) Adaptor3d_OffsetCurve::Trim
(const Standard_Real First, 
 const Standard_Real Last,
 const Standard_Real) const 
{
  Handle(Adaptor3d_HOffsetCurve) HO = new Adaptor3d_HOffsetCurve(*this);
  HO->ChangeCurve2d().Load(myOffset,First,Last);
  return HO;
}


//=======================================================================
//function : IsClosed
//purpose  : 
//=======================================================================

Standard_Boolean Adaptor3d_OffsetCurve::IsClosed() const
{
  if ( myOffset == 0.) {
    return myCurve->IsClosed();
  }
  else {
    if (myCurve->Continuity() == GeomAbs_C0)
      return Standard_False;
    else {
      if ( myCurve->IsClosed()) {
	gp_Vec2d Dummy[2];
	gp_Pnt2d P;
	myCurve->D1
	  (myCurve->FirstParameter(),P,Dummy[0]);
	myCurve->D1
	  (myCurve->LastParameter(),P,Dummy[1]);
	if (Dummy[0].IsParallel(Dummy[1],Precision::Angular()) && 
            !(Dummy[0].IsOpposite(Dummy[1],Precision::Angular())))
	  return Standard_True;
	else
	  return Standard_False;
      }
      else
	return Standard_False;
    }
  }
}

//=======================================================================
//function : IsPeriodic
//purpose  : 
//=======================================================================

Standard_Boolean Adaptor3d_OffsetCurve::IsPeriodic() const
{
  return myCurve->IsPeriodic();
}

//=======================================================================
//function : Period
//purpose  : 
//=======================================================================

Standard_Real Adaptor3d_OffsetCurve::Period() const
{
  return myCurve->Period();
}

//=======================================================================
//function : Value
//purpose  : 
//=======================================================================

gp_Pnt2d Adaptor3d_OffsetCurve::Value(const Standard_Real U) const
{
  if ( myOffset != 0.) {
    gp_Pnt2d P;
    gp_Vec2d V;
    Standard_Real Norme;
    myCurve->D1(U, P, V);
    Norme = V.Magnitude();
    V.SetCoord(-V.Y(),V.X());
    if (Norme >= gp::Resolution()) {
      return gp_Pnt2d(P.XY()+myOffset*V.XY()/Norme);
    }
    else {
      gp_VectorWithNullMagnitude::Raise("Adaptor3d_OffsetCurve::Value");
      return gp_Pnt2d();
    }
  }
  else {
    return myCurve->Value(U);
  }
}

//=======================================================================
//function : D0
//purpose  : 
//=======================================================================

void Adaptor3d_OffsetCurve::D0(const Standard_Real U, gp_Pnt2d& P) const
{
  P = Value( U);
}

//=======================================================================
//function : D1
//purpose  : 
//=======================================================================

void Adaptor3d_OffsetCurve::D1
  (const Standard_Real U, gp_Pnt2d& P, gp_Vec2d& V) const
{
  gp_Vec2d V1,V2,V3;
  gp_Pnt2d PP;
  Standard_Real Norme;
  if ( myOffset != 0. ) {
    myCurve->D2(U,PP,V1,V2);
    Norme = V1.Magnitude();
    V3.SetCoord( -V1.Y(),V1.X());
    V2.SetCoord( -V2.Y(),V2.X());
    if ( Norme >= gp::Resolution()) {
      P = gp_Pnt2d( PP.XY()+myOffset*V3.XY()/Norme);
      V = gp_Vec2d( V1.XY()+
		   (myOffset/Norme)*(V2.XY()-V3.XY()*
				    (V2.XY()*V3.XY())/(Norme*Norme)));
    }
    else {
      gp_VectorWithNullMagnitude::Raise("Adaptor3d_OffsetCurve::D1");
    }
  }
  else {
    myCurve->D1(U,P,V);
  }
}

//=======================================================================
//function : D2
//purpose  : 
//=======================================================================

void Adaptor3d_OffsetCurve::D2
  (const Standard_Real U, gp_Pnt2d& P, gp_Vec2d& V1, gp_Vec2d& V2) const
{
  if ( myOffset != 0.) {
    gp_Vec2d T1,T2,T3;
    gp_Pnt2d PP;
    Standard_Real Norme;
    myCurve->D3(U,PP,T1,T2,T3);

    Norme = T1.Magnitude();
    if ( Norme >= gp::Resolution()) {
      gp_Vec2d N1,N2,N3;             // Ni = Z ^ Ti
      N1.SetCoord( -T1.Y(), T1.X());
      N2.SetCoord( -T2.Y(), T2.X());
      N3.SetCoord( -T3.Y(), T3.X());
      Standard_Real d12,d13,d22,Nor3,Nor11;
      d12   = T1*T2;
      d22   = T2*T2;
      d13   = T1*T3;
      Nor3  = Norme*Norme*Norme;
      Nor11 = Nor3*Nor3*Nor3*Norme*Norme;
      V2    = gp_Vec2d( -1 * ( (d22+d13)/Nor3 + 3*d12*d12/Nor11) * N1.XY());
      V2    = gp_Vec2d( V2.XY() - (2*d12/Nor3)*N2.XY() + N3.XY()/Norme);
      V2    = gp_Vec2d( myOffset*V2.XY() + T2.XY());

      D1( U,P,V1);
    }
    else {
      gp_VectorWithNullMagnitude::Raise("Adaptor3d_OffsetCurve::D2");
    }
  }
  else {
    myCurve->D2(U,P,V1,V2);
  }
}

//=======================================================================
//function : D3
//purpose  : 
//=======================================================================

//void Adaptor3d_OffsetCurve::D3
//  (const Standard_Real T, 
//   gp_Pnt2d& P, gp_Vec2d& V1, gp_Vec2d& V2, gp_Vec2d& V3) const
void Adaptor3d_OffsetCurve::D3
  (const Standard_Real , 
   gp_Pnt2d& , gp_Vec2d& , gp_Vec2d& , gp_Vec2d& ) const
{
  Standard_NotImplemented::Raise("Adaptor3d_OffsetCurve::D3");
}

//=======================================================================
//function : DN
//purpose  : 
//=======================================================================

gp_Vec2d Adaptor3d_OffsetCurve::DN
//  (const Standard_Real T, const Standard_Integer N) const
  (const Standard_Real , const Standard_Integer ) const
{
  Standard_NotImplemented::Raise("Adaptor3d_OffsetCurve::DN");
  return gp_Vec2d();
}


//=======================================================================
//function : Resolution
//purpose  : 
//=======================================================================

Standard_Real Adaptor3d_OffsetCurve::Resolution(const Standard_Real R3d) const
{
  return Precision::PConfusion(R3d);
}


//=======================================================================
//function : GetType
//purpose  : 
//=======================================================================

GeomAbs_CurveType Adaptor3d_OffsetCurve::GetType() const {

  if ( myOffset == 0.) {
    return myCurve->GetType();
  }
  else {
    switch (myCurve->GetType()) {
      
    case GeomAbs_Line:
      return GeomAbs_Line;
      
    case GeomAbs_Circle:
      return GeomAbs_Circle;
      
    default:
      return GeomAbs_OtherCurve;
      
    }
  }
}

//=======================================================================
//function : Line
//purpose  : 
//=======================================================================

gp_Lin2d Adaptor3d_OffsetCurve::Line() const
{
  if ( GetType() == GeomAbs_Line) {
    gp_Pnt2d P;
    gp_Vec2d V;
    D1(0,P,V);
    return gp_Lin2d(P,V);
  }
  else {
    Standard_NoSuchObject::Raise("Adaptor3d_OffsetCurve::Line");
    return gp_Lin2d();
  }
}


//=======================================================================
//function : Circle
//purpose  : 
//=======================================================================

gp_Circ2d Adaptor3d_OffsetCurve::Circle() const
{
  if ( GetType() == GeomAbs_Circle) {
    if (myOffset == 0.) {
      return myCurve->Circle();
    }
    else {
      gp_Circ2d C1( myCurve->Circle());
      Standard_Real radius = C1.Radius();
      gp_Ax22d axes( C1.Axis());
      gp_Dir2d Xd = axes.XDirection();
      gp_Dir2d Yd = axes.YDirection();
      Standard_Real Crossed = Xd.X()*Yd.Y()-Xd.Y()*Yd.X();
      Standard_Real Signe = ( Crossed > 0.) ? 1. : -1.;

      radius += Signe*myOffset;
      if ( radius > 0.) {
	return gp_Circ2d( axes,radius);
      }
      else if ( radius < 0.) {
	radius = - radius;
	axes.SetXDirection( (axes.XDirection()).Reversed());
	return gp_Circ2d( axes,radius); 
      }
      else {     // Cercle de rayon Nul
	Standard_NoSuchObject::Raise("Adaptor3d_OffsetCurve::Circle");
      }
    }
  }
  else {
    Standard_NoSuchObject::Raise("Adaptor3d_OffsetCurve::Circle");
  }
  // portage WNT
  return gp_Circ2d();
}

//=======================================================================
//function : Ellipse
//purpose  : 
//=======================================================================

gp_Elips2d Adaptor3d_OffsetCurve::Ellipse() const
{
  if (myCurve->GetType() == GeomAbs_Ellipse && myOffset == 0.) {
    return myCurve->Ellipse();;
  }
  else {
    Standard_NoSuchObject::Raise("Adaptor3d_OffsetCurve:Ellipse");
  }
  // portage WNT
  return gp_Elips2d();
}

//=======================================================================
//function : Hyperbola
//purpose  : 
//=======================================================================

gp_Hypr2d Adaptor3d_OffsetCurve::Hyperbola() const
{
  if (myCurve->GetType()==GeomAbs_Hyperbola && myOffset==0.) {
    return myCurve->Hyperbola();
  }
  else {
    Standard_NoSuchObject::Raise("Adaptor3d_OffsetCurve:Hyperbola");
  }
  // portage WNT
  return gp_Hypr2d();
}

//=======================================================================
//function : Parabola
//purpose  : 
//=======================================================================

gp_Parab2d Adaptor3d_OffsetCurve::Parabola() const
{
  if (myCurve->GetType() == GeomAbs_Parabola && myOffset == 0.) {
    return myCurve->Parabola();
  }
  else {
    Standard_NoSuchObject::Raise("Adaptor3d_OffsetCurve:Parabola");
  }
  // portage WNT
  return gp_Parab2d();
}
//=======================================================================
//function : Degree
//purpose  : 
//=======================================================================

Standard_Integer  Adaptor3d_OffsetCurve::Degree() const
{
  GeomAbs_CurveType type = myCurve->GetType();
  if (   (type==GeomAbs_BezierCurve || type==GeomAbs_BSplineCurve) 
      && myOffset == 0.) {
    return myCurve->Degree();
  }
  else {
    Standard_NoSuchObject::Raise("Adaptor3d_offsetCurve::Degree");
    return 0;
  }
}
//=======================================================================
//function : IsRational
//purpose  : 
//=======================================================================

Standard_Boolean  Adaptor3d_OffsetCurve::IsRational() const
{
  if ( myOffset == 0.) {
    return myCurve->IsRational();
  }
  return Standard_False;
}
//=======================================================================
//function : NbPoles
//purpose  : 
//=======================================================================

Standard_Integer  Adaptor3d_OffsetCurve::NbPoles() const
{
  GeomAbs_CurveType type = myCurve->GetType();
  if (   (type==GeomAbs_BezierCurve || type==GeomAbs_BSplineCurve) 
      && myOffset == 0.) {
    return myCurve->NbPoles();
  }
  else {
    Standard_NoSuchObject::Raise("Adaptor3d_OffsetCurve::NbPoles");
    return 0;
  }
}

//=======================================================================
//function : NbKnots
//purpose  : 
//=======================================================================

Standard_Integer  Adaptor3d_OffsetCurve::NbKnots() const
{
  if( myOffset == 0.) {
    return myCurve->NbKnots();
  }
  else {
    Standard_NoSuchObject::Raise("Adaptor3d_OffsetCurve::NbKnots");
    return 0;
  }
}

//=======================================================================
//function : Bezier
//purpose  : 
//=======================================================================

Handle(Geom2d_BezierCurve) Adaptor3d_OffsetCurve::Bezier() const 
{
  Standard_NoSuchObject_Raise_if
    ( myOffset != 0.0e0 || GetType() != GeomAbs_BezierCurve, "");
   return myCurve->Bezier();
}


//=======================================================================
//function : BSpline
//purpose  : 
//=======================================================================

Handle(Geom2d_BSplineCurve) Adaptor3d_OffsetCurve::BSpline() const 
{
  Standard_NoSuchObject_Raise_if
    ( myOffset != 0.0e0 || GetType() != GeomAbs_BSplineCurve, "");

  return myCurve->BSpline();
}


