Salome HOME
Merge from V6_3_BR 15/07/2011
[modules/geom.git] / src / GEOMImpl / GEOMImpl_PositionDriver.cxx
index 8e0fb508fcaa4914614e419b5fc4c1849c72a570..cd2d34473514c227b6328ea5a5fdd78a0e413fcb 100644 (file)
@@ -1,71 +1,98 @@
-// Copyright (C) 2005  OPEN CASCADE, EADS/CCR, LIP6, CEA/DEN,
+// 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
-// 
+//
 // 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 
+// 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 
+//
+// 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 
+// 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
 //
 
-#include <Standard_Stream.hxx>
-
+//#include <Standard_Stream.hxx>
+//
 #include <GEOMImpl_PositionDriver.hxx>
 #include <GEOMImpl_IPosition.hxx>
 #include <GEOMImpl_Types.hxx>
 #include <GEOM_Function.hxx>
 
+#include <GEOMImpl_IMeasureOperations.hxx>
+
+// OCCT Includes
 #include <BRepBuilderAPI_Transform.hxx>
+#include <ShHealOper_EdgeDivide.hxx>
 #include <BRep_Tool.hxx>
+#include <BRepTools.hxx>
+#include <BRepFill_LocationLaw.hxx>
+#include <BRepFill_Edge3DLaw.hxx>
+#include <BRepFill_SectionPlacement.hxx>
+#include <BRepTools_WireExplorer.hxx>
+#include <BRepBuilderAPI_MakeWire.hxx>
+#include <BRepBuilderAPI_MakeVertex.hxx>
 #include <TopoDS.hxx>
 #include <TopoDS_Shape.hxx>
 #include <TopoDS_Vertex.hxx>
+#include <TopoDS_Edge.hxx>
+#include <TopoDS_Wire.hxx>
 #include <TopAbs.hxx>
 #include <TopExp.hxx>
+#include <TopExp_Explorer.hxx>
 #include <gp_Pln.hxx>
 #include <Geom_Plane.hxx>
+#include <Geom_Curve.hxx>
 #include <GProp_GProps.hxx>
 #include <BRepGProp.hxx>
+#include <ShapeAnalysis_Edge.hxx>
+#include <GeomAdaptor_Curve.hxx>
+#include <BRepGProp.hxx>
+#include <ShapeFix_Wire.hxx>
+
+#include <GeomFill_TrihedronLaw.hxx>
+#include <GeomFill_CurveAndTrihedron.hxx>
+#include <GeomFill_CorrectedFrenet.hxx>
 
 #include <Precision.hxx>
 #include <gp_Pnt.hxx>
+#include <gp_Vec.hxx>
+#include <TopExp.hxx>
 
 //=======================================================================
 //function : GetID
 //purpose  :
-//======================================================================= 
+//=======================================================================
 const Standard_GUID& GEOMImpl_PositionDriver::GetID()
 {
   static Standard_GUID aPositionDriver("FF1BBB69-5D14-4df2-980B-3A668264EA16");
-  return aPositionDriver; 
+  return aPositionDriver;
 }
 
 
 //=======================================================================
 //function : GEOMImpl_PositionDriver
-//purpose  : 
+//purpose  :
 //=======================================================================
-GEOMImpl_PositionDriver::GEOMImpl_PositionDriver() 
+GEOMImpl_PositionDriver::GEOMImpl_PositionDriver()
 {
 }
 
 //=======================================================================
 //function : Execute
 //purpose  :
