1 // Copyright (C) 2007-2014 CEA/DEN, EDF R&D, OPEN CASCADE
3 // Copyright (C) 2003-2007 OPEN CASCADE, EADS/CCR, LIP6, CEA/DEN,
4 // CEDRAT, EDF R&D, LEG, PRINCIPIA R&D, BUREAU VERITAS
6 // This library is free software; you can redistribute it and/or
7 // modify it under the terms of the GNU Lesser General Public
8 // License as published by the Free Software Foundation; either
9 // version 2.1 of the License, or (at your option) any later version.
11 // This library is distributed in the hope that it will be useful,
12 // but WITHOUT ANY WARRANTY; without even the implied warranty of
13 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 // Lesser General Public License for more details.
16 // You should have received a copy of the GNU Lesser General Public
17 // License along with this library; if not, write to the Free Software
18 // Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
20 // See http://www.salome-platform.org/ or email : webmaster.salome@opencascade.com
23 #include "HYDROData_StreamLinearInterpolation.h"
24 #include <HYDROData_Profile.h>
25 #include <HYDROData_ProfileUZ.h>
27 #include <gp_Lin2d.hxx>
28 #include <BRepAdaptor_Curve.hxx>
29 #include <HYDROData_ShapesTool.h>
30 #include <GCPnts_UniformAbscissa.hxx>
31 #include <Geom2dAPI_InterCurveCurve.hxx>
32 #include <Geom2d_Line.hxx>
33 #include <TopoDS_Shape.hxx>
35 #include <HYDROData_Tool.h>
36 #include <GCE2d_MakeLine.hxx>
37 #include <TopoDS_Iterator.hxx>
38 #include <TopExp_Explorer.hxx>
39 #include <BRepAlgo.hxx>
40 #include <Geom2dAdaptor_Curve.hxx>
45 #include <BRepBuilderAPI_MakeEdge2d.hxx>
46 #include <BRepBuilderAPI_MakeEdge.hxx>
47 #include <BRep_Tool.hxx>
48 #include <BRepBuilderAPI_MakeWire.hxx>
49 #include <TopoDS_Face.hxx>
51 #include <BRepBuilderAPI_MakeFace.hxx>
54 #include <Geom_Plane.hxx>
55 #include <TopoDS_Wire.hxx>
56 #include <BRepLib.hxx>
57 #include <BRepLib_MakePolygon.hxx>
58 #include <TopoDS_Compound.hxx>
59 #include <BRep_Builder.hxx>
61 static std::vector<gp_Pnt2d> GetProfileUZPoints(const Handle(HYDROData_Profile)& theProfile)
63 Handle(HYDROData_ProfileUZ) aProfileUZ = theProfile->GetProfileUZ( false );
64 HYDROData_ProfileUZ::PointsList aSectPointsList = aProfileUZ->GetPoints();
65 std::vector<gp_Pnt2d> points;
66 points.reserve(aSectPointsList.Size());
67 for ( int i = 1; i <= aSectPointsList.Size(); i++ )
69 const HYDROData_ProfileUZ::Point& aSectPoint = aSectPointsList(i);
70 points.push_back( gp_Pnt2d(aSectPoint.X(), aSectPoint.Y()));
75 static void GetMaxDist(const std::vector<gp_Pnt2d>& PNTS,
83 std::vector<double> dist;
84 dist.reserve(PNTS.size()-1);
85 for (int i=0; i<PNTS.size()-1; i++)
87 //dist.push_back(PNTS[i].Distance(PNTS[i+1])); //via distance between p1/p2
88 dist.push_back(std::abs(PNTS[i].X()-PNTS[i+1].X())); //via U-diff of p1/p2
90 for (int i=0; i<dist.size(); i++)
99 for (int i=0; i<dist.size(); i++)
102 if (d > dmax2 && d < dmax)
107 static void InsertPoints(std::vector<gp_Pnt2d>& points, int nbpoints)
109 points.reserve(points.size() + nbpoints);
112 double dmax=0, dmax2=0;
114 GetMaxDist(points, dmax, dmax2, imax);
117 nbPins = floor(dmax/dmax2);
119 nbPins = nbpoints; //one segment, put all points here
120 //insert nbPins points in [imax, imax+1] segment
121 gp_Pnt2d p1 = points[imax];
122 gp_Pnt2d p2 = points[imax+1];
127 for (int i=0;i<nbPins;i++)
129 double t = ((double)i+1)/((double)nbPins+1);
130 double Xp = X0 + (X1-X0)*t;
131 double Yp = Y0 + (Y1-Y0)*t;
133 points.insert(points.begin() + imax + 1, P);
139 static void PolyToCurve2d(const Handle(HYDROData_PolylineXY)& poly, Handle(Geom2d_Curve)& c2d)
143 TopoDS_Shape sh = poly->GetShape();
144 if (sh.ShapeType() == TopAbs_COMPOUND)
146 TopoDS_Iterator it(sh);
155 if (sh.ShapeType() == TopAbs_EDGE)
156 ee = TopoDS::Edge(sh);
157 else if (sh.ShapeType() == TopAbs_WIRE)
158 ee = BRepAlgo::ConcatenateWireC0(TopoDS::Wire(sh)); //convert to bspline
163 BRepAdaptor_Curve Ad(ee);
165 c2d = HYDROData_Tool::BRepAdaptorTo2DCurve(Ad);
168 static void InterProfilesAndHAX(const HYDROData_SequenceOfObjects& profiles,
169 const Handle(Geom2d_Curve)& Hax2d,
170 std::map<double, Handle(HYDROData_Profile)>& profToInterParam,
171 std::vector<bool>& paramToSwapFlag,
172 std::vector<std::string>* warnings)
174 for (int i=1;i<=profiles.Size();i++)
176 Handle(HYDROData_Profile) aProfile = Handle(HYDROData_Profile)::DownCast(profiles(i));
178 aProfile->GetLeftPoint( LP, false, true );
179 aProfile->GetRightPoint( RP, false, true );
180 gp_Pnt2d P1(LP), P2(RP);
181 double d = P2.Distance(P1);
182 if (d < gp::Resolution())
185 warnings->push_back(aProfile->GetName().toStdString() + " is skipped: Left and Right points is the same");
188 Handle(Geom2d_Line) lin2d = new Geom2d_Line(P1,gp_Dir2d(P2.XY()-P1.XY()));
189 gp_Dir2d prof_dir2d = lin2d->Direction();
191 Geom2dAdaptor_Curve linAd(lin2d, 0, d);
192 Geom2dAdaptor_Curve haxAd(Hax2d);
193 Geom2dInt_GInter isec( linAd, haxAd, 1.0e-6, 1.0e-6);
197 warnings->push_back(aProfile->GetName().toStdString() + " is skipped: intersection between hydraulic axis & profile is failed");
200 if (isec.NbPoints() == 0)
203 warnings->push_back(aProfile->GetName().toStdString() + " is skipped: no intersection between hydraulic axis & profile");
206 if (isec.NbPoints() > 1)
209 warnings->push_back(aProfile->GetName().toStdString() + " is skipped; intersection between hydraulic axis & profile produces more than 1 point");
212 double param = isec.Point(1).ParamOnSecond();
214 gp_Vec2d vec_on_hax_intersec;
215 haxAd.D1(param, int_p2d, vec_on_hax_intersec);
216 gp_Dir2d d_hax(vec_on_hax_intersec);
217 double ang = d_hax.Angle(prof_dir2d);
219 paramToSwapFlag.push_back(true);
221 paramToSwapFlag.push_back(false);
222 profToInterParam[param] = aProfile;
226 static bool EquidParamsOnHAX(const Handle(Geom2d_Curve)& Hax2d, double step, double fp, double lp, std::set<double>& params)
228 Geom2dAdaptor_Curve ad(Hax2d);
229 GCPnts_UniformAbscissa GUA(ad, step, fp, lp);
233 for(int i = 1; i<= GUA.NbPoints(); i++)
234 params.insert(GUA.Parameter(i));
239 static void GetPointsOnBanks(const std::vector<double>& gua_params,
240 const Handle(Geom2d_Curve)& Hax2d,
241 const Handle(Geom2d_Curve)& LB2d,
242 const Handle(Geom2d_Curve)& RB2d,
243 std::map<double, std::pair<IntRes2d_IntersectionPoint, IntRes2d_IntersectionPoint>>& parToBankPoints,
244 std::vector<std::string>* warnings,
245 const std::map<double, std::pair<Handle(HYDROData_Profile), Handle(HYDROData_Profile)>>* intermParamToProfPair)
247 for(int i = 0; i < gua_params.size(); i++)
249 double par = gua_params[i];
252 Hax2d->D1(par, p, v); //if non-diff?
253 gp_Pnt2d outpLB, outpRB;
255 gp_Dir2d n2d(v.X(), v.Y()); //ignore Z (Z==0)
257 //nLine2d is an orthogonal line to hydr. axis
258 gp_Pnt2d p2d(gp_Pnt2d(p.X(), p.Y()));
259 Handle(Geom2d_Line) nLine2d = new Geom2d_Line(p2d, n2d);
260 //intersect nLine2d with banks
261 Geom2dAPI_InterCurveCurve intL(LB2d, nLine2d);
262 Geom2dAPI_InterCurveCurve intR(RB2d, nLine2d);
264 if (warnings && intL.NbPoints()==0 )
266 std::string coord = (QString::number(p2d.X()) + ", "+QString::number(p2d.Y())).toStdString();
267 if (intermParamToProfPair && intermParamToProfPair->count(par) != 0)
269 std::string fpn = intermParamToProfPair->at(par).first->GetName().toStdString();
270 std::string spn = intermParamToProfPair->at(par).second->GetName().toStdString();
271 warnings->push_back("no intersection between intermediate profile (point on h.axis:("+
272 coord +"), located between " + fpn + " & " + spn + ") and left bank found; skipped");
275 warnings->push_back("no intersection between intermediate profile (point on h.axis:("+ coord +")) and left bank found; skipped");
278 if (warnings && intR.NbPoints()==0)
280 std::string coord = (QString::number(p2d.X()) + ", "+QString::number(p2d.Y())).toStdString();
281 if (intermParamToProfPair && intermParamToProfPair->count(par) != 0)
283 std::string fpn = intermParamToProfPair->at(par).first->GetName().toStdString();
284 std::string spn = intermParamToProfPair->at(par).second->GetName().toStdString();
285 warnings->push_back("no intersection between intermediate profile (point on h.axis:("+
286 coord +"), located between " + fpn + " & " + spn + ") and right bank found; skipped");
289 warnings->push_back("no intersection between intermediate profile (point on h.axis:("+ coord +")) and right bank found; skipped");
292 if ( intL.NbPoints()==0 || intR.NbPoints()==0)
295 IntRes2d_IntersectionPoint aNearSolL, aNearSolR;
296 double min_sq_dist = Precision::Infinite();
297 for (int j=1;j<=intL.NbPoints();j++)
299 double sq_dist = p2d.SquareDistance(intL.Point(j));
300 if (min_sq_dist > sq_dist)
302 min_sq_dist = sq_dist;
303 //aNearSolL = intL.Point(j);
304 aNearSolL = intL.Intersector().Point(j);
307 min_sq_dist = Precision::Infinite();
308 for (int j=1;j<=intR.NbPoints();j++)
310 double sq_dist = p2d.SquareDistance(intR.Point(j));
311 if (min_sq_dist > sq_dist)
313 min_sq_dist = sq_dist;
314 //aNearSolR = intR.Point(j);
315 aNearSolR = intR.Intersector().Point(j);
319 std::pair<IntRes2d_IntersectionPoint, IntRes2d_IntersectionPoint> int_pair(aNearSolL, aNearSolR);
320 parToBankPoints[par]=int_pair;
325 void BuildFace(const std::map<double, std::pair<IntRes2d_IntersectionPoint, IntRes2d_IntersectionPoint>>& parToBankPoints,
326 const Handle(Geom2d_Curve)& LB2d,
327 const Handle(Geom2d_Curve)& RB2d,
328 HYDROData_Stream::PrsDefinition& prsDef)
330 prsDef.myPrs3D.Nullify();
331 prsDef.myPrs2D.Nullify();
332 prsDef.myLeftBank.Nullify();
333 prsDef.myRightBank.Nullify();
334 prsDef.myInlet.Nullify();
335 prsDef.myOutlet.Nullify();
337 double lb_1, lb_2, rb_1, rb_2;
338 lb_1 = parToBankPoints.begin()->second.first.ParamOnFirst();
339 rb_1 = parToBankPoints.begin()->second.second.ParamOnFirst();
341 lb_2 = parToBankPoints.rbegin()->second.first.ParamOnFirst();
342 rb_2 = parToBankPoints.rbegin()->second.second.ParamOnFirst();
344 //stat = GetItersectionParam(F_prof, LB2d, lb_1) && GetItersectionParam(F_prof, RB2d, rb_1)
345 // && GetItersectionParam(S_prof, LB2d, lb_2) && GetItersectionParam(S_prof, RB2d, rb_2);
347 BRepBuilderAPI_MakeEdge2d LEM(LB2d, lb_1, lb_2);
350 BRepBuilderAPI_MakeEdge2d REM(RB2d, rb_1, rb_2);
353 TopoDS_Edge LBE = LEM.Edge();
354 TopoDS_Edge RBE = REM.Edge();
355 if (LBE.IsNull() || RBE.IsNull())
357 BRepBuilderAPI_MakeEdge PFEM(BRep_Tool::Pnt(LEM.Vertex1()), BRep_Tool::Pnt(REM.Vertex1()));
358 BRepBuilderAPI_MakeEdge PLEM(BRep_Tool::Pnt(LEM.Vertex2()), BRep_Tool::Pnt(REM.Vertex2()));
363 TopoDS_Edge FProfE = PFEM.Edge();
364 TopoDS_Edge SProfE = PLEM.Edge();
365 BRepBuilderAPI_MakeWire WM(FProfE, LBE, SProfE, RBE);
368 TopoDS_Wire W = WM.Wire();
369 BRepLib::BuildCurves3d(W);
370 BRepBuilderAPI_MakeFace FM(Geom_Plane(gp::XOY()).Pln(), WM.Wire());
373 prsDef.myPrs2D = FM.Face();
374 prsDef.myLeftBank = LBE;
375 prsDef.myRightBank = RBE;
376 prsDef.myInlet = FProfE;
377 prsDef.myOutlet = SProfE;
382 void reversePoints(std::vector<gp_Pnt2d>& points)
384 std::reverse(points.begin(), points.end());
387 void HYDROData_StreamLinearInterpolation::Perform(const HYDROData_SequenceOfObjects& profiles,
390 const Handle(HYDROData_PolylineXY)& hax,
391 const Handle(HYDROData_PolylineXY)& LB,
392 const Handle(HYDROData_PolylineXY)& RB,
393 HYDROData_Bathymetry::AltitudePoints& outBathypoints,
394 bool buildPresentationShapes,
395 bool estimateWarnOnly,
396 HYDROData_Stream::PrsDefinition& prsDef,
397 std::vector<std::string>* warnings)
399 //intersect profiles with given hydr.axis
400 if (hax.IsNull() || LB.IsNull() || RB.IsNull())
403 Handle(Geom2d_Curve) Hax2d;
404 PolyToCurve2d(hax, Hax2d);
405 if (hax->IsClosed() || Hax2d->IsClosed()) //can't be closed
408 warnings->push_back(hax->GetName().toStdString() + " is closed; abort");
412 std::map<double, Handle(HYDROData_Profile)> InterParamToProf;
413 std::vector<bool> paramToSwapFlag;
414 //profToInterParam is output param map: profile to intersection param on hydr.axis
415 InterProfilesAndHAX(profiles, Hax2d, InterParamToProf, paramToSwapFlag, warnings);
417 std::vector<std::vector<gp_Pnt2d>> profilesPoints;
418 profilesPoints.reserve(InterParamToProf.size());
421 //for (int i=1;i<=InterParamToProf.Extent();i++)
422 for( std::map<double, Handle(HYDROData_Profile)>::iterator it = InterParamToProf.begin(); it != InterParamToProf.end(); ++it )
424 //ordered by param on hydr axis
425 Handle(HYDROData_Profile) aProfile = it->second;
426 const std::vector<gp_Pnt2d>& profile_points = GetProfileUZPoints(aProfile);
427 profilesPoints.push_back(profile_points);
428 if (profile_points.size() > maxNbPoints)
429 maxNbPoints = profile_points.size();
431 std::set<double> paramsOnHAX;
433 if (InterParamToProf.size() <= 1)
436 warnings->push_back("Insufficient count of correct input profiles; abort");
440 EquidParamsOnHAX(Hax2d, stepOnHA, InterParamToProf.begin()->first,
441 InterParamToProf.rbegin()->first, paramsOnHAX);
443 //prepare ParamsPerSegm - number of interm.profiles for profile_points
444 std::vector<std::vector<double>> ParamsPerSegm;
445 std::set<double>::iterator it_params_hax = paramsOnHAX.begin();
446 std::map<double, Handle(HYDROData_Profile)>::iterator it_p = InterParamToProf.begin();
448 std::map<double, std::pair<Handle(HYDROData_Profile), Handle(HYDROData_Profile)>> intermParamToProfPair; //for warnings only
451 ParamsPerSegm.resize(profilesPoints.size()-1);
452 for( int k=0; it_p != InterParamToProf.end(); )
454 if (*it_params_hax < it_p->first)
456 double val = *it_params_hax;
457 ParamsPerSegm[k].push_back(val);
461 const Handle(HYDROData_Profile)& cp = it_p->second;
463 const Handle(HYDROData_Profile)& np = it_p->second;
464 std::pair<Handle(HYDROData_Profile), Handle(HYDROData_Profile)> profPair(cp, np);
465 intermParamToProfPair[val] = profPair;
473 ParamsPerSegm.back().push_back(*paramsOnHAX.rbegin());
475 std::map<double, std::pair<IntRes2d_IntersectionPoint, IntRes2d_IntersectionPoint>> parToBankPoints;
476 std::vector<double> paramHAXVec;
477 paramHAXVec.reserve(paramsOnHAX.size());
478 for( std::set<double>::iterator it = paramsOnHAX.begin(); it != paramsOnHAX.end(); ++it )
479 paramHAXVec.push_back(*it);
481 Handle(Geom2d_Curve) LB2d, RB2d;
482 PolyToCurve2d(LB, LB2d);
483 PolyToCurve2d(RB, RB2d);
484 GetPointsOnBanks( paramHAXVec, Hax2d, LB2d, RB2d, parToBankPoints, warnings, &intermParamToProfPair);
486 if (buildPresentationShapes)
488 //parToBankPoints.begin()->second.;
489 //double lp1 = parToBankPoints.rbegin()->first;
491 //Handle(HYDROData_Profile) F_prof = InterParamToProf.begin()->second;
492 //Handle(HYDROData_Profile) S_prof = InterParamToProf.rbegin()->second;
493 BuildFace(parToBankPoints, LB2d, RB2d, prsDef);
497 if (estimateWarnOnly)
500 maxNbPoints = Max(pointsToInsert, maxNbPoints);
502 //insert points to profiles
503 for (int i=0;i<profilesPoints.size();i++)
505 int nbPointsToInsert = maxNbPoints - profilesPoints[i].size();
506 //insert nbPointsToInsert points to current profile
507 InsertPoints(profilesPoints[i], nbPointsToInsert);
510 for (int i=0;i<profilesPoints.size();i++)
512 bool toSwap = paramToSwapFlag[i];
515 std::vector<gp_Pnt2d>& prof = profilesPoints[i];
520 TopoDS_Compound cmp2d;
521 if ( buildPresentationShapes)
523 BRep_Builder().MakeCompound(cmp2d);
524 BRep_Builder().Add(cmp2d, prsDef.myLeftBank);
525 BRep_Builder().Add(cmp2d, prsDef.myRightBank);
528 for (int i=0;i<profilesPoints.size()-1;i++)
530 const std::vector<gp_Pnt2d>& prof1 = profilesPoints[i];
531 const std::vector<gp_Pnt2d>& prof2 = profilesPoints[i+1];
532 std::vector<std::vector<gp_Pnt2d>> IntermProf;
534 std::map<int, double> indToParam; //index of im.profile to param on hax. ()
535 for (int j=0;j<ParamsPerSegm[i].size();j++)
537 double param = ParamsPerSegm[i][j];
538 if (parToBankPoints.count(param) > 0) //not intersected with banks; skip this
541 int NbIntermProf = indToParam.size();
542 IntermProf.resize(NbIntermProf);
544 for (int l=0;l<NbIntermProf;l++)
545 IntermProf[l].resize(prof1.size());
546 //calc interm. between prof1 & prof2
547 assert (prof1.size() == prof2.size());
548 for (int j=0;j<prof1.size();j++)
550 gp_Pnt2d P1 = prof1[j];
551 gp_Pnt2d P2 = prof2[j];
556 std::map<int, double>::iterator it = indToParam.begin();
557 for ( int m=0; it != indToParam.end(); it++, m++ )
560 double t = ((double)ind+1)/((double)NbIntermProf+1);
561 double Xp = X0 + (X1-X0)*t;
562 double Yp = Y0 + (Y1-Y0)*t;
564 IntermProf[m][j] = P;
567 std::map<int, double>::iterator it = indToParam.begin();
568 for ( int m=0; it != indToParam.end(); it++, m++ )
570 const std::vector<gp_Pnt2d>& im_prof = IntermProf[m];
571 double param = it->second;
572 const std::pair<IntRes2d_IntersectionPoint, IntRes2d_IntersectionPoint>& BB = parToBankPoints[param]; //param is included in map; no checks
573 gp_Pnt2d LP = BB.first.Value();
574 gp_Pnt2d RP = BB.second.Value();
575 HYDROData_ProfileUZ::PointsList pl;
576 for (int k=0;k<im_prof.size();k++)
577 pl.Append(im_prof[k].XY());
578 HYDROData_Profile::ProfilePoints profile_points3d = HYDROData_Profile::CalculateProfilePoints(pl, LP.XY(), RP.XY());
579 for (int k=1;k<=profile_points3d.Length();k++)
581 HYDROData_Bathymetry::AltitudePoint AP(profile_points3d(k).X(), profile_points3d(k).Y(), profile_points3d(k).Z());
582 outBathypoints.push_back(AP);
584 if (buildPresentationShapes)
586 if (m==0 || i == profilesPoints.size()-2 && param == indToParam.rbegin()->second) //if last prof1/prof2 segment => take a last profile too
588 BRepLib_MakePolygon PM;
589 for (int k=1;k<=profile_points3d.Length();k++)
590 PM.Add(gp_Pnt(profile_points3d(k)));
593 const TopoDS_Wire& resW = PM.Wire();
594 BRep_Builder().Add(cmp2d, resW);
600 if (buildPresentationShapes)
602 prsDef.myPrs3D = cmp2d;
604 //outBathy->SetAltitudePoints(bathypoints);