X-Git-Url: http://git.salome-platform.org/gitweb/?a=blobdiff_plain;ds=sidebyside;f=src%2FGEOMImpl%2FGEOMImpl_PointDriver.cxx;h=6fe35c0ee011004bbc04a77dbfa82b31c934cf5f;hb=de2617e3f55fc12bac2da61fcbaf2d96f1e38926;hp=38411ee68be74cfb18c8e1efbfd47c9c8a24c376;hpb=9c7d624fdc08c44e52f1567b80501351b93d8a14;p=modules%2Fgeom.git diff --git a/src/GEOMImpl/GEOMImpl_PointDriver.cxx b/src/GEOMImpl/GEOMImpl_PointDriver.cxx index 38411ee68..6fe35c0ee 100644 --- a/src/GEOMImpl/GEOMImpl_PointDriver.cxx +++ b/src/GEOMImpl/GEOMImpl_PointDriver.cxx @@ -1,23 +1,23 @@ -// Copyright (C) 2007-2010 CEA/DEN, EDF R&D, OPEN CASCADE +// Copyright (C) 2007-2011 CEA/DEN, EDF R&D, OPEN CASCADE // -// Copyright (C) 2003-2007 OPEN CASCADE, EADS/CCR, LIP6, CEA/DEN, -// CEDRAT, EDF R&D, LEG, PRINCIPIA R&D, BUREAU VERITAS +// Copyright (C) 2003-2007 OPEN CASCADE, EADS/CCR, LIP6, CEA/DEN, +// CEDRAT, EDF R&D, LEG, PRINCIPIA R&D, BUREAU VERITAS // -// This library is free software; you can redistribute it and/or -// modify it under the terms of the GNU Lesser General Public -// License as published by the Free Software Foundation; either -// version 2.1 of the License. +// This library is free software; you can redistribute it and/or +// modify it under the terms of the GNU Lesser General Public +// License as published by the Free Software Foundation; either +// version 2.1 of the License. // -// This library is distributed in the hope that it will be useful, -// but WITHOUT ANY WARRANTY; without even the implied warranty of -// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU -// Lesser General Public License for more details. +// This library is distributed in the hope that it will be useful, +// but WITHOUT ANY WARRANTY; without even the implied warranty of +// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU +// Lesser General Public License for more details. // -// You should have received a copy of the GNU Lesser General Public -// License along with this library; if not, write to the Free Software -// Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA +// You should have received a copy of the GNU Lesser General Public +// License along with this library; if not, write to the Free Software +// Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA // -// See http://www.salome-platform.org/ or email : webmaster.salome@opencascade.com +// See http://www.salome-platform.org/ or email : webmaster.salome@opencascade.com // #include @@ -27,26 +27,34 @@ #include #include +#include + +#include #include +#include #include #include -#include -#include + #include +#include #include #include +#include #include #include #include +#include +#include + #include #include + #include -#include -#include -#include -#include +#include + +#include //======================================================================= //function : GetID @@ -72,23 +80,22 @@ GEOMImpl_PointDriver::GEOMImpl_PointDriver() //purpose : local function //======================================================================= static Standard_Boolean getExtremaSolution -(GEOMImpl_IPoint& thePI, - TopoDS_Shape& theRefShape, +(const gp_Pnt& theInitPnt, + const TopoDS_Shape& theRefShape, gp_Pnt& thePnt) { - gp_Pnt anInitPnt( thePI.GetX(), thePI.GetY(), thePI.GetZ() ); - BRepBuilderAPI_MakeVertex mkVertex (anInitPnt); + BRepBuilderAPI_MakeVertex mkVertex (theInitPnt); TopoDS_Vertex anInitV = TopoDS::Vertex(mkVertex.Shape()); - BRepExtrema_DistShapeShape anExt( anInitV, theRefShape ); + BRepExtrema_DistShapeShape anExt (anInitV, theRefShape); if ( !anExt.IsDone() || anExt.NbSolution() < 1 ) return Standard_False; thePnt = anExt.PointOnShape2(1); - Standard_Real aMinDist2 = anInitPnt.SquareDistance( thePnt ); + Standard_Real aMinDist2 = theInitPnt.SquareDistance( thePnt ); for ( Standard_Integer j = 2, jn = anExt.NbSolution(); j <= jn; j++ ) { gp_Pnt aPnt = anExt.PointOnShape2(j); - Standard_Real aDist2 = anInitPnt.SquareDistance( aPnt ); + Standard_Real aDist2 = theInitPnt.SquareDistance( aPnt ); if ( aDist2 > aMinDist2) continue; aMinDist2 = aDist2; @@ -115,10 +122,8 @@ Standard_Integer GEOMImpl_PointDriver::Execute(TFunction_Logbook& log) const if (aType == POINT_XYZ) { aPnt = gp_Pnt(aPI.GetX(), aPI.GetY(), aPI.GetZ()); - } else if (aType == POINT_XYZ_REF) { - Handle(GEOM_Function) aRefPoint = aPI.GetRef(); TopoDS_Shape aRefShape = aRefPoint->GetValue(); if (aRefShape.ShapeType() != TopAbs_VERTEX) { @@ -147,31 +152,73 @@ Standard_Integer GEOMImpl_PointDriver::Execute(TFunction_Logbook& log) const Standard_TypeMismatch::Raise ("Point On Curve creation aborted : curve shape is not an edge"); } - if (!getExtremaSolution( aPI, aRefShape, aPnt ) ) { + gp_Pnt anInitPnt (aPI.GetX(), aPI.GetY(), aPI.GetZ()); + if (!getExtremaSolution(anInitPnt, aRefShape, aPnt)) { Standard_ConstructionError::Raise ("Point On Curve creation aborted : cannot project point"); } } else if (aType == POINT_CURVE_LENGTH) { + // RefCurve Handle(GEOM_Function) aRefCurve = aPI.GetCurve(); - Standard_Real theLength = aPI.GetLength(); - TopoDS_Shape aRefShape = aRefCurve->GetValue(); - if (aRefShape.ShapeType() != TopAbs_EDGE) { + if (aRefCurve.IsNull()) { + Standard_NullObject::Raise + ("Point On Curve creation aborted : curve object is null"); + } + TopoDS_Shape aRefShape1 = aRefCurve->GetValue(); + if (aRefShape1.ShapeType() != TopAbs_EDGE) { Standard_TypeMismatch::Raise ("Point On Curve creation aborted : curve shape is not an edge"); - } - BRepAdaptor_Curve AdapCurve = BRepAdaptor_Curve(TopoDS::Edge(aRefShape)); - Standard_Real theCurveLength = GCPnts_AbscissaPoint::Length(AdapCurve); - //std::cout<<"theCurveLength = "< theCurveLength) { - Standard_ConstructionError::Raise - ("Point On Curve creation aborted : given length is greater than edges length"); + } + TopoDS_Edge aRefEdge = TopoDS::Edge(aRefShape1); + TopoDS_Vertex V1, V2; + TopExp::Vertices(aRefEdge, V1, V2, Standard_True); + + // RefPoint + TopoDS_Vertex aRefVertex; + Handle(GEOM_Function) aRefPoint = aPI.GetRef(); + if (aRefPoint.IsNull()) { + aRefVertex = V1; + } + else { + TopoDS_Shape aRefShape2 = aRefPoint->GetValue(); + if (aRefShape2.ShapeType() != TopAbs_VERTEX) { + Standard_TypeMismatch::Raise + ("Point On Curve creation aborted : start point shape is not a vertex"); + } + aRefVertex = TopoDS::Vertex(aRefShape2); + } + gp_Pnt aRefPnt = BRep_Tool::Pnt(aRefVertex); + + // Length + Standard_Real aLength = aPI.GetLength(); + //Standard_Real theCurveLength = IntTools::Length(aRefEdge); + //if (aLength > theCurveLength) { + // Standard_ConstructionError::Raise + // ("Point On Curve creation aborted : given length is greater than edges length"); + //} + + // Check orientation + Standard_Real UFirst, ULast; + Handle(Geom_Curve) EdgeCurve = BRep_Tool::Curve(aRefEdge, UFirst, ULast); + Handle(Geom_Curve) ReOrientedCurve = EdgeCurve; + + Standard_Real dU = ULast - UFirst; + Standard_Real par1 = UFirst + 0.1 * dU; + Standard_Real par2 = ULast - 0.1 * dU; + + gp_Pnt P1 = EdgeCurve->Value(par1); + gp_Pnt P2 = EdgeCurve->Value(par2); + + if (aRefPnt.SquareDistance(P2) < aRefPnt.SquareDistance(P1)) { + ReOrientedCurve = EdgeCurve->Reversed(); + UFirst = EdgeCurve->ReversedParameter(ULast); } - GCPnts_AbscissaPoint anAbsPnt(AdapCurve, aPI.GetLength(), 0); + // Get the point by length + GeomAdaptor_Curve AdapCurve = GeomAdaptor_Curve(ReOrientedCurve); + GCPnts_AbscissaPoint anAbsPnt (AdapCurve, aLength, UFirst); Standard_Real aParam = anAbsPnt.Parameter(); - Standard_Real result_length = GCPnts_AbscissaPoint::Length(AdapCurve, 0, aParam); - std::cout<<"calculated Length of the result = "<