src/SketchPlugin/SketchPlugin_MacroArc.cpp

   1 // Copyright (C) 2014-20xx CEA/DEN, EDF R&D -->
   2
   3 // File:        SketchPlugin_MacroArc.cpp
   4 // Created:     26 Apr 2014
   5 // Author:      Artem ZHIDKOV
   6
   7 #include "SketchPlugin_MacroArc.h"
   8
   9 #include "SketchPlugin_Arc.h"
  10 #include "SketchPlugin_ConstraintTangent.h"
  11 #include "SketchPlugin_Sketch.h"
  12 #include "SketchPlugin_Tools.h"
  13
  14 #include <ModelAPI_AttributeDouble.h>
  15 #include <ModelAPI_AttributeRefAttr.h>
  16 #include <ModelAPI_AttributeString.h>
  17 #include <ModelAPI_Session.h>
  18 #include <ModelAPI_Validator.h>
  19
  20 #include <GeomAPI_Circ.h>
  21 #include <GeomAPI_Circ2d.h>
  22 #include <GeomAPI_Curve.h>
  23 #include <GeomAPI_Dir2d.h>
  24 #include <GeomAPI_Edge.h>
  25 #include <GeomAPI_Lin.h>
  26 #include <GeomAPI_Lin2d.h>
  27 #include <GeomAPI_Pnt2d.h>
  28 #include <GeomAPI_Vertex.h>
  29 #include <GeomAPI_XY.h>
  30
  31 #include <GeomDataAPI_Point2D.h>
  32 #include <GeomDataAPI_Dir.h>
  33 #include <GeomAlgoAPI_PointBuilder.h>
  34 #include <GeomAlgoAPI_EdgeBuilder.h>
  35 #include <GeomAlgoAPI_CompoundBuilder.h>
  36
  37 // for sqrt on Linux
  38 #include <math.h>
  39
  40 const double tolerance = 1e-7;
  41 const double paramTolerance = 1.e-4;
  42 const double PI = 3.141592653589793238463;
  43
  44 static void projectPointOnCircle(AttributePoint2DPtr& thePoint, const GeomAPI_Circ2d& theCircle)
  45 {
  46   std::shared_ptr<GeomAPI_Pnt2d> aProjection = theCircle.project(thePoint->pnt());
  47   if(aProjection.get())
  48     thePoint->setValue(aProjection);
  49 }
  50
  51
  52 SketchPlugin_MacroArc::SketchPlugin_MacroArc()
  53 : SketchPlugin_SketchEntity(),
  54   myParamBefore(0.0)
  55 {
  56 }
  57
  58 void SketchPlugin_MacroArc::initAttributes()
  59 {
  60   data()->addAttribute(ARC_TYPE(), ModelAPI_AttributeString::typeId());
  61
  62   data()->addAttribute(CENTER_POINT_ID(), GeomDataAPI_Point2D::typeId());
  63   data()->addAttribute(START_POINT_1_ID(), GeomDataAPI_Point2D::typeId());
  64   data()->addAttribute(END_POINT_1_ID(), GeomDataAPI_Point2D::typeId());
  65
  66   data()->addAttribute(START_POINT_2_ID(), GeomDataAPI_Point2D::typeId());
  67   data()->addAttribute(END_POINT_2_ID(), GeomDataAPI_Point2D::typeId());
  68   data()->addAttribute(PASSED_POINT_ID(), GeomDataAPI_Point2D::typeId());
  69
  70   data()->addAttribute(TANGENT_POINT_ID(), ModelAPI_AttributeRefAttr::typeId());
  71   data()->addAttribute(END_POINT_3_ID(), GeomDataAPI_Point2D::typeId());
  72
  73   data()->addAttribute(REVERSED_ID(), ModelAPI_AttributeBoolean::typeId());
  74
  75   data()->addAttribute(RADIUS_ID(), ModelAPI_AttributeDouble::typeId());
  76   data()->addAttribute(ANGLE_ID(), ModelAPI_AttributeDouble::typeId());
  77
  78   data()->addAttribute(AUXILIARY_ID(), ModelAPI_AttributeBoolean::typeId());
  79
  80   data()->addAttribute(CENTER_POINT_REF_ID(), ModelAPI_AttributeRefAttr::typeId());
  81   data()->addAttribute(START_POINT_REF_ID(), ModelAPI_AttributeRefAttr::typeId());
  82   data()->addAttribute(END_POINT_REF_ID(), ModelAPI_AttributeRefAttr::typeId());
  83   data()->addAttribute(PASSED_POINT_REF_ID(), ModelAPI_AttributeRefAttr::typeId());
  84
  85   boolean(REVERSED_ID())->setValue(false);
  86
  87   ModelAPI_Session::get()->validators()->registerNotObligatory(getKind(), CENTER_POINT_REF_ID());
  88   ModelAPI_Session::get()->validators()->registerNotObligatory(getKind(), START_POINT_REF_ID());
  89   ModelAPI_Session::get()->validators()->registerNotObligatory(getKind(), END_POINT_REF_ID());
  90   ModelAPI_Session::get()->validators()->registerNotObligatory(getKind(), PASSED_POINT_REF_ID());
  91 }
  92
  93 void SketchPlugin_MacroArc::attributeChanged(const std::string& theID)
  94 {
  95   std::string anArcType = string(ARC_TYPE())->value();
  96
  97   // If arc type switched reset according attributes.
  98   if(theID == ARC_TYPE()) {
  99     SketchPlugin_Tools::resetAttribute(this, CENTER_POINT_ID());
 100     SketchPlugin_Tools::resetAttribute(this, CENTER_POINT_REF_ID());
 101     SketchPlugin_Tools::resetAttribute(this, START_POINT_1_ID());
 102     SketchPlugin_Tools::resetAttribute(this, START_POINT_REF_ID());
 103     SketchPlugin_Tools::resetAttribute(this, END_POINT_1_ID());
 104     SketchPlugin_Tools::resetAttribute(this, END_POINT_REF_ID());
 105     SketchPlugin_Tools::resetAttribute(this, START_POINT_2_ID());
 106     SketchPlugin_Tools::resetAttribute(this, END_POINT_2_ID());
 107     SketchPlugin_Tools::resetAttribute(this, PASSED_POINT_ID());
 108     SketchPlugin_Tools::resetAttribute(this, PASSED_POINT_REF_ID());
 109     SketchPlugin_Tools::resetAttribute(this, TANGENT_POINT_ID());
 110     SketchPlugin_Tools::resetAttribute(this, END_POINT_3_ID());
 111     SketchPlugin_Tools::resetAttribute(this, REVERSED_ID());
 112     SketchPlugin_Tools::resetAttribute(this, RADIUS_ID());
 113     SketchPlugin_Tools::resetAttribute(this, ANGLE_ID());
 114
 115     myCenter.reset();
 116     myStart.reset();
 117     myEnd.reset();
 118     boolean(REVERSED_ID())->setValue(false);
 119     myParamBefore = 0.0;
 120   } else if(anArcType == ARC_TYPE_BY_CENTER_AND_POINTS())
 121     fillByCenterAndTwoPassed();
 122   else if(anArcType == ARC_TYPE_BY_THREE_POINTS())
 123     fillByThreePassedPoints();
 124   else if(anArcType == ARC_TYPE_BY_TANGENT_EDGE())
 125     fillByTangentEdge();
 126
 127   double aRadius = 0;
 128   double anAngle = 0;
 129   if(myCenter.get() && myStart.get()) {
 130     aRadius = myCenter->distance(myStart);
 131     if(myEnd.get()) {
 132       if(myStart->isEqual(myEnd)) {
 133         anAngle = 360;
 134       } else {
 135         GeomAPI_Circ2d aCircleForArc(myCenter, myStart);
 136         double aStartParam, anEndParam;
 137         aCircleForArc.parameter(myStart, paramTolerance, aStartParam);
 138         aCircleForArc.parameter(myEnd, paramTolerance, anEndParam);
 139         anAngle = (anEndParam - aStartParam) / PI * 180.0;
 140         if(boolean(REVERSED_ID())->value()) anAngle = 360.0 - anAngle;
 141       }
 142     }
 143   }
 144
 145   bool aWasBlocked = data()->blockSendAttributeUpdated(true);
 146   real(RADIUS_ID())->setValue(aRadius);
 147   real(ANGLE_ID())->setValue(anAngle);
 148   data()->blockSendAttributeUpdated(aWasBlocked, false);
 149 }
 150
 151 AISObjectPtr SketchPlugin_MacroArc::getAISObject(AISObjectPtr thePrevious)
 152 {
 153   if(!myStart.get() || !myEnd.get() || !myCenter.get()) {
 154     return AISObjectPtr();
 155   }
 156
 157   SketchPlugin_Sketch* aSketch = sketch();
 158   if(!aSketch) {
 159     return AISObjectPtr();
 160   }
 161
 162   std::shared_ptr<GeomAPI_Pnt> aStart = aSketch->to3D(myStart->x(), myStart->y());
 163   std::shared_ptr<GeomAPI_Pnt> anEnd = aSketch->to3D(myEnd->x(), myEnd->y());
 164   std::shared_ptr<GeomAPI_Pnt> aCenter = aSketch->to3D(myCenter->x(), myCenter->y());;
 165
 166   std::shared_ptr<GeomDataAPI_Dir> aNDir =
 167       std::dynamic_pointer_cast<GeomDataAPI_Dir>(
 168           aSketch->data()->attribute(SketchPlugin_Sketch::NORM_ID()));
 169   std::shared_ptr<GeomAPI_Dir> aNormal = aNDir->dir();
 170   GeomShapePtr anArcShape = boolean(REVERSED_ID())->value() ?
 171       GeomAlgoAPI_EdgeBuilder::lineCircleArc(aCenter, anEnd, aStart, aNormal)
 172     : GeomAlgoAPI_EdgeBuilder::lineCircleArc(aCenter, aStart, anEnd, aNormal);
 173   GeomShapePtr aCenterPointShape = GeomAlgoAPI_PointBuilder::vertex(aCenter);
 174
 175   if(!anArcShape.get() || !aCenterPointShape.get()) {
 176     return AISObjectPtr();
 177   }
 178
 179   std::list<std::shared_ptr<GeomAPI_Shape> > aShapes;
 180   aShapes.push_back(anArcShape);
 181   aShapes.push_back(aCenterPointShape);
 182
 183   std::shared_ptr<GeomAPI_Shape> aCompound = GeomAlgoAPI_CompoundBuilder::compound(aShapes);
 184   AISObjectPtr anAIS = thePrevious;
 185   if(!anAIS.get()) {
 186     anAIS.reset(new GeomAPI_AISObject());
 187   }
 188   anAIS->createShape(aCompound);
 189   return anAIS;
 190 }
 191
 192 void SketchPlugin_MacroArc::execute()
 193 {
 194   FeaturePtr anArcFeature = createArcFeature();
 195
 196   myCenter.reset();
 197   myStart.reset();
 198   myEnd.reset();
 199
 200   // Create constraints.
 201   std::string anArcType = string(ARC_TYPE())->value();
 202   if(anArcType == ARC_TYPE_BY_CENTER_AND_POINTS()) {
 203     SketchPlugin_Tools::createConstraint(this,
 204                                          CENTER_POINT_REF_ID(),
 205                                          anArcFeature->attribute(SketchPlugin_Arc::CENTER_ID()),
 206                                          ObjectPtr(),
 207                                          false);
 208     SketchPlugin_Tools::createConstraint(this,
 209                                          START_POINT_REF_ID(),
 210                                          anArcFeature->attribute(SketchPlugin_Arc::START_ID()),
 211                                          ObjectPtr(),
 212                                          false);
 213     SketchPlugin_Tools::createConstraint(this,
 214                                          END_POINT_REF_ID(),
 215                                          anArcFeature->attribute(SketchPlugin_Arc::END_ID()),
 216                                          ObjectPtr(),
 217                                          false);
 218   } else if(anArcType == ARC_TYPE_BY_THREE_POINTS()) {
 219     SketchPlugin_Tools::createConstraint(this,
 220                                          START_POINT_REF_ID(),
 221                                          anArcFeature->attribute(SketchPlugin_Arc::START_ID()),
 222                                          ObjectPtr(),
 223                                          false);
 224     SketchPlugin_Tools::createConstraint(this,
 225                                          END_POINT_REF_ID(),
 226                                          anArcFeature->attribute(SketchPlugin_Arc::END_ID()),
 227                                          ObjectPtr(),
 228                                          false);
 229     SketchPlugin_Tools::createConstraint(this,
 230                                          PASSED_POINT_REF_ID(),
 231                                          AttributePtr(),
 232                                          anArcFeature->lastResult(),
 233                                          true);
 234   } else if(anArcType == ARC_TYPE_BY_TANGENT_EDGE()) {
 235     // constraints for tangent arc
 236     SketchPlugin_Tools::createConstraint(this,
 237                                          TANGENT_POINT_ID(),
 238                                          anArcFeature->attribute(SketchPlugin_Arc::START_ID()),
 239                                          ObjectPtr(),
 240                                          false);
 241     FeaturePtr aTangent = sketch()->addFeature(SketchPlugin_ConstraintTangent::ID());
 242     AttributeRefAttrPtr aRefAttrA = aTangent->refattr(SketchPlugin_Constraint::ENTITY_A());
 243     AttributeRefAttrPtr aTgPntRefAttr = refattr(TANGENT_POINT_ID());
 244     FeaturePtr aTgFeature = ModelAPI_Feature::feature(aTgPntRefAttr->attr()->owner());
 245     aRefAttrA->setObject(aTgFeature->lastResult());
 246     AttributeRefAttrPtr aRefAttrB = aTangent->refattr(SketchPlugin_Constraint::ENTITY_B());
 247     aRefAttrB->setObject(anArcFeature->lastResult());
 248     // constraint for end point
 249     SketchPlugin_Tools::createConstraint(this,
 250                                          END_POINT_REF_ID(),
 251                                          anArcFeature->attribute(SketchPlugin_Arc::END_ID()),
 252                                          ObjectPtr(),
 253                                          false);
 254   }
 255 }
 256
 257 FeaturePtr SketchPlugin_MacroArc::createArcFeature()
 258 {
 259   FeaturePtr anArcFeature = sketch()->addFeature(SketchPlugin_Arc::ID());
 260   std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
 261       anArcFeature->attribute(SketchPlugin_Arc::CENTER_ID()))->setValue(myCenter);
 262   std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
 263       anArcFeature->attribute(SketchPlugin_Arc::START_ID()))->setValue(myStart);
 264   std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
 265       anArcFeature->attribute(SketchPlugin_Arc::END_ID()))->setValue(myEnd);
 266   anArcFeature->boolean(SketchPlugin_Arc::REVERSED_ID())
 267                 ->setValue(boolean(REVERSED_ID())->value());
 268   anArcFeature->boolean(SketchPlugin_Arc::AUXILIARY_ID())
 269                 ->setValue(boolean(AUXILIARY_ID())->value());
 270   anArcFeature->execute();
 271
 272   return anArcFeature;
 273 }
 274
 275 void SketchPlugin_MacroArc::fillByCenterAndTwoPassed()
 276 {
 277   AttributePoint2DPtr aCenterPointAttr =
 278       std::dynamic_pointer_cast<GeomDataAPI_Point2D>(attribute(CENTER_POINT_ID()));
 279   if (!aCenterPointAttr->isInitialized())
 280       return;
 281
 282   AttributePoint2DPtr aStartPointAttr =
 283       std::dynamic_pointer_cast<GeomDataAPI_Point2D>(attribute(START_POINT_1_ID()));
 284   if (!aStartPointAttr->isInitialized())
 285     return;
 286
 287   myCenter = aCenterPointAttr->pnt();
 288   myStart = aStartPointAttr->pnt();
 289   myEnd = myStart;
 290
 291   AttributePoint2DPtr anEndPointAttr =
 292       std::dynamic_pointer_cast<GeomDataAPI_Point2D>(attribute(END_POINT_1_ID()));
 293   if (!anEndPointAttr->isInitialized())
 294     return;
 295
 296   GeomAPI_Circ2d aCircleForArc(myCenter, myStart);
 297
 298   // End point should be a projection on circle.
 299   bool aWasBlocked = data()->blockSendAttributeUpdated(true);
 300   projectPointOnCircle(anEndPointAttr, aCircleForArc);
 301   data()->blockSendAttributeUpdated(aWasBlocked, false);
 302   myEnd = anEndPointAttr->pnt();
 303
 304   // update the REVERSED flag
 305   recalculateReversedFlagByEnd(aCircleForArc);
 306 }
 307
 308 void SketchPlugin_MacroArc::recalculateReversedFlagByEnd(const GeomAPI_Circ2d& theCurrentCircular)
 309 {
 310   double aParameterNew = 0.0;
 311   if(theCurrentCircular.parameter(myEnd, paramTolerance, aParameterNew)) {
 312     if(myParamBefore <= PI / 2.0 && aParameterNew >= PI * 1.5) {
 313       boolean(REVERSED_ID())->setValue(true);
 314     } else if(myParamBefore >= PI * 1.5 && aParameterNew <= PI / 2.0) {
 315       boolean(REVERSED_ID())->setValue(false);
 316     }
 317   }
 318   myParamBefore = aParameterNew;
 319 }
 320
 321 void SketchPlugin_MacroArc::fillByThreePassedPoints()
 322 {
 323   AttributePoint2DPtr aStartPointAttr =
 324       std::dynamic_pointer_cast<GeomDataAPI_Point2D>(attribute(START_POINT_2_ID()));
 325   if (!aStartPointAttr->isInitialized())
 326     return;
 327
 328   AttributePoint2DPtr anEndPointAttr =
 329       std::dynamic_pointer_cast<GeomDataAPI_Point2D>(attribute(END_POINT_2_ID()));
 330   if (!anEndPointAttr->isInitialized())
 331     return;
 332
 333   myStart = aStartPointAttr->pnt();
 334   myEnd = anEndPointAttr->pnt();
 335
 336   AttributePoint2DPtr aPassedPointAttr =
 337       std::dynamic_pointer_cast<GeomDataAPI_Point2D>(attribute(PASSED_POINT_ID()));
 338   if (aPassedPointAttr->isInitialized()) {
 339     std::shared_ptr<GeomAPI_Pnt2d> aPassedPnt;
 340     std::shared_ptr<GeomAPI_Shape> aTangentCurve;
 341     SketchPlugin_Tools::convertRefAttrToPointOrTangentCurve(
 342         refattr(PASSED_POINT_REF_ID()), aPassedPointAttr, aTangentCurve, aPassedPnt);
 343
 344     std::shared_ptr<GeomAPI_Interface> aPassed;
 345     if (aTangentCurve)
 346       aPassed = aTangentCurve;
 347     else
 348       aPassed = aPassedPnt;
 349
 350     std::shared_ptr<GeomAPI_Ax3> anAxis = SketchPlugin_Sketch::plane(sketch());
 351     GeomAPI_Circ2d aCircle(myStart, myEnd, aPassed, anAxis);
 352     myCenter = aCircle.center();
 353
 354     recalculateReversedFlagByPassed(aCircle);
 355   } else
 356     myCenter.reset(new GeomAPI_Pnt2d(myStart->xy()->added(myEnd->xy())->multiplied(0.5)));
 357 }
 358
 359 void SketchPlugin_MacroArc::recalculateReversedFlagByPassed(
 360     const GeomAPI_Circ2d& theCurrentCircular)
 361 {
 362   AttributePoint2DPtr aPassedAttr =
 363       std::dynamic_pointer_cast<GeomDataAPI_Point2D>(attribute(PASSED_POINT_ID()));
 364   std::shared_ptr<GeomAPI_Pnt2d> aPassed = theCurrentCircular.project(aPassedAttr->pnt());
 365
 366   double aEndParam, aPassedParam;
 367   theCurrentCircular.parameter(myEnd, paramTolerance, aEndParam);
 368   theCurrentCircular.parameter(aPassed, paramTolerance, aPassedParam);
 369
 370   if(aPassedParam > aEndParam)
 371     boolean(REVERSED_ID())->setValue(true);
 372   else
 373     boolean(REVERSED_ID())->setValue(false);
 374
 375   myParamBefore = aEndParam;
 376 }
 377
 378 void SketchPlugin_MacroArc::fillByTangentEdge()
 379 {
 380   AttributeRefAttrPtr aTangentAttr = refattr(TANGENT_POINT_ID());
 381   if (!aTangentAttr->isInitialized())
 382     return;
 383
 384   AttributePoint2DPtr aTangentPointAttr =
 385       std::dynamic_pointer_cast<GeomDataAPI_Point2D>(aTangentAttr->attr());
 386   if (!aTangentPointAttr->isInitialized())
 387     return;
 388
 389   AttributePoint2DPtr anEndPointAttr =
 390       std::dynamic_pointer_cast<GeomDataAPI_Point2D>(attribute(END_POINT_3_ID()));
 391   if (!anEndPointAttr->isInitialized())
 392     return;
 393
 394   myStart = aTangentPointAttr->pnt();
 395   myEnd = anEndPointAttr->pnt();
 396   if (myStart->isEqual(myEnd))
 397     return;
 398
 399   // obtain a shape the tangent point belongs to
 400   FeaturePtr aTangentFeature = ModelAPI_Feature::feature(aTangentPointAttr->owner());
 401   std::shared_ptr<GeomAPI_Shape> aTangentShape = aTangentFeature->lastResult()->shape();
 402
 403   std::shared_ptr<GeomAPI_Ax3> anAxis = SketchPlugin_Sketch::plane(sketch());
 404   GeomAPI_Circ2d aCircle(myStart, myEnd, aTangentShape, anAxis);
 405   myCenter = aCircle.center();
 406
 407   // rebuild circle to set start point equal to zero parameter
 408   aCircle = GeomAPI_Circ2d(myCenter, myStart);
 409   recalculateReversedFlagByEnd(aCircle);
 410 }