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 GeomAPI_Pln::GeomAPI_Pln(const std::shared_ptr<GeomAPI_Ax3>& theAxis)
  19 : GeomAPI_Interface(new gp_Ax3(theAxis->impl<gp_Ax3>()))
  20 {
  21 }
  22
  23 GeomAPI_Pln::GeomAPI_Pln(const std::shared_ptr<GeomAPI_Pnt>& thePoint,
  24                          const std::shared_ptr<GeomAPI_Dir>& theNormal)
  25     : GeomAPI_Interface(new gp_Pln(thePoint->impl<gp_Pnt>(), theNormal->impl<gp_Dir>()))
  26 {
  27 }
  28
  29 GeomAPI_Pln::GeomAPI_Pln(const double theA, const double theB, const double theC, const double theD)
  30     : GeomAPI_Interface(new gp_Pln(theA, theB, theC, theD))
  31 {
  32 }
  33
  34 std::shared_ptr<GeomAPI_Pnt> GeomAPI_Pln::location() const
  35 {
  36   gp_Pnt aLoc = impl<gp_Pln>().Location();
  37   return std::shared_ptr<GeomAPI_Pnt>(new GeomAPI_Pnt(aLoc.X(), aLoc.Y(), aLoc.Z()));
  38 }
  39
  40 std::shared_ptr<GeomAPI_Dir> GeomAPI_Pln::direction() const
  41 {
  42   const gp_Dir& aDir = impl<gp_Pln>().Axis().Direction();
  43   return std::shared_ptr<GeomAPI_Dir>(new GeomAPI_Dir(aDir.X(), aDir.Y(), aDir.Z()));
  44 }
  45
  46 std::shared_ptr<GeomAPI_Dir> GeomAPI_Pln::xDirection() const
  47 {
  48   const gp_Dir& aDir = impl<gp_Pln>().XAxis().Direction();
  49   return std::shared_ptr<GeomAPI_Dir>(new GeomAPI_Dir(aDir.X(), aDir.Y(), aDir.Z()));
  50 }
  51
  52 void GeomAPI_Pln::coefficients(double& theA, double& theB, double& theC, double& theD)
  53 {
  54   impl<gp_Pln>().Coefficients(theA, theB, theC, theD);
  55 }
  56
  57 bool GeomAPI_Pln::isCoincident(const std::shared_ptr<GeomAPI_Pln> thePlane,
  58                                const double theTolerance)
  59 {
  60   if(!thePlane.get()) {
  61     return false;
  62   }
  63
  64   const gp_Pln& aMyPln = impl<gp_Pln>();
  65   const gp_Pln& anOtherPln = thePlane->impl<gp_Pln>();
  66   return (aMyPln.Contains(anOtherPln.Location(), theTolerance) &&
  67     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>
  83   GeomAPI_Pln::intersect(const std::shared_ptr<GeomAPI_Lin>& theLine) const
  84 {
  85   std::shared_ptr<GeomAPI_XYZ> aLineDir = theLine->direction()->xyz();
  86   std::shared_ptr<GeomAPI_XYZ> aLineLoc = theLine->location()->xyz();
  87
  88   std::shared_ptr<GeomAPI_XYZ> aNormal = direction()->xyz();
  89   std::shared_ptr<GeomAPI_XYZ> aLocation = location()->xyz();
  90
  91   double aDot = aNormal->dot(aLineDir);
  92   if (Abs(aDot) < Precision::SquareConfusion())
  93     return std::shared_ptr<GeomAPI_Pnt>();
  94
  95   double aParam = aNormal->dot(aLocation->decreased(aLineLoc)) / aDot;
  96   return std::shared_ptr<GeomAPI_Pnt>(
  97     new GeomAPI_Pnt(aLineLoc->added(aLineDir->multiplied(aParam))));
  98 }
  99
 100 std::shared_ptr<GeomAPI_Pnt>
 101   GeomAPI_Pln::project(const std::shared_ptr<GeomAPI_Pnt>& thePoint) const
 102 {
 103   std::shared_ptr<GeomAPI_XYZ> aNormal = direction()->xyz();
 104   std::shared_ptr<GeomAPI_XYZ> aLocation = location()->xyz();
 105
 106   std::shared_ptr<GeomAPI_XYZ> aVec = thePoint->xyz()->decreased(aLocation);
 107   double aDot = aNormal->dot(aVec);
 108   std::shared_ptr<GeomAPI_XYZ> aProjection =
 109       aLocation->added(aVec->decreased(aNormal->multiplied(aDot)));
 110   return std::shared_ptr<GeomAPI_Pnt>(new GeomAPI_Pnt(aProjection));
 111 }
 112
 113 double GeomAPI_Pln::distance(const std::shared_ptr<GeomAPI_Pln> thePlane) const
 114 {
 115   const gp_Pln& aMyPln = impl<gp_Pln>();
 116   const gp_Pln& anOtherPln = thePlane->impl<gp_Pln>();
 117
 118   return aMyPln.Distance(anOtherPln);
 119 }
 120
 121 void GeomAPI_Pln::translate(const std::shared_ptr<GeomAPI_Dir> theDir, double theDist)
 122 {
 123   gp_Vec aVec(theDir->impl<gp_Dir>());
 124   aVec.Normalize();
 125   aVec.Multiply(theDist);
 126   implPtr<gp_Pln>()->Translate(aVec);
 127 }
 128
 129 std::shared_ptr<GeomAPI_Lin>
 130   GeomAPI_Pln::intersect(const std::shared_ptr<GeomAPI_Pln> thePlane) const
 131 {
 132   std::shared_ptr<GeomAPI_Lin> aRes;
 133
 134   if(!thePlane.get()) {
 135     return aRes;
 136   }
 137
 138   const gp_Pln& aMyPln = impl<gp_Pln>();
 139   const gp_Pln& anOtherPln = thePlane->impl<gp_Pln>();
 140
 141   IntAna_QuadQuadGeo aQuad(aMyPln, anOtherPln, Precision::Confusion(), Precision::Confusion());
 142
 143   if(aQuad.IsDone() != Standard_True) {
 144     return aRes;
 145   }
 146
 147   if(aQuad.NbSolutions() != 1) {
 148     return aRes;
 149   }
 150
 151   gp_Lin aLin = aQuad.Line(1);
 152   gp_Pnt aLoc = aLin.Location();
 153   gp_Dir aDir = aLin.Direction();
 154
 155   std::shared_ptr<GeomAPI_Pnt> aGeomLoc(new GeomAPI_Pnt(aLoc.X(), aLoc.Y(), aLoc.Z()));
 156   std::shared_ptr<GeomAPI_Dir> aGeomDir(new GeomAPI_Dir(aDir.X(), aDir.Y(), aDir.Z()));
 157
 158   aRes.reset(new GeomAPI_Lin(aGeomLoc, aGeomDir));
 159
 160   return aRes;
 161 }