-//======================================================================= 
+//=======================================================================
 Standard_Integer GEOMImpl_PositionDriver::Execute(TFunction_Logbook& log) const
 {
-  if (Label().IsNull()) return 0;    
+  if (Label().IsNull()) return 0;
   Handle(GEOM_Function) aFunction = GEOM_Function::GetFunction(Label());
 
   GEOMImpl_IPosition aCI (aFunction);
@@ -82,61 +109,104 @@ Standard_Integer GEOMImpl_PositionDriver::Execute(TFunction_Logbook& log) const
     TopoDS_Shape aShapeStartLCS = aRefStartLCS->GetValue();
     TopoDS_Shape aShapeEndLCS = aRefEndLCS->GetValue();
 
-    if (aShapeBase.IsNull() || aShapeStartLCS.IsNull() || 
-       aShapeEndLCS.IsNull() || aShapeEndLCS.ShapeType() != TopAbs_FACE)
+    if (aShapeBase.IsNull() || aShapeStartLCS.IsNull() ||
+        aShapeEndLCS.IsNull() || aShapeEndLCS.ShapeType() != TopAbs_FACE)
       return 0;
 
     gp_Trsf aTrsf;
     gp_Ax3 aStartAx3, aDestAx3;
-    aStartAx3.Transform(aShapeStartLCS.Location().Transformation());
-    aDestAx3.Transform(aShapeEndLCS.Location().Transformation());
-
-    Handle(Geom_Surface) aGS2 = BRep_Tool::Surface( TopoDS::Face( aShapeEndLCS ) );
-    if (!aGS2.IsNull() && aGS2->IsKind( STANDARD_TYPE( Geom_Plane ) ) ) {
-      Handle(Geom_Plane) aGPlane2 = Handle(Geom_Plane)::DownCast( aGS2 );
-      gp_Pln aPln2 = aGPlane2->Pln();
-      aDestAx3 = aPln2.Position();
-    }
 
-    if(aShapeStartLCS.ShapeType() == TopAbs_FACE) {
-      Handle(Geom_Surface) aGS = BRep_Tool::Surface( TopoDS::Face( aShapeStartLCS ) );
-      if (!aGS.IsNull() && aGS->IsKind( STANDARD_TYPE( Geom_Plane ) ) ) {
-       Handle(Geom_Plane) aGPlane = Handle(Geom_Plane)::DownCast( aGS );
-       gp_Pln aPln = aGPlane->Pln();
-       aStartAx3 = aPln.Position();
-      }
-      aTrsf.SetDisplacement(aStartAx3, aDestAx3);
-    }
-    else {
-      gp_Trsf aTrsf1, aTrsf2;
-      aTrsf1.SetDisplacement(aStartAx3, aDestAx3); 
-      BRepBuilderAPI_Transform aBT (aShapeBase, aTrsf1, Standard_False);
-      TopoDS_Shape aNewShape = aBT.Shape();
-
-      gp_Pnt aPnt;
-      if (aNewShape.ShapeType() == TopAbs_VERTEX) {
-       aPnt = BRep_Tool::Pnt(TopoDS::Vertex(aNewShape));
-      } 
-      else {
-       GProp_GProps aSystem;
-       if (aNewShape.ShapeType() == TopAbs_EDGE || aNewShape.ShapeType() == TopAbs_WIRE)
-         BRepGProp::LinearProperties(aNewShape, aSystem);
-       else if (aNewShape.ShapeType() == TopAbs_FACE || aNewShape.ShapeType() == TopAbs_SHELL)
-         BRepGProp::SurfaceProperties(aNewShape, aSystem);
-       else
-         BRepGProp::VolumeProperties(aNewShape, aSystem);
-       
-       aPnt = aSystem.CentreOfMass();
-      }
-
-      gp_Vec aVec(aPnt, aDestAx3.Location());
-      aTrsf2.SetTranslation(aVec);
-      aTrsf = aTrsf2 * aTrsf1;
-    }
+    // End LCS
+    aDestAx3 = GEOMImpl_IMeasureOperations::GetPosition(aShapeEndLCS);
+
+    // Start LCS
+    aStartAx3 = GEOMImpl_IMeasureOperations::GetPosition(aShapeStartLCS);
 
+    // Set transformation
+    aTrsf.SetDisplacement(aStartAx3, aDestAx3);
+
+    // Perform transformation
     BRepBuilderAPI_Transform aBRepTrsf (aShapeBase, aTrsf, Standard_False);
     aShape = aBRepTrsf.Shape();
   }
