2 #include <HYDROData_DTM.h>
3 #include <HYDROData_Profile.h>
5 #include <Geom2d_BSplineCurve.hxx>
6 #include <Geom2dAPI_Interpolate.hxx>
7 #include <TColgp_HArray1OfPnt2d.hxx>
8 #include <TColgp_Array1OfVec2d.hxx>
9 #include <TColStd_HArray1OfBoolean.hxx>
11 #include <TopoDS_Edge.hxx>
12 #include <TopoDS_Wire.hxx>
13 #include <TopExp_Explorer.hxx>
14 #include <BRep_Tool.hxx>
16 #include <Geom_Line.hxx>
17 #include <Geom2d_Line.hxx>
18 #include <Geom2d_TrimmedCurve.hxx>
19 #include <Geom_BSplineCurve.hxx>
20 #include <Geom2d_BSplineCurve.hxx>
21 #include <GeomAPI_Interpolate.hxx>
22 #include <TColStd_Array1OfReal.hxx>
23 #include <TColStd_Array1OfInteger.hxx>
24 #include <TColgp_Array1OfPnt.hxx>
25 #include <TColgp_Array1OfVec.hxx>
26 #include <TColgp_HArray1OfPnt.hxx>
27 #include <Geom2dAPI_InterCurveCurve.hxx>
28 #include <Geom2dAPI_ProjectPointOnCurve.hxx>
29 #include <Geom2dAdaptor_Curve.hxx>
30 #include <GCPnts_AbscissaPoint.hxx>
31 #include <BRepBuilderAPI_MakeEdge.hxx>
34 #include <BRepLib_MakeEdge.hxx>
35 #include <BRepLib_MakeWire.hxx>
36 #include <BRep_Builder.hxx>
37 #include <GeomProjLib.hxx>
38 #include <Geom_TrimmedCurve.hxx>
39 #include <Geom_Plane.hxx>
40 #include <BRepTools_WireExplorer.hxx>
41 #include <TopTools_IndexedMapOfShape.hxx>
42 #include <BRepBuilderAPI_MakeFace.hxx>
44 #include <TopTools_IndexedMapOfOrientedShape.hxx>
46 #include <BRepLib_MakeEdge.hxx>
47 #include <BRepLib_MakeWire.hxx>
48 #include <BRep_Builder.hxx>
49 #include <ShapeAnalysis_Wire.hxx>
53 IMPLEMENT_STANDARD_HANDLE( HYDROData_DTM, HYDROData_Bathymetry )
54 IMPLEMENT_STANDARD_RTTIEXT( HYDROData_DTM, HYDROData_Bathymetry )
56 HYDROData_DTM::CurveUZ::CurveUZ( double theXCurv, const gp_Vec2d& theProfileDir, double theDeltaZ )
57 : myXcurv( theXCurv ), myProfileDir( theProfileDir ), myDeltaZ( theDeltaZ )
61 HYDROData_DTM::CurveUZ::~CurveUZ()
65 double HYDROData_DTM::CurveUZ::Xcurv() const
70 gp_Vec2d HYDROData_DTM::CurveUZ::ProfileDir() const
75 double HYDROData_DTM::CurveUZ::DeltaZ() const
80 HYDROData_DTM::CurveUZ HYDROData_DTM::CurveUZ::operator + ( const CurveUZ& c ) const
82 HYDROData_DTM::CurveUZ res( Xcurv() + c.Xcurv(), ProfileDir() + c.ProfileDir(), DeltaZ() + c.DeltaZ() );
83 size_t n = size(), n1 = c.size();
86 std::cout << "Warning: different number of points in curves: " << n << ", " << n1 << std::endl;
89 for( int i=0; i<n; i++ )
92 p.U = operator[]( i ).U + c[i].U;
93 p.Z = operator[]( i ).Z;
99 HYDROData_DTM::CurveUZ HYDROData_DTM::CurveUZ::operator * ( double d ) const
101 HYDROData_DTM::CurveUZ res( Xcurv()*d, ProfileDir()*d, DeltaZ()*d );
104 for( int i=0; i<n; i++ )
107 p.U = operator[]( i ).U * d;
108 p.Z = operator[]( i ).Z;
117 HYDROData_DTM::HYDROData_DTM()
121 HYDROData_DTM::~HYDROData_DTM()
125 HYDROData_SequenceOfObjects HYDROData_DTM::GetProfiles() const
127 return GetReferenceObjects( DataTag_Profiles );
130 void HYDROData_DTM::SetProfiles( const HYDROData_SequenceOfObjects& theProfiles )
132 SetReferenceObjects( theProfiles, DataTag_Profiles );
136 double HYDROData_DTM::GetDDZ() const
138 return GetDouble( DataTag_DDZ );
141 void HYDROData_DTM::SetDDZ( double theDDZ )
143 SetDouble( DataTag_DDZ, theDDZ );
147 double HYDROData_DTM::GetSpatialStep() const
149 return GetDouble( DataTag_SpatialStep );
152 void HYDROData_DTM::SetSpatialStep( double theSpatialStep )
154 SetDouble( DataTag_SpatialStep, theSpatialStep );
158 void HYDROData_DTM::PointToWire(const AltitudePoints& pnts, TopoDS_Wire& W )
163 for (int i = 0; i < pnts.size() - 1; i++)
165 gp_Pnt p1(pnts[i].X, pnts[i].Y, pnts[i].Z);
166 gp_Pnt p2(pnts[i+1].X, pnts[i+1].Y, pnts[i+1].Z);
167 WM.Add(BRepLib_MakeEdge(p1, p2).Edge());
173 TopTools_IndexedMapOfOrientedShape HYDROData_DTM::Create3DShape(const AltitudePoints& left,
174 const AltitudePoints& right,
175 const std::vector<AltitudePoints>& main_profiles)
177 TopTools_IndexedMapOfOrientedShape ll;
178 TopoDS_Wire LWire, RWire;
179 PointToWire(left, LWire);
180 PointToWire(right, RWire);
182 ll.Add(LWire.Oriented(TopAbs_FORWARD));
184 for (int k = 0; k < main_profiles.size(); k++)
187 PointToWire(main_profiles[k], W);
188 TopAbs_Orientation Ori = TopAbs_INTERNAL;
189 if (k == 0 || k == main_profiles.size() - 1)
190 Ori = TopAbs_FORWARD;
191 ll.Add(W.Oriented(Ori));
195 ll.Add(RWire.Oriented(TopAbs_FORWARD));
196 //yes, add subshapes in this order (left + profiles + right)
197 //otherwise the projected wire will be non-manifold
203 void HYDROData_DTM::Update()
205 AltitudePoints points;
206 TopoDS_Shape Out3dPres;
207 TopoDS_Shape Out2dPres;
208 TopoDS_Shape OutLeftB;
209 TopoDS_Shape OutRightB;
210 TopoDS_Shape OutInlet;
211 TopoDS_Shape OutOutlet;
213 HYDROData_SequenceOfObjects objs = GetProfiles();
214 double ddz = GetDDZ();
215 double step = GetSpatialStep();
216 std::set<int> InvInd;
217 bool WireIntersections; //__TODO
218 CreateProfilesFromDTM( objs, ddz, step, points, Out3dPres, Out2dPres, OutLeftB, OutRightB, OutInlet, OutOutlet, true, true, InvInd, -1, WireIntersections );
219 SetAltitudePoints( points );
221 SetShape( DataTag_LeftBankShape, OutLeftB);
222 SetShape( DataTag_RightBankShape, OutRightB);
223 SetShape( DataTag_InletShape, OutInlet);
224 SetShape( DataTag_OutletShape, OutOutlet );
225 SetShape( DataTag_3DShape, Out3dPres );
226 SetShape( DataTag_2DShape, Out2dPres );
228 HYDROData_Bathymetry::Update();
231 void HYDROData_DTM::GetPresentationShapes( TopoDS_Shape& Out3dPres,
232 TopoDS_Shape& Out2dPres,
233 TopoDS_Shape& OutLeftB,
234 TopoDS_Shape& OutRightB,
235 TopoDS_Shape& OutInlet,
236 TopoDS_Shape& OutOutlet )
239 OutLeftB = GetShape( DataTag_LeftBankShape);
240 OutRightB = GetShape( DataTag_RightBankShape);
241 OutInlet = GetShape( DataTag_InletShape);
242 OutOutlet = GetShape( DataTag_OutletShape );
243 Out3dPres = GetShape( DataTag_3DShape );
244 Out2dPres = GetShape( DataTag_2DShape );
247 void HYDROData_DTM::CreateProfilesFromDTM (const HYDROData_SequenceOfObjects& InpProfiles,
250 AltitudePoints& points,
251 TopoDS_Shape& Out3dPres,
252 TopoDS_Shape& Out2dPres,
253 TopoDS_Shape& OutLeftB,
254 TopoDS_Shape& OutRightB,
255 TopoDS_Shape& OutInlet,
256 TopoDS_Shape& OutOutlet,
259 std::set<int>& InvInd,
261 bool& WireIntersections)
263 int aLower = InpProfiles.Lower(), anUpper = InpProfiles.Upper();
264 size_t n = anUpper - aLower + 1;
266 std::vector<Handle_HYDROData_Profile> profiles;
267 profiles.reserve( n );
268 for( int i=aLower; i<=anUpper; i++ )
270 Handle(HYDROData_Profile) aProfile = Handle(HYDROData_Profile)::DownCast( InpProfiles.Value( i ) );
271 if( !aProfile.IsNull() )
272 profiles.push_back( aProfile );
274 const double EPS = 1E-3;
276 AltitudePoints right;
277 std::vector<AltitudePoints> main_profiles;
279 if( thePntsLimit > 0 )
281 int aNbPoints = EstimateNbPoints( profiles, ddz, step );
282 if( aNbPoints < 0 || aNbPoints > thePntsLimit )
286 if( ddz>EPS && step>EPS )
287 CreateProfiles(profiles, ddz, step, left, right, points, main_profiles,
288 Out3dPres, Out2dPres, OutLeftB, OutRightB, OutInlet, OutOutlet, Create3dPres, Create2dPres, InvInd, WireIntersections );
291 void HYDROData_DTM::ProjWireOnPlane(const TopoDS_Wire& inpWire, const Handle_Geom_Plane& RefPlane, TopoDS_Wire& outWire)
293 //its also possible to use BrepAlgo_NormalProjection here!
294 BRepTools_WireExplorer ex(TopoDS::Wire(inpWire.Oriented(TopAbs_FORWARD)));
296 for (;ex.More();ex.Next())
298 const TopoDS_Edge& CE = ex.Current();
300 Handle(Geom_Curve) C3d = BRep_Tool::Curve(CE, f, l);
301 Handle(Geom_Curve) ProjectedCurve = GeomProjLib::ProjectOnPlane(new Geom_TrimmedCurve(C3d, f, l), RefPlane, RefPlane->Position().Direction(), Standard_True);
302 TopoDS_Edge ProjEdge = BRepLib_MakeEdge(ProjectedCurve);
303 WM.Add(ProjEdge); //auto sharing between edges if vertex is coincident
306 outWire.Orientation(inpWire.Orientation()); //take from the original wire
310 bool HYDROData_DTM::Get2dFaceFrom3dPres(const TopoDS_Compound& cmp, TopoDS_Face& outF )
312 Handle_Geom_Plane refpl = new Geom_Plane(gp_Pnt(0,0,0), gp_Dir(0,0,1));
314 TopoDS_Iterator it(cmp);
315 //TopTools_IndexedMapOfShape IntW;
316 for (;it.More(); it.Next())
318 const TopoDS_Wire& W = TopoDS::Wire(it.Value());
319 if (W.Orientation() != TopAbs_INTERNAL)
321 //use list of edges to protect againts non-manifold cases.
322 //auto sharing between edges will be added automatically
323 TopTools_IndexedMapOfShape ME;
324 TopTools_ListOfShape LE;
325 TopExp::MapShapes(W, TopAbs_EDGE, ME);
326 for (int i = 1; i <= ME.Extent(); i++)
335 ProjWireOnPlane(WM.Wire(), refpl, outW);
336 BRepBuilderAPI_MakeFace mf(refpl, outW, true); //check inside is true by def
339 ShapeAnalysis_Wire WA(outW, outF, Precision::Confusion());
340 bool res = WA.CheckSelfIntersection();
343 ///!!! the internal wires cant be added with 'internal' ori.
344 // it's possible to do with brep builder yet the result will not be correct!
345 // more proper way is to use BOP operation here.
346 /*for (int i = 1; i <= IntW.Extent(); i++)
349 const TopoDS_Wire& W = TopoDS::Wire(IntW(i));
350 ProjWireOnPlane(W, refpl, outIW);
355 void HYDROData_DTM::CreateProfiles(const std::vector<Handle_HYDROData_Profile>& theProfiles,
357 double theSpatialStep,
358 AltitudePoints& theOutLeft,
359 AltitudePoints& theOutRight,
360 AltitudePoints& theOutPoints,
361 std::vector<AltitudePoints>& theOutMainProfiles,
362 TopoDS_Shape& Out3dPres,
363 TopoDS_Shape& Out2dPres,
364 TopoDS_Shape& OutLeftB,
365 TopoDS_Shape& OutRightB,
366 TopoDS_Shape& OutInlet,
367 TopoDS_Shape& OutOutlet,
370 std::set<int>& InvInd,
371 bool& WireIntersections)
373 if (theProfiles.empty())
375 theOutPoints = Interpolate( theProfiles, theDDZ, theSpatialStep, theOutLeft, theOutRight, theOutMainProfiles, InvInd );
376 //note that if Create3dPres is false => Create2dPres flag is meaningless!
379 TopTools_IndexedMapOfOrientedShape ll = Create3DShape( theOutLeft, theOutRight, theOutMainProfiles);
385 BB.MakeCompound(cmp);
386 for (int i = 1; i <= ll.Extent(); i++)
391 //same order as in HYDROData_DTM::Update()
393 OutRightB = ll(ll.Extent());
395 OutOutlet = ll(ll.Extent() - 1);
400 WireIntersections = Get2dFaceFrom3dPres(cmp, outF); //__TODO
409 void HYDROData_DTM::GetProperties( const Handle_HYDROData_Profile& theProfile,
410 gp_Pnt& theLowestPoint, gp_Vec2d& theDir,
412 double& theZMin, double& theZMax )
414 theLowestPoint = theProfile->GetBottomPoint();
417 theProfile->GetLeftPoint( aLeft, true, true );
418 theProfile->GetRightPoint( aRight, true, true );
419 double x = aRight.X()-aLeft.X();
420 double y = aRight.Y()-aLeft.Y();
422 theDir = gp_Vec2d( -y, x );
424 theDir = gp_Vec2d( x, y );
426 HYDROData_Profile::ProfilePoints points = theProfile->GetProfilePoints();
427 int lo = points.Lower();
428 int up = points.Upper();
429 theZMin = std::numeric_limits<double>::max();
431 for( int i=lo; i<=up; i++ )
433 double z = points.Value( i ).Z();
441 inline gp_Pnt2d To2D( const gp_Pnt& thePnt, const gp_Trsf& theTr,
442 double& theUMin, double& theUMax )
444 gp_Pnt p = thePnt.Transformed( theTr );
451 return gp_Pnt2d( u, z );
454 Handle(TColgp_HArray1OfPnt2d) To2D( const TColgp_Array1OfPnt& thePoints,
455 const gp_Trsf& theTr,
456 double& theUMin, double& theUMax )
458 int low = thePoints.Lower(), up = thePoints.Upper();
459 Handle(TColgp_HArray1OfPnt2d) points = new TColgp_HArray1OfPnt2d( low, up );
460 for( int i=low; i<=up; i++ )
461 points->SetValue( i, To2D( thePoints.Value( i ), theTr, theUMin, theUMax ) );
465 Handle(Geom2d_Curve) CurveTo2D( const Handle(Geom_Curve)& theCurve,
466 Standard_Real theFirst, Standard_Real theLast,
467 const gp_Trsf& theTr,
468 double& theUMin, double& theUMax )
470 if( theCurve->IsKind( STANDARD_TYPE( Geom_Line ) ) )
472 gp_Pnt aFirstPnt, aLastPnt;
473 theCurve->D0( theFirst, aFirstPnt );
474 theCurve->D0( theLast, aLastPnt );
477 aFirst2d = To2D( aFirstPnt, theTr, theUMin, theUMax ),
478 aLast2d = To2D( aLastPnt, theTr, theUMin, theUMax );
480 gp_Vec2d dir( aFirst2d, aLast2d );
481 Handle_Geom2d_Line aLine2d = new Geom2d_Line( aFirst2d, gp_Dir2d( dir.X(), dir.Y() ) );
482 return new Geom2d_TrimmedCurve( aLine2d, 0, aLast2d.Distance( aFirst2d ) );
485 if( theCurve->IsKind( STANDARD_TYPE( Geom_BSplineCurve ) ) )
487 Handle(Geom_BSplineCurve) aSpline = Handle(Geom_BSplineCurve)::DownCast( theCurve );
489 Handle(TColgp_HArray1OfPnt2d) poles = To2D( aSpline->Poles(), theTr, theUMin, theUMax );
490 const TColStd_Array1OfReal& knots = aSpline->Knots();
491 const TColStd_Array1OfInteger& multiplicities = aSpline->Multiplicities();
492 int aDegree = aSpline->Degree();
494 return new Geom2d_BSplineCurve( poles->Array1(), knots, multiplicities, aDegree );
497 return Handle(Geom2d_Curve)();
500 Handle_Geom2d_BSplineCurve HYDROData_DTM::CreateHydraulicAxis(
501 const std::vector<Handle_HYDROData_Profile>& theProfiles,
502 std::vector<double>& theDistances )
504 size_t n = theProfiles.size();
505 Handle_Geom2d_BSplineCurve aResult;
507 Handle(TColgp_HArray1OfPnt2d) points = new TColgp_HArray1OfPnt2d( 1, (int)n );
508 TColgp_Array1OfVec2d tangents( 1, (int)n );
509 Handle(TColStd_HArray1OfBoolean) flags = new TColStd_HArray1OfBoolean( 1, (int)n );
511 for( size_t i = 1; i <= n; i++ )
513 Handle_HYDROData_Profile aProfile = theProfiles[i-1];
519 GetProperties( aProfile, aLowest, aTangent, true, zmin, zmax );
520 aTangent.Normalize();
522 points->SetValue( (int)i, gp_Pnt2d( aLowest.X(), aLowest.Y() ) );
523 tangents.SetValue( (int)i, aTangent );
524 flags->SetValue( (int)i, Standard_True );
527 Geom2dAPI_Interpolate anInterpolator( points, Standard_False, Standard_False );
528 anInterpolator.Load( tangents, flags );
529 anInterpolator.Perform();
530 if( anInterpolator.IsDone() )
532 aResult = anInterpolator.Curve();
534 //fill the distances vector
535 Geom2dAdaptor_Curve anAdaptor( aResult );
537 theDistances.clear();
538 theDistances.reserve( n );
539 Standard_Real aParamFirst = anAdaptor.FirstParameter(), aParamLast = anAdaptor.LastParameter();
540 for( size_t i = 1; i <= n; i++ )
542 gp_Pnt2d aPnt = points->Value( (Standard_Integer)i );
543 Geom2dAPI_ProjectPointOnCurve aProject( aPnt, aResult );
544 Standard_Real aParam = aProject.LowerDistanceParameter();
545 double aDistance = GCPnts_AbscissaPoint::Length( anAdaptor, aParamFirst, aParam );
546 theDistances.push_back( aDistance );
552 std::vector<Handle_Geom2d_Curve> HYDROData_DTM::ProfileToParametric(
553 const Handle_HYDROData_Profile& theProfile,
554 double& theUMin, double& theUMax, gp_Vec2d& theDir )
556 std::vector<Handle_Geom2d_Curve> curves;
558 // Transformation of the coordinate systems
561 GetProperties( theProfile, aLowest, theDir, false, zmin, zmax );
563 gp_Ax3 aStd3d( gp_Pnt( 0, 0, 0 ), gp_Dir( 0, 0, 1 ), gp_Dir( 1, 0, 0 ) );
564 gp_Ax3 aLocal( gp_Pnt( aLowest.X(), aLowest.Y(), 0 ), gp_Dir( 0, 0, 1 ), gp_Dir( theDir.X(), theDir.Y(), 0 ) );
567 aTransf.SetTransformation( aStd3d, aLocal );
569 // Iteration via edges
570 TopoDS_Wire aWire = TopoDS::Wire( theProfile->GetShape3D() );
571 TopExp_Explorer anExp( aWire, TopAbs_EDGE );
572 for( ; anExp.More(); anExp.Next() )
574 // Extract an edge from wire
575 TopoDS_Edge anEdge = TopoDS::Edge( anExp.Current() );
577 // Extract a curve corresponding to the edge
578 TopLoc_Location aLoc;
579 Standard_Real aFirst, aLast;
580 Handle(Geom_Curve) aCurve = BRep_Tool::Curve( anEdge, aLoc, aFirst, aLast );
582 // Convert the curve to 2d CS
583 Handle(Geom2d_Curve) aCurve2d = CurveTo2D( aCurve, aFirst, aLast, aTransf, theUMin, theUMax );
584 if( !aCurve2d.IsNull() )
585 curves.push_back( aCurve2d );
591 bool CalcMidWidth( const std::set<double>& intersections, double& theMid, double& theWid )
593 double umin = std::numeric_limits<double>::max(),
596 size_t n = intersections.size();
600 std::set<double>::const_iterator it = intersections.begin(), last = intersections.end();
601 for( ; it!=last; it++ )
609 theMid = ( umin+umax )/2;
614 void HYDROData_DTM::ProfileDiscretization( const Handle_HYDROData_Profile& theProfile,
615 double theXCurv, double theMinZ, double theMaxZ, double theDDZ,
616 CurveUZ& theMidPointCurve,
617 CurveUZ& theWidthCurve,
618 int& intersection_nb,
621 double aDblMax = std::numeric_limits<double>::max(),
626 gp_Vec2d aProfileDir;
627 std::vector<Handle_Geom2d_Curve> curves = ProfileToParametric( theProfile, aUMin, aUMax, aProfileDir );
628 size_t n = curves.size();
633 // we add the "virtual" vertical lines to simulate the intersection with profile
634 gp_Pnt2d aFirst, aLast;
635 curves[0]->D0( curves[0]->FirstParameter(), aFirst );
636 curves[n-1]->D0( curves[n-1]->LastParameter(), aLast );
637 Handle(Geom2d_Line) aV1 = new Geom2d_Line( aFirst, gp_Dir2d( 0, 1 ) );
638 Handle(Geom2d_TrimmedCurve) aT1 = new Geom2d_TrimmedCurve( aV1, 0.0, aVMax );
640 Handle(Geom2d_Line) aV2 = new Geom2d_Line( aLast, gp_Dir2d( 0, 1 ) );
641 Handle(Geom2d_TrimmedCurve) aT2 = new Geom2d_TrimmedCurve( aV2, 0.0, aVMax );
643 curves.push_back( aT1 );
644 curves.push_back( aT2 );
646 int psize = ( int )( ( theMaxZ-theMinZ ) / theDDZ + 1 );
647 theMidPointCurve = CurveUZ( theXCurv, aProfileDir, theMinZ );
648 theMidPointCurve.reserve( psize );
649 theWidthCurve = CurveUZ( theXCurv, aProfileDir, theMinZ );
650 theWidthCurve.reserve( psize );
653 // for each discrete value of z we search intersection with profile
654 for( double z1 = theMinZ; z1 <= theMaxZ; z1 += theDDZ )
656 Handle(Geom2d_Line) aLine = new Geom2d_Line( gp_Pnt2d( 0, z1 ), gp_Dir2d( 1, 0 ) );
657 std::set<double> intersections;
658 for( size_t i = 0; i < n; i++ )
660 Handle_Geom2d_Curve aCurve = curves[i];
661 Geom2dAPI_InterCurveCurve anIntersect( aCurve, aLine, theTolerance );
662 for( int k=1, m=anIntersect.NbPoints(); k<=m; k++ )
663 intersections.insert( anIntersect.Point( k ).X() );
666 intersection_nb = intersections.size();
667 if( intersection_nb >= 1 )
670 if( !CalcMidWidth( intersections, u_mid, u_wid ) )
673 double z = z1 - theMinZ;
677 theMidPointCurve.push_back( p_mid );
682 theWidthCurve.push_back( p_wid );
687 void HYDROData_DTM::Interpolate( const CurveUZ& theCurveA, const CurveUZ& theCurveB,
688 int theNbSteps, std::vector<CurveUZ>& theInterpolation,
691 theInterpolation.clear();
692 int d = isAddSecond ? 2 : 1;
693 theInterpolation.reserve( theNbSteps+d );
694 double dt = 1.0 / double( theNbSteps + 1 );
696 theInterpolation.push_back( theCurveA );
697 for( int i=0; i<theNbSteps; i++, t+=dt )
699 CurveUZ anInterp = theCurveA*(1-t) + theCurveB*t;
700 theInterpolation.push_back( anInterp );
703 theInterpolation.push_back( theCurveB );
705 #include <BRepLib_MakeEdge2d.hxx>
706 void HYDROData_DTM::CurveTo3D( const Handle_Geom2d_BSplineCurve& theHydraulicAxis,
707 const CurveUZ& theMidCurve, const CurveUZ& theWidthCurve,
708 AltitudePoints& thePoints )
710 Geom2dAdaptor_Curve anAdaptor( theHydraulicAxis );
711 TopoDS_Edge E2d = BRepLib_MakeEdge2d(theHydraulicAxis).Edge();
712 GCPnts_AbscissaPoint ap( anAdaptor, theMidCurve.Xcurv(), anAdaptor.FirstParameter() );
713 double aParam = ap.Parameter();
716 anAdaptor.D0( aParam, point );
717 gp_Vec2d profile_dir = theMidCurve.ProfileDir();
718 //gp_Dir tangent_n( -profile_dir.Y(), profile_dir.X(), dz );
719 profile_dir.Normalize();
721 size_t n = theMidCurve.size();
722 std::map<double, AltitudePoint> sorted_points;
723 for( size_t i=0; i<n; i++ )
725 double param1 = theMidCurve[i].U - theWidthCurve[i].U / 2;
726 double param2 = theMidCurve[i].U + theWidthCurve[i].U / 2;
728 gp_Pnt2d p1 = point.Translated( param1 * profile_dir);
729 gp_Pnt2d p2 = point.Translated( param2 * profile_dir);
731 double z = theMidCurve[i].Z + theMidCurve.DeltaZ();
733 AltitudePoint p3d_1( p1.X(), p1.Y(), z ), p3d_2( p2.X(), p2.Y(), z );
735 sorted_points[param1] = p3d_1;
736 sorted_points[param2] = p3d_2;
739 thePoints.reserve( sorted_points.size() );
740 const double EPS = 1E-12;
741 std::map<double, AltitudePoint>::const_iterator it = sorted_points.begin(), last = sorted_points.end();
742 for( ; it!=last; it++ )
743 if( thePoints.empty() || thePoints.back().SquareDistance( it->second ) > EPS )
744 thePoints.push_back( it->second );
747 inline double max( double a, double b )
755 inline double min( double a, double b )
763 #include <BRepLib_MakeWire.hxx>
765 std::vector<HYDROData_Bathymetry::AltitudePoints> HYDROData_DTM::Interpolate
766 ( const Handle_Geom2d_BSplineCurve& theHydraulicAxis,
767 const Handle_HYDROData_Profile& theProfileA,
769 const Handle_HYDROData_Profile& theProfileB,
771 double theDDZ, int theNbSteps, bool isAddSecond,
772 int& inter_nb_1, int& inter_nb_2)
774 double zminA, zmaxA, zminB, zmaxB;
775 gp_Pnt lowestA, lowestB;
778 GetProperties( theProfileA, lowestA, dirA, false, zminA, zmaxA );
779 GetProperties( theProfileB, lowestB, dirB, false, zminB, zmaxB );
782 double hmax = max( zmaxA-zminA, zmaxB-zminB );
784 //double dz = zminB - zminA;
785 //double zmin = min( zminA, zminB );
786 //double zmax = max( zmaxA, zmaxB );
788 CurveUZ midA(0, gp_Vec2d(), 0), midB(0, gp_Vec2d(), 0);
789 CurveUZ widA(0, gp_Vec2d(), 0), widB(0, gp_Vec2d(), 0);
791 ProfileDiscretization( theProfileA, theXCurvA, zminA, zminA+hmax, theDDZ, midA, widA, inter_nb_1 );
792 ProfileDiscretization( theProfileB, theXCurvB, zminB, zminB+hmax, theDDZ, midB, widB, inter_nb_2 );
794 std::vector<CurveUZ> mid, wid;
795 Interpolate( midA, midB, theNbSteps, mid, isAddSecond );
796 Interpolate( widA, widB, theNbSteps, wid, isAddSecond );
798 size_t p = mid.size();
799 size_t q = p>0 ? 2*mid[0].size() : 1;
800 std::vector<AltitudePoints> points;
803 for( size_t i=0; i<p; i++ )
805 points[i].reserve( q );
806 CurveTo3D( theHydraulicAxis, mid[i], wid[i], points[i] );
812 HYDROData_Bathymetry::AltitudePoints HYDROData_DTM::Interpolate
813 ( const std::vector<Handle_HYDROData_Profile>& theProfiles,
814 double theDDZ, double theSpatialStep,
815 AltitudePoints& theLeft,
816 AltitudePoints& theRight,
817 std::vector<AltitudePoints>& theMainProfiles,
818 std::set<int>& invalInd)
820 AltitudePoints points;
821 size_t n = theProfiles.size();
825 std::vector<double> distances;
826 Handle_Geom2d_BSplineCurve aHydraulicAxis = CreateHydraulicAxis( theProfiles, distances );
827 if( aHydraulicAxis.IsNull() )
830 theMainProfiles.reserve( n );
832 for( size_t i=0, n1=n-1; i<n1; i++ )
834 double aDistance = distances[i+1]-distances[i];
835 int aNbSteps = int(aDistance/theSpatialStep);
836 bool isAddSecond = i==n1-1;
838 // 1. Calculate interpolated profiles
839 int inter_nb_1, inter_nb_2;
840 std::vector<AltitudePoints> local_points = Interpolate( aHydraulicAxis, theProfiles[i], distances[i],
841 theProfiles[i+1], distances[i+1], theDDZ, aNbSteps, isAddSecond, inter_nb_1, inter_nb_2 );
842 int lps = local_points.size();
848 invalInd.insert(i+1);
850 // 2. Put all points into the global container
851 for( size_t j=0; j<lps; j++ )
853 const AltitudePoints& lp = local_points[j];
855 points.reserve( lp.size() * n );
856 for( size_t k=0, ks=lp.size(); k<ks; k++ )
857 points.push_back( lp[k] );
860 // 3. Get left/right banks' points
863 theLeft.reserve( lps * n );
864 theRight.reserve( lps * n );
866 for( size_t j=0; j<lps; j++ )
868 const AltitudePoints& lp = local_points[j];
869 theLeft.push_back( lp[0] );
870 theRight.push_back( lp[lp.size()-1] );
873 // 4. Get main profiles points
874 theMainProfiles.push_back( local_points[0] );
876 theMainProfiles.push_back( local_points[lps-1] );
881 int HYDROData_DTM::EstimateNbPoints( const std::vector<Handle_HYDROData_Profile>& theProfiles,
882 double theDDZ, double theSpatialStep )
884 size_t n = theProfiles.size();
887 if( theDDZ<1E-6 || theSpatialStep<1E-6 )
890 std::vector<double> distances;
891 Handle_Geom2d_BSplineCurve aHydraulicAxis = CreateHydraulicAxis( theProfiles, distances );
892 if( aHydraulicAxis.IsNull() )
895 double aCompleteDistance = distances[n-1];
896 int aNbSteps = int( aCompleteDistance / theSpatialStep ) + 1;
900 GetProperties( theProfiles[0], aLowest, aDir, true, aZMin, aZMax );
901 int aNbZSteps = (aZMax-aZMin)/theDDZ;
903 if( aNbSteps > ( 1<<16 ) || aNbZSteps > ( 1<<16 ) )
906 return aNbSteps * aNbZSteps;