OCCT

// 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.

//    rln 22.03.99: syntax correction in CombineVertex
// szv#4 S4163

#include <BRep_Builder.hxx>
#include <BRep_Tool.hxx>
#include <gp_Pnt.hxx>
#include <ShapeBuild_Vertex.hxx>
#include <TopoDS_Vertex.hxx>

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

TopoDS_Vertex ShapeBuild_Vertex::CombineVertex(const TopoDS_Vertex& V1,
                                               const TopoDS_Vertex& V2,
                                               const double         tolFactor) const
{
  return CombineVertex(BRep_Tool::Pnt(V1),
                       BRep_Tool::Pnt(V2),
                       BRep_Tool::Tolerance(V1),
                       BRep_Tool::Tolerance(V2),
                       tolFactor);
}

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

TopoDS_Vertex ShapeBuild_Vertex::CombineVertex(const gp_Pnt& pnt1,
                                               const gp_Pnt& pnt2,
                                               const double  tol1,
                                               const double  tol2,
                                               const double  tolFactor) const
{
  gp_Pnt pos;
  double tol;

  gp_Vec v    = pnt2.XYZ() - pnt1.XYZ();
  double dist = v.Magnitude();

  // #47 rln 09.12.98 S4054 PRO14323 entity 2844
  if (dist + tol2 <= tol1)
  {
    pos = pnt1;
    tol = tol1;
  }
  else if (dist + tol1 <= tol2)
  {
    pos = pnt2;
    tol = tol2;
  }
  else
  {
    tol      = 0.5 * (dist + tol1 + tol2);
    double s = (dist > 0.) ? (tol2 - tol1) / dist : 0.; // szv#4:S4163:12Mar99 anti-exception
    pos      = 0.5 * ((1 - s) * pnt1.XYZ() + (1 + s) * pnt2.XYZ());
  }

  TopoDS_Vertex V;
  BRep_Builder  B;
  B.MakeVertex(V, pos, tolFactor * tol);
  return V;
}