src/SketchSolver/PlaneGCSSolver/PlaneGCSSolver_Tools.cpp

   1 // Copyright (C) 2014-20xx CEA/DEN, EDF R&D
   2
   3 // File:    SketchSolver_Builder.cpp
   4 // Created: 25 Mar 2015
   5 // Author:  Artem ZHIDKOV
   6
   7 #include <PlaneGCSSolver_Tools.h>
   8 #include <PlaneGCSSolver_EntityWrapper.h>
   9 #include <PlaneGCSSolver_PointWrapper.h>
  10 #include <PlaneGCSSolver_ScalarWrapper.h>
  11 #include <PlaneGCSSolver_ConstraintWrapper.h>
  12
  13 #include <SketchSolver_Constraint.h>
  14 #include <SketchSolver_ConstraintAngle.h>
  15 #include <SketchSolver_ConstraintCoincidence.h>
  16 #include <SketchSolver_ConstraintCollinear.h>
  17 #include <SketchSolver_ConstraintDistance.h>
  18 #include <SketchSolver_ConstraintEqual.h>
  19 #include <SketchSolver_ConstraintFixed.h>
  20 #include <SketchSolver_ConstraintLength.h>
  21 #include <SketchSolver_ConstraintMiddle.h>
  22 #include <SketchSolver_ConstraintMirror.h>
  23 #include <SketchSolver_ConstraintTangent.h>
  24 #include <SketchSolver_ConstraintMultiRotation.h>
  25 #include <SketchSolver_ConstraintMultiTranslation.h>
  26
  27 #include <SketchPlugin_ConstraintAngle.h>
  28 #include <SketchPlugin_ConstraintCoincidence.h>
  29 #include <SketchPlugin_ConstraintCollinear.h>
  30 #include <SketchPlugin_ConstraintDistance.h>
  31 #include <SketchPlugin_ConstraintEqual.h>
  32 #include <SketchPlugin_ConstraintLength.h>
  33 #include <SketchPlugin_ConstraintMiddle.h>
  34 #include <SketchPlugin_ConstraintMirror.h>
  35 #include <SketchPlugin_ConstraintRigid.h>
  36 #include <SketchPlugin_ConstraintTangent.h>
  37 #include <SketchPlugin_Line.h>
  38 #include <SketchPlugin_MultiRotation.h>
  39 #include <SketchPlugin_MultiTranslation.h>
  40
  41 #include <cmath>
  42
  43
  44 #define GCS_ENTITY_WRAPPER(x) std::dynamic_pointer_cast<PlaneGCSSolver_EntityWrapper>(x)
  45 #define GCS_POINT_WRAPPER(x)  std::dynamic_pointer_cast<PlaneGCSSolver_PointWrapper>(x)
  46 #define GCS_SCALAR_WRAPPER(x) std::dynamic_pointer_cast<PlaneGCSSolver_ScalarWrapper>(x)
  47
  48
  49
  50 static ConstraintWrapperPtr
  51   createConstraintCoincidence(std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint1,
  52                               std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint2);
  53 static ConstraintWrapperPtr
  54   createConstraintPointOnEntity(const SketchSolver_ConstraintType& theType,
  55                                 std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint,
  56                                 std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity);
  57 static ConstraintWrapperPtr
  58   createConstraintDistancePointPoint(std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
  59                                      std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint1,
  60                                      std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint2);
  61 static ConstraintWrapperPtr
  62   createConstraintDistancePointLine(std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
  63                                     std::shared_ptr<PlaneGCSSolver_PointWrapper>  thePoint,
  64                                     std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity);
  65 static ConstraintWrapperPtr
  66   createConstraintRadius(std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
  67                          std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity);
  68 static ConstraintWrapperPtr
  69   createConstraintAngle(ConstraintPtr theConstraint,
  70                         std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
  71                         std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity1,
  72                         std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity2);
  73 static ConstraintWrapperPtr
  74   createConstraintHorizVert(const SketchSolver_ConstraintType& theType,
  75                             std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity);
  76 static ConstraintWrapperPtr
  77   createConstraintParallel(std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity1,
  78                            std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity2);
  79 static ConstraintWrapperPtr
  80   createConstraintPerpendicular(std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity1,
  81                                 std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity2);
  82 static ConstraintWrapperPtr
  83   createConstraintEqual(const SketchSolver_ConstraintType& theType,
  84                         std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity1,
  85                         std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity2,
  86                         std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theIntermed);
  87 static ConstraintWrapperPtr
  88   createConstraintTangent(const SketchSolver_ConstraintType& theType,
  89                           std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity1,
  90                           std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity2);
  91 static ConstraintWrapperPtr
  92   createConstraintMiddlePoint(std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint,
  93                               std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity);
  94
  95
  96
  97
  98
  99 SolverConstraintPtr PlaneGCSSolver_Tools::createConstraint(ConstraintPtr theConstraint)
 100 {
 101   if (theConstraint->getKind() == SketchPlugin_ConstraintCoincidence::ID()) {
 102     return SolverConstraintPtr(new SketchSolver_ConstraintCoincidence(theConstraint));
 103   } else if (theConstraint->getKind() == SketchPlugin_ConstraintCollinear::ID()) {
 104     return SolverConstraintPtr(new SketchSolver_ConstraintCollinear(theConstraint));
 105   } else if (theConstraint->getKind() == SketchPlugin_ConstraintDistance::ID()) {
 106     return SolverConstraintPtr(new SketchSolver_ConstraintDistance(theConstraint));
 107   } else if (theConstraint->getKind() == SketchPlugin_ConstraintEqual::ID()) {
 108     return SolverConstraintPtr(new SketchSolver_ConstraintEqual(theConstraint));
 109   } else if (theConstraint->getKind() == SketchPlugin_ConstraintLength::ID()) {
 110     return SolverConstraintPtr(new SketchSolver_ConstraintLength(theConstraint));
 111   } else if (theConstraint->getKind() == SketchPlugin_ConstraintMiddle::ID()) {
 112     return SolverConstraintPtr(new SketchSolver_ConstraintMiddle(theConstraint));
 113   } else if (theConstraint->getKind() == SketchPlugin_ConstraintMirror::ID()) {
 114     return SolverConstraintPtr(new SketchSolver_ConstraintMirror(theConstraint));
 115   } else if (theConstraint->getKind() == SketchPlugin_ConstraintTangent::ID()) {
 116     return SolverConstraintPtr(new SketchSolver_ConstraintTangent(theConstraint));
 117   } else if (theConstraint->getKind() == SketchPlugin_ConstraintRigid::ID()) {
 118     return SolverConstraintPtr(new SketchSolver_ConstraintFixed(theConstraint));
 119   } else if (theConstraint->getKind() == SketchPlugin_MultiTranslation::ID()) {
 120     return SolverConstraintPtr(new SketchSolver_ConstraintMultiTranslation(theConstraint));
 121   } else if (theConstraint->getKind() == SketchPlugin_MultiRotation::ID()) {
 122     return SolverConstraintPtr(new SketchSolver_ConstraintMultiRotation(theConstraint));
 123   } else if (theConstraint->getKind() == SketchPlugin_ConstraintAngle::ID()) {
 124     return SolverConstraintPtr(new SketchSolver_ConstraintAngle(theConstraint));
 125   }
 126   // All other types of constraints
 127   return SolverConstraintPtr(new SketchSolver_Constraint(theConstraint));
 128 }
 129
 130 SolverConstraintPtr PlaneGCSSolver_Tools::createMovementConstraint(FeaturePtr theMovedFeature)
 131 {
 132   return SolverConstraintPtr(new SketchSolver_ConstraintFixed(theMovedFeature));
 133 }
 134
 135
 136
 137 ConstraintWrapperPtr PlaneGCSSolver_Tools::createConstraint(
 138     ConstraintPtr theConstraint,
 139     const SketchSolver_ConstraintType& theType,
 140     const EntityWrapperPtr& theValue,
 141     const EntityWrapperPtr& thePoint1,
 142     const EntityWrapperPtr& thePoint2,
 143     const EntityWrapperPtr& theEntity1,
 144     const EntityWrapperPtr& theEntity2)
 145 {
 146   ConstraintWrapperPtr aResult;
 147   ScalarWrapperPtr anIntermediate;
 148
 149   std::shared_ptr<PlaneGCSSolver_PointWrapper> aPoint1 = GCS_POINT_WRAPPER(thePoint1);
 150   std::shared_ptr<PlaneGCSSolver_PointWrapper> aPoint2 = GCS_POINT_WRAPPER(thePoint2);
 151
 152   switch (theType) {
 153   case CONSTRAINT_PT_PT_COINCIDENT:
 154     aResult = createConstraintCoincidence(aPoint1, aPoint2);
 155     break;
 156   case CONSTRAINT_PT_ON_LINE:
 157   case CONSTRAINT_PT_ON_CIRCLE:
 158     aResult = createConstraintPointOnEntity(theType, aPoint1, GCS_ENTITY_WRAPPER(theEntity1));
 159     break;
 160   case CONSTRAINT_MIDDLE_POINT:
 161     aResult = createConstraintMiddlePoint(aPoint1, GCS_ENTITY_WRAPPER(theEntity1));
 162     break;
 163   case CONSTRAINT_PT_PT_DISTANCE:
 164     aResult = createConstraintDistancePointPoint(GCS_SCALAR_WRAPPER(theValue), aPoint1, aPoint2);
 165     break;
 166   case CONSTRAINT_PT_LINE_DISTANCE:
 167     aResult = createConstraintDistancePointLine(GCS_SCALAR_WRAPPER(theValue),
 168                                                 aPoint1,
 169                                                 GCS_ENTITY_WRAPPER(theEntity1));
 170     break;
 171   case CONSTRAINT_RADIUS:
 172     aResult = createConstraintRadius(GCS_SCALAR_WRAPPER(theValue),
 173                                      GCS_ENTITY_WRAPPER(theEntity1));
 174     break;
 175   case CONSTRAINT_ANGLE:
 176     aResult = createConstraintAngle(theConstraint,
 177                   GCS_SCALAR_WRAPPER(theValue),
 178                   GCS_ENTITY_WRAPPER(theEntity1), GCS_ENTITY_WRAPPER(theEntity2));
 179     break;
 180   case CONSTRAINT_FIXED:
 181     break;
 182   case CONSTRAINT_HORIZONTAL:
 183   case CONSTRAINT_VERTICAL:
 184     aResult = createConstraintHorizVert(theType, GCS_ENTITY_WRAPPER(theEntity1));
 185     break;
 186   case CONSTRAINT_PARALLEL:
 187     aResult = createConstraintParallel(GCS_ENTITY_WRAPPER(theEntity1),
 188                                        GCS_ENTITY_WRAPPER(theEntity2));
 189     break;
 190   case CONSTRAINT_PERPENDICULAR:
 191     aResult = createConstraintPerpendicular(GCS_ENTITY_WRAPPER(theEntity1),
 192                                             GCS_ENTITY_WRAPPER(theEntity2));
 193     break;
 194   case CONSTRAINT_EQUAL_LINES:
 195     anIntermediate = GCS_SCALAR_WRAPPER(theValue); // parameter is used to store length of lines
 196   case CONSTRAINT_EQUAL_LINE_ARC:
 197   case CONSTRAINT_EQUAL_RADIUS:
 198     aResult = createConstraintEqual(theType,
 199                                     GCS_ENTITY_WRAPPER(theEntity1),
 200                                     GCS_ENTITY_WRAPPER(theEntity2),
 201                                     anIntermediate);
 202     break;
 203   case CONSTRAINT_TANGENT_CIRCLE_LINE:
 204   case CONSTRAINT_TANGENT_CIRCLE_CIRCLE:
 205     aResult = createConstraintTangent(theType,
 206                                       GCS_ENTITY_WRAPPER(theEntity1),
 207                                       GCS_ENTITY_WRAPPER(theEntity2));
 208     break;
 209   case CONSTRAINT_MULTI_TRANSLATION:
 210   case CONSTRAINT_MULTI_ROTATION:
 211   case CONSTRAINT_SYMMETRIC:
 212   default:
 213     break;
 214   }
 215
 216   return aResult;
 217 }
 218
 219 std::shared_ptr<GeomAPI_Pnt2d> PlaneGCSSolver_Tools::point(EntityWrapperPtr theEntity)
 220 {
 221   if (theEntity->type() != ENTITY_POINT)
 222     return std::shared_ptr<GeomAPI_Pnt2d>();
 223
 224   std::shared_ptr<PlaneGCSSolver_PointWrapper> aPointWrapper =
 225       std::dynamic_pointer_cast<PlaneGCSSolver_PointWrapper>(theEntity);
 226   const GCSPointPtr& aPoint = aPointWrapper->point();
 227   return std::shared_ptr<GeomAPI_Pnt2d>(new GeomAPI_Pnt2d(*aPoint->x, *aPoint->y));
 228 }
 229
 230 std::shared_ptr<GeomAPI_Lin2d> PlaneGCSSolver_Tools::line(EntityWrapperPtr theEntity)
 231 {
 232   if (theEntity->type() != ENTITY_LINE)
 233     return std::shared_ptr<GeomAPI_Lin2d>();
 234
 235   std::shared_ptr<PlaneGCSSolver_EntityWrapper> anEntity =
 236       std::dynamic_pointer_cast<PlaneGCSSolver_EntityWrapper>(theEntity);
 237   std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(anEntity->entity());
 238   return std::shared_ptr<GeomAPI_Lin2d>(
 239       new GeomAPI_Lin2d(*(aLine->p1.x), *(aLine->p1.y), *(aLine->p2.x), *(aLine->p2.y)));
 240 }
 241
 242 std::shared_ptr<GeomAPI_Lin2d> PlaneGCSSolver_Tools::line(FeaturePtr theFeature)
 243 {
 244   if (theFeature->getKind() != SketchPlugin_Line::ID())
 245     return std::shared_ptr<GeomAPI_Lin2d>();
 246
 247   AttributePoint2DPtr aStart = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
 248       theFeature->attribute(SketchPlugin_Line::START_ID()));
 249   AttributePoint2DPtr aEnd = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
 250       theFeature->attribute(SketchPlugin_Line::END_ID()));
 251
 252   return std::shared_ptr<GeomAPI_Lin2d>(new GeomAPI_Lin2d(aStart->pnt(), aEnd->pnt()));
 253 }
 254
 255
 256
 257
 258
 259 // ================   Auxiliary functions   ==========================
 260 ConstraintWrapperPtr createConstraintCoincidence(
 261     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint1,
 262     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint2)
 263 {
 264   GCSPointPtr aPoint1 = thePoint1->point();
 265   GCSPointPtr aPoint2 = thePoint2->point();
 266
 267   // Create equality constraint for corresponding attributes of the points
 268   std::list<GCSConstraintPtr> aConstrList;
 269   aConstrList.push_back(
 270       GCSConstraintPtr(new GCS::ConstraintEqual(aPoint1->x, aPoint2->x)));
 271   aConstrList.push_back(
 272       GCSConstraintPtr(new GCS::ConstraintEqual(aPoint1->y, aPoint2->y)));
 273
 274   return ConstraintWrapperPtr(new PlaneGCSSolver_ConstraintWrapper(
 275       aConstrList, CONSTRAINT_PT_PT_COINCIDENT));
 276 }
 277
 278 ConstraintWrapperPtr createConstraintPointOnEntity(
 279     const SketchSolver_ConstraintType& theType,
 280     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint,
 281     std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity)
 282 {
 283   GCSConstraintPtr aNewConstr;
 284
 285   switch (theEntity->type()) {
 286   case ENTITY_LINE: {
 287     std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(theEntity->entity());
 288     aNewConstr = GCSConstraintPtr(new GCS::ConstraintPointOnLine(*(thePoint->point()), *aLine));
 289     break;
 290     }
 291   case ENTITY_ARC:
 292   case ENTITY_CIRCLE: {
 293     std::shared_ptr<GCS::Circle> aCirc =
 294       std::dynamic_pointer_cast<GCS::Circle>(theEntity->entity());
 295     aNewConstr = GCSConstraintPtr(
 296         new GCS::ConstraintP2PDistance(*(thePoint->point()), aCirc->center, aCirc->rad));
 297     break;
 298     }
 299   default:
 300     return ConstraintWrapperPtr();
 301   }
 302
 303   return ConstraintWrapperPtr(new PlaneGCSSolver_ConstraintWrapper(aNewConstr, theType));
 304 }
 305
 306 ConstraintWrapperPtr createConstraintMiddlePoint(
 307     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint,
 308     std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity)
 309 {
 310   GCSPointPtr aPoint = thePoint->point();
 311   std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(theEntity->entity());
 312   if (!aLine)
 313     return ConstraintWrapperPtr();
 314
 315   std::list<GCSConstraintPtr> aConstrList;
 316   aConstrList.push_back(
 317       GCSConstraintPtr(new GCS::ConstraintPointOnPerpBisector(*aPoint, aLine->p1, aLine->p2)));
 318   aConstrList.push_back(GCSConstraintPtr(new GCS::ConstraintPointOnLine(*aPoint, *aLine)));
 319
 320   return ConstraintWrapperPtr(
 321       new PlaneGCSSolver_ConstraintWrapper(aConstrList, CONSTRAINT_MIDDLE_POINT));
 322 }
 323
 324
 325 ConstraintWrapperPtr createConstraintDistancePointPoint(
 326     std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
 327     std::shared_ptr<PlaneGCSSolver_PointWrapper>  thePoint1,
 328     std::shared_ptr<PlaneGCSSolver_PointWrapper>  thePoint2)
 329 {
 330   GCSConstraintPtr aNewConstr(new GCS::ConstraintP2PDistance(
 331       *(thePoint1->point()), *(thePoint2->point()), theValue->scalar()));
 332   std::shared_ptr<PlaneGCSSolver_ConstraintWrapper> aResult(
 333       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_PT_PT_DISTANCE));
 334   aResult->setValueParameter(theValue);
 335   return aResult;
 336 }
 337
 338 ConstraintWrapperPtr createConstraintDistancePointLine(
 339     std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
 340     std::shared_ptr<PlaneGCSSolver_PointWrapper>  thePoint,
 341     std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity)
 342 {
 343   std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(theEntity->entity());
 344   GCSConstraintPtr aNewConstr(new GCS::ConstraintP2LDistance(
 345       *(thePoint->point()), *(aLine), theValue->scalar()));
 346   std::shared_ptr<PlaneGCSSolver_ConstraintWrapper> aResult(
 347       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_PT_LINE_DISTANCE));
 348   aResult->setValueParameter(theValue);
 349   return aResult;
 350 }
 351
 352 ConstraintWrapperPtr createConstraintRadius(
 353     std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
 354     std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity)
 355 {
 356   std::shared_ptr<GCS::Circle> aCircle =
 357     std::dynamic_pointer_cast<GCS::Circle>(theEntity->entity());
 358   GCSConstraintPtr aNewConstr(new GCS::ConstraintEqual(aCircle->rad, theValue->scalar()));
 359   std::shared_ptr<PlaneGCSSolver_ConstraintWrapper> aResult(
 360       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_RADIUS));
 361   aResult->setValueParameter(theValue);
 362   return aResult;
 363 }
 364
 365 ConstraintWrapperPtr createConstraintAngle(
 366     ConstraintPtr theConstraint,
 367     std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
 368     std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity1,
 369     std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity2)
 370 {
 371   std::shared_ptr<GCS::Line> aLine1 = std::dynamic_pointer_cast<GCS::Line>(theEntity1->entity());
 372   bool isLine1Rev = theConstraint->boolean(
 373       SketchPlugin_ConstraintAngle::ANGLE_REVERSED_FIRST_LINE_ID())->value();
 374   GCS::Point aLine1Pt1 = isLine1Rev ? aLine1->p2 : aLine1->p1;
 375   GCS::Point aLine1Pt2 = isLine1Rev ? aLine1->p1 : aLine1->p2;
 376
 377   std::shared_ptr<GCS::Line> aLine2 = std::dynamic_pointer_cast<GCS::Line>(theEntity2->entity());
 378   bool isLine2Rev = theConstraint->boolean(
 379       SketchPlugin_ConstraintAngle::ANGLE_REVERSED_SECOND_LINE_ID())->value();
 380   GCS::Point aLine2Pt1 = isLine2Rev ? aLine2->p2 : aLine2->p1;
 381   GCS::Point aLine2Pt2 = isLine2Rev ? aLine2->p1 : aLine2->p2;
 382
 383   GCSConstraintPtr aNewConstr(new GCS::ConstraintL2LAngle(
 384       aLine1Pt1, aLine1Pt2, aLine2Pt1, aLine2Pt2, theValue->scalar()));
 385
 386   std::shared_ptr<PlaneGCSSolver_ConstraintWrapper> aResult(
 387       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_ANGLE));
 388   aResult->setValueParameter(theValue);
 389   return aResult;
 390 }
 391
 392 ConstraintWrapperPtr createConstraintHorizVert(
 393     const SketchSolver_ConstraintType& theType,
 394     std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity)
 395 {
 396   std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(theEntity->entity());
 397   GCSConstraintPtr aNewConstr;
 398   if (theType == CONSTRAINT_HORIZONTAL)
 399     aNewConstr = GCSConstraintPtr(new GCS::ConstraintEqual(aLine->p1.y, aLine->p2.y));
 400   else
 401     aNewConstr = GCSConstraintPtr(new GCS::ConstraintEqual(aLine->p1.x, aLine->p2.x));
 402
 403   return ConstraintWrapperPtr(new PlaneGCSSolver_ConstraintWrapper(aNewConstr, theType));
 404 }
 405
 406 ConstraintWrapperPtr createConstraintParallel(
 407     std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity1,
 408     std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity2)
 409 {
 410   std::shared_ptr<GCS::Line> aLine1 = std::dynamic_pointer_cast<GCS::Line>(theEntity1->entity());
 411   std::shared_ptr<GCS::Line> aLine2 = std::dynamic_pointer_cast<GCS::Line>(theEntity2->entity());
 412   GCSConstraintPtr aNewConstr(new GCS::ConstraintParallel(*(aLine1), *(aLine2)));
 413
 414   return ConstraintWrapperPtr(
 415       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_PARALLEL));
 416 }
 417
 418 ConstraintWrapperPtr createConstraintPerpendicular(
 419     std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity1,
 420     std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity2)
 421 {
 422   std::shared_ptr<GCS::Line> aLine1 = std::dynamic_pointer_cast<GCS::Line>(theEntity1->entity());
 423   std::shared_ptr<GCS::Line> aLine2 = std::dynamic_pointer_cast<GCS::Line>(theEntity2->entity());
 424   GCSConstraintPtr aNewConstr(new GCS::ConstraintPerpendicular(*(aLine1), *(aLine2)));
 425
 426   return ConstraintWrapperPtr(
 427       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_PERPENDICULAR));
 428 }
 429
 430 ConstraintWrapperPtr createConstraintEqual(
 431     const SketchSolver_ConstraintType& theType,
 432     std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity1,
 433     std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity2,
 434     std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theIntermed)
 435 {
 436   if (theType == CONSTRAINT_EQUAL_LINE_ARC)
 437     return ConstraintWrapperPtr(); // line-arc equivalence is not supported yet
 438
 439   std::list<GCSConstraintPtr> aConstrList;
 440   if (theType == CONSTRAINT_EQUAL_LINES) {
 441     std::shared_ptr<GCS::Line> aLine1 = std::dynamic_pointer_cast<GCS::Line>(theEntity1->entity());
 442     std::shared_ptr<GCS::Line> aLine2 = std::dynamic_pointer_cast<GCS::Line>(theEntity2->entity());
 443
 444     aConstrList.push_back(GCSConstraintPtr(
 445         new GCS::ConstraintP2PDistance(aLine1->p1, aLine1->p2, theIntermed->scalar())));
 446     aConstrList.push_back(GCSConstraintPtr(
 447         new GCS::ConstraintP2PDistance(aLine2->p1, aLine2->p2, theIntermed->scalar())));
 448     // update value of intermediate parameter
 449     double x = *aLine1->p1.x - *aLine1->p2.x;
 450     double y = *aLine1->p1.y - *aLine1->p2.y;
 451     double aLen = sqrt(x*x + y*y);
 452     theIntermed->setValue(aLen);
 453   } else {
 454     std::shared_ptr<GCS::Circle> aCirc1 =
 455         std::dynamic_pointer_cast<GCS::Circle>(theEntity1->entity());
 456     std::shared_ptr<GCS::Circle> aCirc2 =
 457         std::dynamic_pointer_cast<GCS::Circle>(theEntity2->entity());
 458
 459     aConstrList.push_back(GCSConstraintPtr(new GCS::ConstraintEqual(aCirc1->rad, aCirc2->rad)));
 460   }
 461
 462   std::shared_ptr<PlaneGCSSolver_ConstraintWrapper> aResult(
 463       new PlaneGCSSolver_ConstraintWrapper(aConstrList, theType));
 464   if (theIntermed)
 465     aResult->setValueParameter(theIntermed);
 466   return aResult;
 467 }
 468
 469 ConstraintWrapperPtr createConstraintTangent(
 470     const SketchSolver_ConstraintType& theType,
 471     std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity1,
 472     std::shared_ptr<PlaneGCSSolver_EntityWrapper> theEntity2)
 473 {
 474   GCSConstraintPtr aNewConstr;
 475   if (theType == CONSTRAINT_TANGENT_CIRCLE_LINE) {
 476     std::shared_ptr<GCS::Circle> aCirc =
 477       std::dynamic_pointer_cast<GCS::Circle>(theEntity1->entity());
 478     std::shared_ptr<GCS::Line> aLine =
 479       std::dynamic_pointer_cast<GCS::Line>(theEntity2->entity());
 480
 481     aNewConstr =
 482       GCSConstraintPtr(new GCS::ConstraintP2LDistance(aCirc->center, *aLine, aCirc->rad));
 483   } else {
 484     std::shared_ptr<GCS::Circle> aCirc1 =
 485       std::dynamic_pointer_cast<GCS::Circle>(theEntity1->entity());
 486     std::shared_ptr<GCS::Circle> aCirc2 =
 487       std::dynamic_pointer_cast<GCS::Circle>(theEntity2->entity());
 488
 489     double aDX = *(aCirc1->center.x) - *(aCirc2->center.x);
 490     double aDY = *(aCirc1->center.y) - *(aCirc2->center.y);
 491     double aDist = sqrt(aDX * aDX + aDY * aDY);
 492     aNewConstr = GCSConstraintPtr(new GCS::ConstraintTangentCircumf(aCirc1->center, aCirc2->center,
 493         aCirc1->rad, aCirc2->rad, (aDist < *(aCirc1->rad) || aDist < *(aCirc2->rad))));
 494   }
 495
 496   return ConstraintWrapperPtr(new PlaneGCSSolver_ConstraintWrapper(aNewConstr, theType));
 497 }
 498
 499 bool PlaneGCSSolver_Tools::isArcArcTangencyInternal(
 500     EntityWrapperPtr theArc1, EntityWrapperPtr theArc2)
 501 {
 502   std::shared_ptr<GCS::Circle> aCirc1 = std::dynamic_pointer_cast<GCS::Circle>(
 503       GCS_ENTITY_WRAPPER(theArc1)->entity());
 504   std::shared_ptr<GCS::Circle> aCirc2 = std::dynamic_pointer_cast<GCS::Circle>(
 505       GCS_ENTITY_WRAPPER(theArc2)->entity());
 506
 507   if (!aCirc1 || !aCirc2)
 508     return false;
 509
 510   double aDX = *(aCirc1->center.x) - *(aCirc2->center.x);
 511   double aDY = *(aCirc1->center.y) - *(aCirc2->center.y);
 512   double aDist = sqrt(aDX * aDX + aDY * aDY);
 513
 514   return (aDist < *(aCirc1->rad) || aDist < *(aCirc2->rad));
 515 }