+  else if (aType == POSITION_SHAPE_FROM_GLOBAL ||
+           aType == POSITION_SHAPE_FROM_GLOBAL_COPY) {
+    Handle(GEOM_Function) aRefShape = aCI.GetShape();
+    Handle(GEOM_Function) aRefEndLCS = aCI.GetEndLCS();
+
+    TopoDS_Shape aShapeBase = aRefShape->GetValue();
+    TopoDS_Shape aShapeEndLCS = aRefEndLCS->GetValue();
+
+    if (aShapeBase.IsNull() || aShapeEndLCS.IsNull() ||
+        aShapeEndLCS.ShapeType() != TopAbs_FACE)
+      return 0;
+
+    gp_Trsf aTrsf;
+    gp_Ax3 aStartAx3, aDestAx3;
+
+    // End LCS
+    aDestAx3 = GEOMImpl_IMeasureOperations::GetPosition(aShapeEndLCS);
+
+    // Set transformation
+    aTrsf.SetDisplacement(aStartAx3, aDestAx3);
+
+    // Perform transformation
+    BRepBuilderAPI_Transform aBRepTrsf (aShapeBase, aTrsf, Standard_False);
+    aShape = aBRepTrsf.Shape();
+  }
+  else if (aType == POSITION_ALONG_PATH) {
+    Handle(GEOM_Function) aRefShape = aCI.GetShape();
+    Handle(GEOM_Function) aPathShape = aCI.GetPath();
+    Standard_Real aParameter = aCI.GetDistance();
+    bool aReversed = aCI.GetReverse();
+    if (aReversed)
+      aParameter = 1 - aParameter;
+
+    TopoDS_Shape aShapeBase = aRefShape->GetValue();
+    TopoDS_Shape aPath = aPathShape->GetValue();
+    TopoDS_Wire aWire;
+
+    if (aShapeBase.IsNull() || aPath.IsNull())
+      return 0;
+
+    if ( aPath.ShapeType() == TopAbs_EDGE ) {
+      TopoDS_Edge anEdge = TopoDS::Edge(aPath);
+      aWire = BRepBuilderAPI_MakeWire(anEdge); 
+    }
+    else if ( aPath.ShapeType() == TopAbs_WIRE)
+      aWire = TopoDS::Wire(aPath);
+    else
+      return 0;
+
+    Handle(GeomFill_TrihedronLaw) TLaw = new GeomFill_CorrectedFrenet();
+    Handle(GeomFill_CurveAndTrihedron) aLocationLaw = new GeomFill_CurveAndTrihedron( TLaw );
+    Handle(BRepFill_LocationLaw) aLocation = new BRepFill_Edge3DLaw(aWire, aLocationLaw);
+
+    aLocation->TransformInCompatibleLaw( 0.01 );
+
+    //Calculate a Parameter
+    Standard_Real aFirstParam1 = 0, aLastParam1 = 0; // Parameters of the First edge
+    Standard_Real aFirstParam2 = 0, aLastParam2 = 0; // Parameters of the Last edge
+    aLocation->CurvilinearBounds(aLocation->NbLaw(), aFirstParam2, aLastParam2);
+
+    if ( aLocation->NbLaw() > 1)
+      aLocation->CurvilinearBounds(1, aFirstParam1, aLastParam1);
+    else if ( aLocation->NbLaw() == 1 )
+      aFirstParam1 = aFirstParam2;
+    else
+      return 0;
+
+    Standard_Real aParam = (aFirstParam1 + (aLastParam2 - aFirstParam1)*aParameter );
+
+    TopoDS_Shape CopyShape = aShapeBase;
+    BRepFill_SectionPlacement Place( aLocation, aShapeBase );
+    TopLoc_Location Loc2(Place.Transformation()), Loc1;
+    Loc1 = CopyShape.Location();
+    CopyShape.Location(Loc2.Multiplied(Loc1));
+
+    aLocation->D0( aParam, CopyShape );
+    aShape = CopyShape;
+  }
   else
     return 0;
 
@@ -144,33 +214,33 @@ Standard_Integer GEOMImpl_PositionDriver::Execute(TFunction_Logbook& log) const
 
   aFunction->SetValue(aShape);
 
-  log.SetTouched(Label()); 
+  log.SetTouched(Label());
 
-  return 1;    
+  return 1;
 }
 
 
 //=======================================================================
 //function :  GEOMImpl_PositionDriver_Type_
 //purpose  :
-//======================================================================= 
+//=======================================================================
 Standard_EXPORT Handle_Standard_Type& GEOMImpl_PositionDriver_Type_()
 {
 
   static Handle_Standard_Type aType1 = STANDARD_TYPE(TFunction_Driver);
   if ( aType1.IsNull()) aType1 = STANDARD_TYPE(TFunction_Driver);
   static Handle_Standard_Type aType2 = STANDARD_TYPE(MMgt_TShared);
-  if ( aType2.IsNull()) aType2 = STANDARD_TYPE(MMgt_TShared); 
+  if ( aType2.IsNull()) aType2 = STANDARD_TYPE(MMgt_TShared);
   static Handle_Standard_Type aType3 = STANDARD_TYPE(Standard_Transient);
   if ( aType3.IsNull()) aType3 = STANDARD_TYPE(Standard_Transient);
+
 
   static Handle_Standard_Transient _Ancestors[]= {aType1,aType2,aType3,NULL};
   static Handle_Standard_Type _aType = new Standard_Type("GEOMImpl_PositionDriver",
-                                                        sizeof(GEOMImpl_PositionDriver),
-                                                        1,
-                                                        (Standard_Address)_Ancestors,
-                                                        (Standard_Address)NULL);
+                                                         sizeof(GEOMImpl_PositionDriver),
+                                                         1,
+                                                         (Standard_Address)_Ancestors,
+                                                         (Standard_Address)NULL);
 
   return _aType;
 }
@@ -178,7 +248,7 @@ Standard_EXPORT Handle_Standard_Type& GEOMImpl_PositionDriver_Type_()
 //=======================================================================
 //function : DownCast
 //purpose  :
-//======================================================================= 
+//=======================================================================
 const Handle(GEOMImpl_PositionDriver) Handle(GEOMImpl_PositionDriver)::DownCast(const Handle(Standard_Transient)& AnObject)
 {
   Handle(GEOMImpl_PositionDriver) _anOtherObject;