// Created on: 2011-06-30
// Created by: jgv@ROLEX
// Copyright (c) 2011-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 <GeometryTest.hxx>
#include <Geom_Curve.hxx>
#include <Geom2d_Curve.hxx>
#include <Geom_Surface.hxx>
#include <GeomAPI_ProjectPointOnSurf.hxx>

#include <DBRep.hxx>
#include <DBRep_DrawableShape.hxx>
#include <Draw_Interpretor.hxx>
#include <Draw_Appli.hxx>
#include <DrawTrSurf.hxx>
#include <Draw_Marker3D.hxx>

#include <stdio.h>
#ifdef _WIN32
Standard_IMPORT Draw_Viewer dout;
#endif

//=======================================================================
//function : xdistcc
//purpose  : 
//=======================================================================
static Standard_Integer xdistcc(Draw_Interpretor& , Standard_Integer n, const char** a)
{
  if (n < 5)
  {
    cout<<" Use xdistcc c1 c2 t1 t2 nbp"<<endl;
    return 0;
  }

  Standard_Integer i, aNbP, iSize;
  Standard_Real aD, aT, aT1, aT2, dT;
  gp_Pnt aP1, aP2;
  Handle(Geom_Curve) aC1, aC2;
  Handle(Draw_Marker3D) aMr;
  Draw_Color aColor(Draw_rouge);

  aC1=DrawTrSurf::GetCurve(a[1]);
  if (aC1.IsNull())
  {
    cout<<a[1]<<" is null curve"<<endl;
    return 0;
  }

  aC2=DrawTrSurf::GetCurve(a[2]);
  if (aC2.IsNull())
  {
    cout<<a[2]<<" is null curve"<<endl;
    return 0;
  }

  aT1=Draw::Atof(a[3]);
  aT2=Draw::Atof(a[4]);

  aNbP=10;
  if (n > 4)
  {
    aNbP=Draw::Atoi(a[5]);
  }

  iSize=3;

  Standard_Real aMaxParam = 0.0;
  Standard_Real aMaxDist  = 0.0;

  dT=(aT2 - aT1) / (aNbP - 1);
  for(i = 0; i < aNbP; ++i)
  {
    aT=aT1 + i * dT;
    if (i == aNbP-1) 
      aT=aT2;

    aC1->D0(aT, aP1);
    aC2->D0(aT, aP2);

    aD = aP1.Distance(aP2);

    if (aD > aMaxDist)
    {
      aMaxParam = aT;
      aMaxDist = aD;
    }

    printf(" T=%lg\tD=%lg\n", aT, aD);

    aMr=new Draw_Marker3D(aP1, Draw_Plus, aColor, iSize);
    dout << aMr;
  }

  cout << "Max distance = "  << aMaxDist << endl;
  cout << "Param = " << aMaxParam << endl;

  return 0;
}

