mirror of
https://git.salome-platform.org/gitpub/modules/geom.git
synced 2025-02-06 13:54:18 +05:00
398 lines
10 KiB
C++
398 lines
10 KiB
C++
|
// File: GEOMAlgo_Tools.cxx
|
||
|
|
// Created: Mon Dec 6 11:35:29 2004
|
||
|
|
// Author: Peter KURNEV
|
||
|
|
// <pkv@irinox>
|
||
|
|
|
||
|
|
#include <GEOMAlgo_Tools.ixx>
|
||
|
|
|
||
|
|
#include <gp_Pnt.hxx>
|
||
|
|
|
||
|
|
#include <Geom_Surface.hxx>
|
||
|
|
#include <Geom_Curve.hxx>
|
||
|
|
|
||
|
|
#include <GeomAPI_ProjectPointOnSurf.hxx>
|
||
|
|
|
||
|
|
#include <TopAbs_ShapeEnum.hxx>
|
||
|
|
|
||
|
|
#include <TopoDS.hxx>
|
||
|
|
#include <TopoDS_Shape.hxx>
|
||
|
|
#include <TopoDS_Edge.hxx>
|
||
|
|
|
||
|
|
#include <TopTools_ListOfShape.hxx>
|
||
|
|
#include <TopTools_ListIteratorOfListOfShape.hxx>
|
||
|
|
#include <TopTools_IndexedMapOfShape.hxx>
|
||
|
|
|
||
|
|
#include <BRep_Tool.hxx>
|
||
|
|
#include <BOPTools_Tools2D.hxx>
|
||
|
|
#include <BRepTools.hxx>
|
||
|
|
|
||
|
|
#include <BOPTools_Tools2D.hxx>
|
||
|
|
#include <IntTools_Context.hxx>
|
||
|
|
|
||
|
|
#include <GEOMAlgo_PassKey.hxx>
|
||
|
|
#include <GEOMAlgo_IndexedDataMapOfPassKeyListOfShape.hxx>
|
||
|
|
|
||
|
|
//=======================================================================
|
||
|
|
//function : RefineSDShapes
|
||
|
|
//purpose :
|
||
|
|
//=======================================================================
|
||
|
|
Standard_Integer GEOMAlgo_Tools::RefineSDShapes(GEOMAlgo_IndexedDataMapOfPassKeyListOfShape &aMPKLE,
|
||
|
|
const Standard_Real aTol,
|
||
|
|
IntTools_Context& aCtx)
|
||
|
|
{
|
||
|
|
Standard_Integer i, aNbE, iErr, j, aNbEE, aNbToAdd;
|
||
|
|
TopTools_IndexedDataMapOfShapeListOfShape aMEE, aMSDE, aMEToAdd;
|
||
|
|
//
|
||
|
|
iErr=1;
|
||
|
|
//
|
||
|
|
aNbE=aMPKLE.Extent();
|
||
|
|
for (i=1; i<=aNbE; ++i) {
|
||
|
|
TopTools_ListOfShape& aLSDE=aMPKLE.ChangeFromIndex(i);
|
||
|
|
aMEE.Clear();
|
||
|
|
//
|
||
|
|
iErr=GEOMAlgo_Tools::FindSDShapes(aLSDE, aTol, aMEE, aCtx);
|
||
|
|
if (iErr) {
|
||
|
|
return iErr;
|
||
|
|
}
|
||
|
|
//
|
||
|
|
aNbEE=aMEE.Extent();
|
||
|
|
if (aNbEE==1) {
|
||
|
|
continue; // nothing to do
|
||
|
|
}
|
||
|
|
//
|
||
|
|
for (j=1; j<=aNbEE; ++j) {
|
||
|
|
TopTools_ListOfShape& aLEE=aMEE.ChangeFromIndex(j);
|
||
|
|
//
|
||
|
|
if (j==1) {
|
||
|
|
aLSDE.Clear();
|
||
|
|
aLSDE.Append(aLEE);
|
||
|
|
}
|
||
|
|
else {
|
||
|
|
const TopoDS_Shape& aE1=aLEE.First();
|
||
|
|
aMEToAdd.Add(aE1, aLEE);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
//
|
||
|
|
aNbToAdd=aMEToAdd.Extent();
|
||
|
|
if (!aNbToAdd) {
|
||
|
|
return aNbToAdd;
|
||
|
|
}
|
||
|
|
//
|
||
|
|
for (i=1; i<=aNbToAdd; ++i) {
|
||
|
|
GEOMAlgo_PassKey aPKE1;
|
||
|
|
//
|
||
|
|
const TopoDS_Shape& aE1=aMEToAdd.FindKey(i);
|
||
|
|
const TopTools_ListOfShape& aLE=aMEToAdd(i);
|
||
|
|
//
|
||
|
|
aPKE1.SetIds(aE1);
|
||
|
|
aMPKLE.Add(aPKE1, aLE);
|
||
|
|
}
|
||
|
|
//
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
//=======================================================================
|
||
|
|
//function : FindSDShapes
|
||
|
|
//purpose :
|
||
|
|
//=======================================================================
|
||
|
|
Standard_Integer GEOMAlgo_Tools::FindSDShapes(const TopTools_ListOfShape& aLE,
|
||
|
|
const Standard_Real aTol,
|
||
|
|
TopTools_IndexedDataMapOfShapeListOfShape& aMEE,
|
||
|
|
IntTools_Context& aCtx)
|
||
|
|
{
|
||
|
|
Standard_Integer aNbE, aNbEProcessed, aNbESD, iErr;
|
||
|
|
TopTools_ListOfShape aLESD;
|
||
|
|
TopTools_ListIteratorOfListOfShape aIt, aIt1;
|
||
|
|
TopTools_IndexedMapOfShape aMProcessed;
|
||
|
|
//
|
||
|
|
aNbE=aLE.Extent();
|
||
|
|
if (!aNbE) {
|
||
|
|
return 3; // Err
|
||
|
|
}
|
||
|
|
//
|
||
|
|
while(1) {
|
||
|
|
aNbEProcessed=aMProcessed.Extent();
|
||
|
|
if (aNbEProcessed==aNbE) {
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
//
|
||
|
|
aIt.Initialize(aLE);
|
||
|
|
for (; aIt.More(); aIt.Next()) {
|
||
|
|
const TopoDS_Shape& aS=aIt.Value();
|
||
|
|
if (aMProcessed.Contains(aS)) {
|
||
|
|
continue;
|
||
|
|
}
|
||
|
|
//
|
||
|
|
aLESD.Clear();
|
||
|
|
iErr=GEOMAlgo_Tools::FindSDShapes(aS, aLE, aTol, aLESD, aCtx);
|
||
|
|
if (iErr) {
|
||
|
|
return 2; // Err
|
||
|
|
}
|
||
|
|
//
|
||
|
|
aNbESD=aLESD.Extent();
|
||
|
|
if (!aNbESD) {
|
||
|
|
return 1; // Err
|
||
|
|
}
|
||
|
|
//
|
||
|
|
aMEE.Add(aS, aLESD);
|
||
|
|
//
|
||
|
|
aIt1.Initialize(aLESD);
|
||
|
|
for (; aIt1.More(); aIt1.Next()) {
|
||
|
|
const TopoDS_Shape& aE1=aIt1.Value();
|
||
|
|
aMProcessed.Add(aE1);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
//=======================================================================
|
||
|
|
//function : FindSDShapes
|
||
|
|
//purpose :
|
||
|
|
//=======================================================================
|
||
|
|
Standard_Integer GEOMAlgo_Tools::FindSDShapes(const TopoDS_Shape& aE1,
|
||
|
|
const TopTools_ListOfShape& aLE,
|
||
|
|
const Standard_Real aTol,
|
||
|
|
TopTools_ListOfShape& aLESD,
|
||
|
|
IntTools_Context& aCtx)
|
||
|
|
{
|
||
|
|
Standard_Boolean bIsDone;
|
||
|
|
Standard_Real aTol2, aD2;
|
||
|
|
gp_Pnt aP1, aP2;
|
||
|
|
TopTools_ListIteratorOfListOfShape aIt;
|
||
|
|
//
|
||
|
|
aTol2=aTol*aTol;
|
||
|
|
GEOMAlgo_Tools::PointOnShape(aE1, aP1);
|
||
|
|
//
|
||
|
|
aIt.Initialize(aLE);
|
||
|
|
for (; aIt.More(); aIt.Next()) {
|
||
|
|
const TopoDS_Shape& aE2=aIt.Value();
|
||
|
|
if (aE2.IsSame(aE1)) {
|
||
|
|
aLESD.Append(aE2);
|
||
|
|
}
|
||
|
|
else {
|
||
|
|
bIsDone=GEOMAlgo_Tools::ProjectPointOnShape(aP1, aE2, aP2, aCtx);
|
||
|
|
if (!bIsDone) {
|
||
|
|
return 1;
|
||
|
|
}
|
||
|
|
aD2=aP1.SquareDistance(aP2);
|
||
|
|
if(aD2<aTol2) {
|
||
|
|
aLESD.Append(aE2);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
//=======================================================================
|
||
|
|
//function : ProjectPointOnShape
|
||
|
|
//purpose :
|
||
|
|
//=======================================================================
|
||
|
|
Standard_Boolean GEOMAlgo_Tools::ProjectPointOnShape(const gp_Pnt& aP1,
|
||
|
|
const TopoDS_Shape& aS,
|
||
|
|
gp_Pnt& aP2,
|
||
|
|
IntTools_Context& aCtx)
|
||
|
|
{
|
||
|
|
Standard_Boolean bIsDone=Standard_False;
|
||
|
|
Standard_Real aT2;
|
||
|
|
TopAbs_ShapeEnum aType;
|
||
|
|
//
|
||
|
|
aType=aS.ShapeType();
|
||
|
|
switch(aType) {
|
||
|
|
case TopAbs_EDGE: {
|
||
|
|
const TopoDS_Edge& aE2=TopoDS::Edge(aS);
|
||
|
|
//
|
||
|
|
bIsDone=aCtx.ProjectPointOnEdge(aP1, aE2, aT2);
|
||
|
|
if (!bIsDone) {
|
||
|
|
return bIsDone;
|
||
|
|
}
|
||
|
|
//
|
||
|
|
GEOMAlgo_Tools::PointOnEdge(aE2, aT2, aP2);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
//
|
||
|
|
case TopAbs_FACE: {
|
||
|
|
const TopoDS_Face& aF2=TopoDS::Face(aS);
|
||
|
|
GeomAPI_ProjectPointOnSurf& aProj=aCtx.ProjPS(aF2);
|
||
|
|
//
|
||
|
|
aProj.Perform(aP1);
|
||
|
|
bIsDone=aProj.IsDone();
|
||
|
|
if (!bIsDone) {
|
||
|
|
return bIsDone;
|
||
|
|
}
|
||
|
|
//
|
||
|
|
aP2=aProj.NearestPoint();
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
//
|
||
|
|
default:
|
||
|
|
break; // Err
|
||
|
|
}
|
||
|
|
return bIsDone;
|
||
|
|
}
|
||
|
|
//=======================================================================
|
||
|
|
//function : PointOnShape
|
||
|
|
//purpose :
|
||
|
|
//=======================================================================
|
||
|
|
void GEOMAlgo_Tools::PointOnShape(const TopoDS_Shape& aS,
|
||
|
|
gp_Pnt& aP3D)
|
||
|
|
{
|
||
|
|
TopAbs_ShapeEnum aType;
|
||
|
|
//
|
||
|
|
aP3D.SetCoord(99.,99.,99.);
|
||
|
|
aType=aS.ShapeType();
|
||
|
|
switch(aType) {
|
||
|
|
case TopAbs_EDGE: {
|
||
|
|
const TopoDS_Edge& aE=TopoDS::Edge(aS);
|
||
|
|
GEOMAlgo_Tools::PointOnEdge(aE, aP3D);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
//
|
||
|
|
case TopAbs_FACE: {
|
||
|
|
const TopoDS_Face& aF=TopoDS::Face(aS);
|
||
|
|
GEOMAlgo_Tools::PointOnFace(aF, aP3D);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
//
|
||
|
|
default:
|
||
|
|
break; // Err
|
||
|
|
}
|
||
|
|
}
|
||
|
|
//=======================================================================
|
||
|
|
//function : PointOnFace
|
||
|
|
//purpose :
|
||
|
|
//=======================================================================
|
||
|
|
void GEOMAlgo_Tools::PointOnFace(const TopoDS_Face& aF,
|
||
|
|
gp_Pnt& aP3D)
|
||
|
|
{
|
||
|
|
Standard_Real aU, aV, aUMin, aUMax, aVMin, aVMax;
|
||
|
|
//
|
||
|
|
BRepTools::UVBounds(aF, aUMin, aUMax, aVMin, aVMax);
|
||
|
|
//
|
||
|
|
aU=BOPTools_Tools2D::IntermediatePoint(aUMin, aUMax);
|
||
|
|
aV=BOPTools_Tools2D::IntermediatePoint(aVMin, aVMax);
|
||
|
|
//
|
||
|
|
GEOMAlgo_Tools::PointOnFace(aF, aU, aV, aP3D);
|
||
|
|
}
|
||
|
|
//=======================================================================
|
||
|
|
//function : PointOnFace
|
||
|
|
//purpose :
|
||
|
|
//=======================================================================
|
||
|
|
void GEOMAlgo_Tools::PointOnFace(const TopoDS_Face& aF,
|
||
|
|
const Standard_Real aU,
|
||
|
|
const Standard_Real aV,
|
||
|
|
gp_Pnt& aP3D)
|
||
|
|
{
|
||
|
|
Handle(Geom_Surface) aS;
|
||
|
|
//
|
||
|
|
aS=BRep_Tool::Surface(aF);
|
||
|
|
aS->D0(aU, aV, aP3D);
|
||
|
|
}
|
||
|
|
//=======================================================================
|
||
|
|
//function : PointOnEdge
|
||
|
|
//purpose :
|
||
|
|
//=======================================================================
|
||
|
|
void GEOMAlgo_Tools::PointOnEdge(const TopoDS_Edge& aE,
|
||
|
|
gp_Pnt& aP3D)
|
||
|
|
{
|
||
|
|
Standard_Real aTx, aT1, aT2;
|
||
|
|
//
|
||
|
|
BRep_Tool::Curve(aE, aT1, aT2);
|
||
|
|
aTx=BOPTools_Tools2D::IntermediatePoint(aT1, aT2);
|
||
|
|
GEOMAlgo_Tools::PointOnEdge(aE, aTx, aP3D);
|
||
|
|
}
|
||
|
|
//=======================================================================
|
||
|
|
//function : PointOnEdge
|
||
|
|
//purpose :
|
||
|
|
//=======================================================================
|
||
|
|
void GEOMAlgo_Tools::PointOnEdge(const TopoDS_Edge& aE,
|
||
|
|
const Standard_Real aT,
|
||
|
|
gp_Pnt& aP3D)
|
||
|
|
{
|
||
|
|
Standard_Real aT1, aT2;
|
||
|
|
Handle(Geom_Curve) aC3D;
|
||
|
|
//
|
||
|
|
aC3D=BRep_Tool::Curve(aE, aT1, aT2);
|
||
|
|
aC3D->D0(aT, aP3D);
|
||
|
|
}
|
||
|
|
/*
|
||
|
|
//=======================================================================
|
||
|
|
//function : FindSDEdges
|
||
|
|
//purpose :
|
||
|
|
//=======================================================================
|
||
|
|
Standard_Integer GEOMAlgo_Tools::FindSDEdges(const TopoDS_Edge& aE1,
|
||
|
|
const TopTools_ListOfShape& aLE,
|
||
|
|
const Standard_Real aTol,
|
||
|
|
TopTools_ListOfShape& aLESD,
|
||
|
|
IntTools_Context& aCtx)
|
||
|
|
{
|
||
|
|
Standard_Boolean bIsDone;
|
||
|
|
Standard_Real aT2, aTol2, aD2;
|
||
|
|
gp_Pnt aP1, aP2;
|
||
|
|
TopTools_ListIteratorOfListOfShape aIt;
|
||
|
|
//
|
||
|
|
aTol2=aTol*aTol;
|
||
|
|
//
|
||
|
|
GEOMAlgo_Tools::PointOnEdge(aE1, aP1);
|
||
|
|
aIt.Initialize(aLE);
|
||
|
|
for (; aIt.More(); aIt.Next()) {
|
||
|
|
const TopoDS_Edge& aE2=TopoDS::Edge(aIt.Value());
|
||
|
|
if (aE2.IsSame(aE1)) {
|
||
|
|
aLESD.Append(aE2);
|
||
|
|
}
|
||
|
|
else {
|
||
|
|
bIsDone=aCtx.ProjectPointOnEdge(aP1, aE2, aT2);
|
||
|
|
if (!bIsDone) {
|
||
|
|
return 1;
|
||
|
|
}
|
||
|
|
GEOMAlgo_Tools::PointOnEdge(aE2, aT2, aP2);
|
||
|
|
aD2=aP1.SquareDistance(aP2);
|
||
|
|
if(aD2<aTol2) {
|
||
|
|
aLESD.Append(aE2);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
//=======================================================================
|
||
|
|
//function : FindSDFaces
|
||
|
|
//purpose :
|
||
|
|
//=======================================================================
|
||
|
|
Standard_Integer GEOMAlgo_Tools::FindSDFaces(const TopoDS_Face& aF1,
|
||
|
|
const TopTools_ListOfShape& aLF,
|
||
|
|
const Standard_Real aTol,
|
||
|
|
TopTools_ListOfShape& aLFSD,
|
||
|
|
IntTools_Context& aCtx)
|
||
|
|
{
|
||
|
|
Standard_Boolean bIsDone;
|
||
|
|
Standard_Real aTol2, aD2;
|
||
|
|
gp_Pnt aP1, aP2;
|
||
|
|
TopTools_ListIteratorOfListOfShape aIt;
|
||
|
|
//
|
||
|
|
aTol2=aTol*aTol;
|
||
|
|
//
|
||
|
|
GEOMAlgo_Tools::PointOnFace(aF1, aP1);
|
||
|
|
aIt.Initialize(aLF);
|
||
|
|
for (; aIt.More(); aIt.Next()) {
|
||
|
|
const TopoDS_Face& aF2=TopoDS::Face(aIt.Value());
|
||
|
|
if (aF2.IsSame(aF1)) {
|
||
|
|
aLFSD.Append(aF2);
|
||
|
|
}
|
||
|
|
else {
|
||
|
|
GeomAPI_ProjectPointOnSurf& aProj=aCtx.ProjPS(aF2);
|
||
|
|
aProj.Perform(aP1);
|
||
|
|
bIsDone=aProj.IsDone();
|
||
|
|
if (!bIsDone) {
|
||
|
|
return 1; //??
|
||
|
|
}
|
||
|
|
//
|
||
|
|
aP2=aProj.NearestPoint();
|
||
|
|
aD2=aP1.SquareDistance(aP2);
|
||
|
|
if(aD2<aTol2) {
|
||
|
|
aLFSD.Append(aF2);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
*/
|