1 // Copyright (C) 2014-20xx CEA/DEN, EDF R&D
3 // File: GeomAPI_Lin.cpp
4 // Created: 29 May 2014
5 // Author: Artem ZHIDKOV
7 #include <GeomAPI_Lin.h>
8 #include <GeomAPI_Pnt.h>
9 #include <GeomAPI_Dir.h>
13 #include <gp_Lin2d.hxx>
19 #include <IntAna2d_AnaIntersection.hxx>
20 #include <Precision.hxx>
21 #include <ProjLib.hxx>
23 #define MY_LIN implPtr<gp_Lin>()
25 static gp_Lin* newLine(const double theStartX, const double theStartY, const double theStartZ,
26 const double theEndX, const double theEndY, const double theEndZ)
28 gp_XYZ aDir(theEndX - theStartX, theEndY - theStartY, theEndZ - theStartZ);
29 gp_Pnt aStart(theStartX, theStartY, theStartZ);
30 return new gp_Lin(aStart, gp_Dir(aDir));
33 GeomAPI_Lin::GeomAPI_Lin(const double theStartX, const double theStartY, const double theStartZ,
34 const double theEndX, const double theEndY, const double theEndZ)
35 : GeomAPI_Interface(newLine(theStartX, theStartY, theStartZ, theEndX, theEndY, theEndZ))
39 GeomAPI_Lin::GeomAPI_Lin(const std::shared_ptr<GeomAPI_Pnt>& theStart,
40 const std::shared_ptr<GeomAPI_Pnt>& theEnd)
42 newLine(theStart->x(), theStart->y(), theStart->z(), theEnd->x(), theEnd->y(), theEnd->z()))
46 std::shared_ptr<GeomAPI_Pnt> GeomAPI_Lin::location()
48 gp_Pnt aLoc = impl<gp_Lin>().Location();
49 return std::shared_ptr<GeomAPI_Pnt>(new GeomAPI_Pnt(aLoc.X(), aLoc.Y(), aLoc.Z()));
52 std::shared_ptr<GeomAPI_Dir> GeomAPI_Lin::direction()
54 const gp_Dir& aDir = impl<gp_Lin>().Direction();
55 return std::shared_ptr<GeomAPI_Dir>(new GeomAPI_Dir(aDir.X(), aDir.Y(), aDir.Z()));
58 double GeomAPI_Lin::distance(const std::shared_ptr<GeomAPI_Pnt>& thePoint) const
60 return MY_LIN->Distance(thePoint->impl<gp_Pnt>());
63 const std::shared_ptr<GeomAPI_Pnt> GeomAPI_Lin::intersect(
64 const std::shared_ptr<GeomAPI_Lin>& theLine) const
66 if (MY_LIN->SquareDistance(theLine->impl<gp_Lin>()) > Precision::Confusion())
67 return std::shared_ptr<GeomAPI_Pnt>();
69 const gp_Dir& aDir1 = MY_LIN->Direction();
70 const gp_Dir& aDir2 = theLine->impl<gp_Lin>().Direction();
71 gp_Dir aCross = aDir1.Crossed(aDir2);
72 gp_Pln aPlane(MY_LIN->Location(), aCross); // plane containing both lines
74 gp_Lin2d aPrjLine1 = ProjLib::Project(aPlane, *MY_LIN);
75 gp_Lin2d aPrjLine2 = ProjLib::Project(aPlane, theLine->impl<gp_Lin>());
77 IntAna2d_AnaIntersection anInter(aPrjLine1, aPrjLine1);
78 if (!anInter.IsDone() || anInter.IsEmpty())
79 return std::shared_ptr<GeomAPI_Pnt>();
80 const gp_Pnt2d& anIntPnt2d = anInter.Point(0).Value();
81 gp_Pnt aResult = ElSLib::Value(anIntPnt2d.X(), anIntPnt2d.Y(), aPlane);
83 return std::shared_ptr<GeomAPI_Pnt>(
84 new GeomAPI_Pnt(aResult.X(), aResult.Y(), aResult.Z()));
87 const std::shared_ptr<GeomAPI_Pnt> GeomAPI_Lin::project(
88 const std::shared_ptr<GeomAPI_Pnt>& thePoint) const
90 const gp_XYZ& aDir = MY_LIN->Direction().XYZ();
91 const gp_XYZ& aLoc = MY_LIN->Location().XYZ();
92 const gp_XYZ& aPnt = thePoint->impl<gp_Pnt>().XYZ();
93 double aParam = aDir.Dot(aPnt - aLoc);
95 gp_XYZ aResult = aPnt + aDir * aParam;
96 return std::shared_ptr<GeomAPI_Pnt>(new GeomAPI_Pnt(aResult.X(), aResult.Y(), aResult.Z()));