//=======================================================================
//function : xdistc2dc2dss
//purpose  : 
//=======================================================================
static Standard_Integer xdistc2dc2dss(Draw_Interpretor& , Standard_Integer n, const char** a)
{
  if (n < 7)
  {
    cout<<" Use xdistc2dc2dss c2d_1 c2d_2 s1 s2 t1 t2 nbp"<<endl;
    return 0;
  }

  Standard_Integer i, aNbP, iSize;
  Standard_Real aD, aT, aT1, aT2, dT;
  gp_Pnt aP1, aP2;
  gp_Pnt2d aP2d1, aP2d2;
  Handle(Geom2d_Curve) aC2d1, aC2d2;
  Handle(Geom_Surface) aS1, aS2;
  Handle(Draw_Marker3D) aMr;
  Draw_Color aColor(Draw_rouge);

  aC2d1=DrawTrSurf::GetCurve2d(a[1]);
  if (aC2d1.IsNull())
  {
    cout<<a[1]<<" is null 2dcurve"<<endl;
    return 0;
  }

  aC2d2=DrawTrSurf::GetCurve2d(a[2]);
  if (aC2d2.IsNull())
  {
    cout<<a[2]<<" is null 2dcurve"<<endl;
    return 0;
  }

  aS1=DrawTrSurf::GetSurface(a[3]);
  if (aS1.IsNull())
  {
    cout<<a[3]<<" is null surface"<<endl;
    return 0;
  }

  aS2=DrawTrSurf::GetSurface(a[4]);
  if (aS2.IsNull())
  {
    cout<<a[4]<<" is null surface"<<endl;
    return 0;
  }

  aT1=Draw::Atof(a[5]);
  aT2=Draw::Atof(a[6]);

  aNbP=10;
  if (n > 6)
  {
    aNbP=Draw::Atoi(a[7]);
  }

  iSize=3;

  Standard_Real aMaxParam = 0.0;
  Standard_Real aMaxDist  = 0.0;

  dT=(aT2 - aT1) / (aNbP - 1);
  for(i = 0; i < aNbP; ++i)
  {
    aT=aT1 + i * dT;
    if (i == aNbP-1) 
      aT=aT2;

    aC2d1->D0(aT, aP2d1);
    aS1->D0(aP2d1.X(), aP2d1.Y(), aP1);

    aC2d2->D0(aT, aP2d2);
    aS2->D0(aP2d2.X(), aP2d2.Y(), aP2);

    aD = aP1.Distance(aP2);

    if (aD > aMaxDist)
    {
      aMaxParam = aT;
      aMaxDist = aD;
    }

    printf(" T=%lg\tD=%lg\n", aT, aD);

    aMr=new Draw_Marker3D(aP1, Draw_Plus, aColor, iSize);
    dout << aMr;
  }

  cout << "Max distance = "  << aMaxDist << endl;
  cout << "Param = " << aMaxParam << endl;

  return 0;
}

//=======================================================================
//function : xdistcc2ds
//purpose  : 
//=======================================================================
static Standard_Integer xdistcc2ds(Draw_Interpretor& , Standard_Integer n, const char** a)
{
  if (n < 6)
  {
    cout<<" Use xdistcc2ds c c2d s t1 t2 nbp"<<endl;
    return 0;
  }

  Standard_Integer i, aNbP, iSize;
  Standard_Real aD, aT, aT1, aT2, dT;
  gp_Pnt aP, aPOnS;
  gp_Pnt2d aP2d;
  Handle(Geom_Curve) aC;
  Handle(Geom2d_Curve) aC2d;
  Handle(Geom_Surface) aS;
  Handle(Draw_Marker3D) aMr;
  Draw_Color aColor(Draw_rouge);

  aC=DrawTrSurf::GetCurve(a[1]);
  if (aC.IsNull())
  {
    cout<<a[1]<<" is null curve"<<endl;
    return 0;
  }

  aC2d=DrawTrSurf::GetCurve2d(a[2]);
  if (aC2d.IsNull())
  {
    cout<<a[2]<<" is null 2dcurve"<<endl;
    return 0;
  }

  aS=DrawTrSurf::GetSurface(a[3]);
  if (aS.IsNull())
  {
    cout<<a[3]<<" is null surface"<<endl;
    return 0;
  }

  aT1=Draw::Atof(a[4]);
  aT2=Draw::Atof(a[5]);

  aNbP=10;
  if (n>5)
  {
    aNbP=Draw::Atoi(a[6]);
  }

  iSize=3;

  Standard_Real aMaxParam = 0.0;
  Standard_Real aMaxDist  = 0.0;

  dT=(aT2 - aT1) / (aNbP - 1);
  for(i = 0; i < aNbP; ++i)
  {
    aT=aT1 + i * dT;
    if (i == aNbP-1) 
      aT=aT2;

    aC->D0(aT, aP);

    aC2d->D0(aT, aP2d);
    aS->D0(aP2d.X(), aP2d.Y(), aPOnS);

    aD = aP.Distance(aPOnS);

    if (aD > aMaxDist)
    {
      aMaxParam = aT;
      aMaxDist = aD;
    }

    printf(" T=%lg\tD=%lg\n", aT, aD);

    aMr=new Draw_Marker3D(aP, Draw_Plus, aColor, iSize);
    dout << aMr;
  }

  cout << "Max distance = "  << aMaxDist << endl;
  cout << "Param = " << aMaxParam << endl;

  return 0;
}

