src/GeomAPI/GeomAPI_Pln.cpp

   1 // Copyright (C) 2014-20xx CEA/DEN, EDF R&D
   2
   3 // File:        GeomAPI_Pln.cpp
   4 // Created:     23 Apr 2014
   5 // Author:      Mikhail PONIKAROV
   6
   7 #include <GeomAPI_Pln.h>
   8 #include <GeomAPI_Ax3.h>
   9 #include <GeomAPI_Pnt.h>
  10 #include <GeomAPI_Dir.h>
  11 #include <GeomAPI_Lin.h>
  12 #include <GeomAPI_XYZ.h>
  13
  14 #include <gp_Pln.hxx>
  15
  16 #include <IntAna_QuadQuadGeo.hxx>
  17
  18 using namespace std;
  19
  20 GeomAPI_Pln::GeomAPI_Pln(const std::shared_ptr<GeomAPI_Ax3>& theAxis)
  21 : GeomAPI_Interface(new gp_Ax3(theAxis->impl<gp_Ax3>()))
  22 {
  23 }
  24
  25 GeomAPI_Pln::GeomAPI_Pln(const std::shared_ptr<GeomAPI_Pnt>& thePoint,
  26                          const std::shared_ptr<GeomAPI_Dir>& theNormal)
  27     : GeomAPI_Interface(new gp_Pln(thePoint->impl<gp_Pnt>(), theNormal->impl<gp_Dir>()))
  28 {
  29 }
  30
  31 GeomAPI_Pln::GeomAPI_Pln(const double theA, const double theB, const double theC, const double theD)
  32     : GeomAPI_Interface(new gp_Pln(theA, theB, theC, theD))
  33 {
  34 }
  35
  36 std::shared_ptr<GeomAPI_Pnt> GeomAPI_Pln::location() const
  37 {
  38   gp_Pnt aLoc = impl<gp_Pln>().Location();
  39   return std::shared_ptr<GeomAPI_Pnt>(new GeomAPI_Pnt(aLoc.X(), aLoc.Y(), aLoc.Z()));
  40 }
  41
  42 std::shared_ptr<GeomAPI_Dir> GeomAPI_Pln::direction() const
  43 {
  44   const gp_Dir& aDir = impl<gp_Pln>().Axis().Direction();
  45   return std::shared_ptr<GeomAPI_Dir>(new GeomAPI_Dir(aDir.X(), aDir.Y(), aDir.Z()));
  46 }
  47
  48 std::shared_ptr<GeomAPI_Dir> GeomAPI_Pln::xDirection() const
  49 {
  50   const gp_Dir& aDir = impl<gp_Pln>().XAxis().Direction();
  51   return std::shared_ptr<GeomAPI_Dir>(new GeomAPI_Dir(aDir.X(), aDir.Y(), aDir.Z()));
  52 }
  53
  54 void GeomAPI_Pln::coefficients(double& theA, double& theB, double& theC, double& theD)
  55 {
  56   impl<gp_Pln>().Coefficients(theA, theB, theC, theD);
  57 }
  58
  59 bool GeomAPI_Pln::isCoincident(const std::shared_ptr<GeomAPI_Pln> thePlane, const double theTolerance)
  60 {
  61   if(!thePlane.get()) {
  62     return false;
  63   }
  64
  65   const gp_Pln& aMyPln = impl<gp_Pln>();
  66   const gp_Pln& anOtherPln = thePlane->impl<gp_Pln>();
  67   return (aMyPln.Contains(anOtherPln.Location(), theTolerance) && aMyPln.Axis().IsParallel(anOtherPln.Axis(), theTolerance));
  68 }
  69
  70 bool GeomAPI_Pln::isParallel(const std::shared_ptr<GeomAPI_Lin> theLine)
  71 {
  72   std::shared_ptr<GeomAPI_XYZ> aLineDir = theLine->direction()->xyz();
  73   std::shared_ptr<GeomAPI_XYZ> aLineLoc = theLine->location()->xyz();
  74
  75   std::shared_ptr<GeomAPI_XYZ> aNormal = direction()->xyz();
  76   std::shared_ptr<GeomAPI_XYZ> aLocation = location()->xyz();
  77
  78   double aDot = aNormal->dot(aLineDir);
  79   return Abs(aDot) < Precision::SquareConfusion();
  80 }
  81
  82 std::shared_ptr<GeomAPI_Pnt> GeomAPI_Pln::intersect(const std::shared_ptr<GeomAPI_Lin>& theLine) const
  83 {
  84   std::shared_ptr<GeomAPI_XYZ> aLineDir = theLine->direction()->xyz();
  85   std::shared_ptr<GeomAPI_XYZ> aLineLoc = theLine->location()->xyz();
  86
  87   std::shared_ptr<GeomAPI_XYZ> aNormal = direction()->xyz();
  88   std::shared_ptr<GeomAPI_XYZ> aLocation = location()->xyz();
  89
  90   double aDot = aNormal->dot(aLineDir);
  91   if (Abs(aDot) < Precision::SquareConfusion())
  92     return std::shared_ptr<GeomAPI_Pnt>();
  93
  94   double aParam = aNormal->dot(aLocation->decreased(aLineLoc)) / aDot;
  95   return std::shared_ptr<GeomAPI_Pnt>(new GeomAPI_Pnt(aLineLoc->added(aLineDir->multiplied(aParam))));
  96 }
  97
  98 std::shared_ptr<GeomAPI_Pnt> GeomAPI_Pln::project(const std::shared_ptr<GeomAPI_Pnt>& thePoint) const
  99 {
 100   std::shared_ptr<GeomAPI_XYZ> aNormal = direction()->xyz();
 101   std::shared_ptr<GeomAPI_XYZ> aLocation = location()->xyz();
 102
 103   std::shared_ptr<GeomAPI_XYZ> aVec = thePoint->xyz()->decreased(aLocation);
 104   double aDot = aNormal->dot(aVec);
 105   std::shared_ptr<GeomAPI_XYZ> aProjection =
 106       aLocation->added(aVec->decreased(aNormal->multiplied(aDot)));
 107   return std::shared_ptr<GeomAPI_Pnt>(new GeomAPI_Pnt(aProjection));
 108 }
 109
 110 double GeomAPI_Pln::distance(const std::shared_ptr<GeomAPI_Pln> thePlane) const
 111 {
 112   const gp_Pln& aMyPln = impl<gp_Pln>();
 113   const gp_Pln& anOtherPln = thePlane->impl<gp_Pln>();
 114
 115   return aMyPln.Distance(anOtherPln);
 116 }
 117
 118 void GeomAPI_Pln::translate(const std::shared_ptr<GeomAPI_Dir> theDir, double theDist)
 119 {
 120   gp_Vec aVec(theDir->impl<gp_Dir>());
 121   aVec.Normalize();
 122   aVec.Multiply(theDist);
 123   implPtr<gp_Pln>()->Translate(aVec);
 124 }
 125
 126 std::shared_ptr<GeomAPI_Lin> GeomAPI_Pln::intersect(const std::shared_ptr<GeomAPI_Pln> thePlane) const
 127 {
 128   std::shared_ptr<GeomAPI_Lin> aRes;
 129
 130   if(!thePlane.get()) {
 131     return aRes;
 132   }
 133
 134   const gp_Pln& aMyPln = impl<gp_Pln>();
 135   const gp_Pln& anOtherPln = thePlane->impl<gp_Pln>();
 136
 137   IntAna_QuadQuadGeo aQuad(aMyPln, anOtherPln, Precision::Confusion(), Precision::Confusion());
 138
 139   if(aQuad.IsDone() != Standard_True) {
 140     return aRes;
 141   }
 142
 143   if(aQuad.NbSolutions() != 1) {
 144     return aRes;
 145   }
 146
 147   gp_Lin aLin = aQuad.Line(1);
 148   gp_Pnt aLoc = aLin.Location();
 149   gp_Dir aDir = aLin.Direction();
 150
 151   std::shared_ptr<GeomAPI_Pnt> aGeomLoc(new GeomAPI_Pnt(aLoc.X(), aLoc.Y(), aLoc.Z()));
 152   std::shared_ptr<GeomAPI_Dir> aGeomDir(new GeomAPI_Dir(aDir.X(), aDir.Y(), aDir.Z()));
 153
 154   aRes.reset(new GeomAPI_Lin(aGeomLoc, aGeomDir));
 155
 156   return aRes;
 157 }