src/SketchSolver/PlaneGCSSolver/PlaneGCSSolver_EdgeWrapper.cpp

   1 // Copyright (C) 2014-2017  CEA/DEN, EDF R&D
   2 //
   3 // This library is free software; you can redistribute it and/or
   4 // modify it under the terms of the GNU Lesser General Public
   5 // License as published by the Free Software Foundation; either
   6 // version 2.1 of the License, or (at your option) any later version.
   7 //
   8 // This library is distributed in the hope that it will be useful,
   9 // but WITHOUT ANY WARRANTY; without even the implied warranty of
  10 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  11 // Lesser General Public License for more details.
  12 //
  13 // You should have received a copy of the GNU Lesser General Public
  14 // License along with this library; if not, write to the Free Software
  15 // Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  16 //
  17 // See http://www.salome-platform.org/ or
  18 // email : webmaster.salome@opencascade.com<mailto:webmaster.salome@opencascade.com>
  19 //
  20
  21 #include <PlaneGCSSolver_EdgeWrapper.h>
  22 #include <cmath>
  23
  24 PlaneGCSSolver_EdgeWrapper::PlaneGCSSolver_EdgeWrapper(const GCSCurvePtr theEntity)
  25   : myEntity(theEntity)
  26 {
  27   std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(myEntity);
  28   if (aLine) myType = ENTITY_LINE;
  29   else {
  30     std::shared_ptr<GCS::Arc> anArc = std::dynamic_pointer_cast<GCS::Arc>(myEntity);
  31     if (anArc) myType = ENTITY_ARC;
  32     else {
  33       std::shared_ptr<GCS::Circle> aCircle = std::dynamic_pointer_cast<GCS::Circle>(myEntity);
  34       if (aCircle) myType = ENTITY_CIRCLE;
  35     }
  36   }
  37 }
  38
  39 static double squareDistance(const GCS::Point& theP1, const GCS::Point& theP2)
  40 {
  41   double dx = *theP1.x - *theP2.x;
  42   double dy = *theP1.y - *theP2.y;
  43   return dx*dx + dy*dy;
  44 }
  45
  46 bool PlaneGCSSolver_EdgeWrapper::isDegenerated() const
  47 {
  48   static const double aSqTol = tolerance * 1e-2;
  49   static const double aMaxRadius = 1e8;
  50   if (myType == ENTITY_LINE) {
  51     std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(myEntity);
  52     return squareDistance(aLine->p1, aLine->p2) < aSqTol;
  53   }
  54   else if (myType == ENTITY_CIRCLE) {
  55     std::shared_ptr<GCS::Circle> aCircle = std::dynamic_pointer_cast<GCS::Circle>(myEntity);
  56     return *aCircle->rad < tolerance || *aCircle->rad > aMaxRadius;
  57   }
  58   else if (myType == ENTITY_ARC) {
  59     static const double anAngleTol = 1.e-5;
  60     std::shared_ptr<GCS::Arc> anArc = std::dynamic_pointer_cast<GCS::Arc>(myEntity);
  61     double anAngleDiff = fabs(*anArc->startAngle - *anArc->endAngle);
  62     double aSqRadius = squareDistance(anArc->center, anArc->start);
  63     return aSqRadius < aSqTol || aSqRadius > aMaxRadius * aMaxRadius || // <- arc radius
  64            anAngleDiff < anAngleTol || fabs(anAngleDiff - 2*PI) < anAngleTol; // <- arc angle
  65   }
  66   return false;
  67 }