//=======================================================================
//function : xdistcs
//purpose  : 
//=======================================================================
static Standard_Integer xdistcs(Draw_Interpretor& di, Standard_Integer n, const char** a)
{
  if (n < 6) {
    cout << "Use: xdistcs curve surface t1 t2 nbpoints [tol [warn_tol]]" << endl;
    cout << "Measures distances from curve to surface by nbpoints probing points on a curve" << endl;
    cout << "Error will be reported for points where distance is greater than tol" << endl;
    cout << "Warning will be reported for points where distance is greater than warn_tol" << endl;
    return 0;
  }
  //
  Standard_Boolean bRet;
  Standard_Integer i, aNbP, iSize;
  Standard_Real aTol, aD, aT, aT1, aT2, dT;
  gp_Pnt aP;
  Handle(Geom_Curve) aC;
  Handle(Geom_Surface) aS;
  GeomAPI_ProjectPointOnSurf aPPS;
  Handle(Draw_Marker3D) aMr;
  Draw_Color aColor(Draw_rouge);
  //
  aTol=1.e-7;
  //
  aC=DrawTrSurf::GetCurve(a[1]);
  if (aC.IsNull()) {
    di << "Error: " << a[1] << " is not a curve!\n";
    return 0;
  }
  //
  aS=DrawTrSurf::GetSurface(a[2]);
  if (aS.IsNull()) {
    di << "Error: " << a[2] << " is not a surface!\n";
    return 0;
  }
  //
  aT1=Draw::Atof(a[3]);
  aT2=Draw::Atof(a[4]);
  //
  aNbP=10;
  if (n>5) {
    aNbP=Draw::Atoi(a[5]);
  }
  Standard_Real anErrTol = (n > 6 ? Draw::Atof(a[6]) : RealLast());
  Standard_Real aWarnTol = (n > 7 ? Draw::Atof(a[7]) : RealLast());
  //
  iSize=3;
  //
  dT=(aT2-aT1)/(aNbP-1);

  Standard_Real aMaxParam = 0.0;
  Standard_Real aMaxDist  = 0.0;
  for (i=0; i<aNbP; ++i) {
    aT=aT1+i*dT;
    if (i==aNbP-1) {
      aT=aT2;
    }
    //
    aC->D0(aT, aP);
    aPPS.Init(aP, aS, aTol);
    bRet=aPPS.IsDone();
    if (!bRet) {
      di << "Error: GeomAPI_ProjectPointOnSurf failed\n";
      return 0;
    }
    //
    aD=aPPS.LowerDistance();
    // report error or warning if distance is greater than tolerance
    if (aD > anErrTol)
    {
      di << "Error :";
    }
    else if (aD > aWarnTol)
    {
      di << "Attention (critical value of tolerance) :";
    }
    char aMsg[256];
    sprintf(aMsg," T=%lg\tD=%lg\n", aT, aD);
    di << aMsg;
    //
    aMr=new Draw_Marker3D(aP, Draw_Plus, aColor, iSize);
    dout << aMr;

    if (aD > aMaxDist)
    {
      aMaxParam = aT;
      aMaxDist = aD;
    }
  }

  di << "Max distance = "  << aMaxDist << "\n" ;
  di << "Param = " << aMaxParam << "\n" ;
  //
  return 0;
}

//=======================================================================
//function : TestProjCommands
//purpose  : 
//=======================================================================

void  GeometryTest::TestProjCommands(Draw_Interpretor& theCommands)
{
  
  static Standard_Boolean loaded = Standard_False;
  if (loaded) return;
  loaded = Standard_True;
  
  DrawTrSurf::BasicCommands(theCommands);
  
  const char* g;
  
  g = "Testing of projection (geometric objects)";
  
  theCommands.Add("xdistcs", "xdistcs curve surface t1 t2 nbpoints [tol [warn_tol]]", __FILE__, xdistcs, g);
  theCommands.Add("xdistcc2ds", "xdistcc2ds c c2d s t1 t2 nbp", __FILE__, xdistcc2ds, g);
  theCommands.Add("xdistc2dc2dss", "xdistc2dc2dss c2d_1 c2d_2 s1 s2 t1 t2 nbp", __FILE__, xdistc2dc2dss, g);
  theCommands.Add("xdistcc", "xdistcc c1 c2 t1 t2 nbp", __FILE__, xdistcc, g);
}