src/SketchSolver/PlaneGCSSolver/PlaneGCSSolver_Tools.cpp

   1 // Copyright (C) 2014-2019  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 email : webmaster.salome@opencascade.com
  18 //
  19
  20 #include <PlaneGCSSolver_Tools.h>
  21 #include <PlaneGCSSolver_EdgeWrapper.h>
  22 #include <PlaneGCSSolver_PointWrapper.h>
  23 #include <PlaneGCSSolver_ScalarWrapper.h>
  24 #include <PlaneGCSSolver_ConstraintWrapper.h>
  25
  26 #include <SketchSolver_Constraint.h>
  27 #include <SketchSolver_ConstraintAngle.h>
  28 #include <SketchSolver_ConstraintCoincidence.h>
  29 #include <SketchSolver_ConstraintCollinear.h>
  30 #include <SketchSolver_ConstraintDistance.h>
  31 #include <SketchSolver_ConstraintEqual.h>
  32 #include <SketchSolver_ConstraintFixed.h>
  33 #include <SketchSolver_ConstraintLength.h>
  34 #include <SketchSolver_ConstraintMiddle.h>
  35 #include <SketchSolver_ConstraintMirror.h>
  36 #include <SketchSolver_ConstraintTangent.h>
  37 #include <SketchSolver_ConstraintMultiRotation.h>
  38 #include <SketchSolver_ConstraintMultiTranslation.h>
  39
  40 #include <SketchPlugin_ConstraintAngle.h>
  41 #include <SketchPlugin_ConstraintCoincidence.h>
  42 #include <SketchPlugin_ConstraintCollinear.h>
  43 #include <SketchPlugin_ConstraintDistance.h>
  44 #include <SketchPlugin_ConstraintDistanceHorizontal.h>
  45 #include <SketchPlugin_ConstraintDistanceVertical.h>
  46 #include <SketchPlugin_ConstraintEqual.h>
  47 #include <SketchPlugin_ConstraintLength.h>
  48 #include <SketchPlugin_ConstraintMiddle.h>
  49 #include <SketchPlugin_ConstraintMirror.h>
  50 #include <SketchPlugin_ConstraintRigid.h>
  51 #include <SketchPlugin_ConstraintTangent.h>
  52 #include <SketchPlugin_Line.h>
  53 #include <SketchPlugin_MultiRotation.h>
  54 #include <SketchPlugin_MultiTranslation.h>
  55
  56 #include <cmath>
  57
  58
  59 #define GCS_EDGE_WRAPPER(x)   std::dynamic_pointer_cast<PlaneGCSSolver_EdgeWrapper>(x)
  60 #define GCS_POINT_WRAPPER(x)  std::dynamic_pointer_cast<PlaneGCSSolver_PointWrapper>(x)
  61 #define GCS_SCALAR_WRAPPER(x) std::dynamic_pointer_cast<PlaneGCSSolver_ScalarWrapper>(x)
  62
  63
  64
  65 static ConstraintWrapperPtr
  66   createConstraintCoincidence(std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint1,
  67                               std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint2);
  68 static ConstraintWrapperPtr
  69   createConstraintPointOnEntity(const SketchSolver_ConstraintType& theType,
  70                                 std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint,
  71                                 std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity);
  72 static ConstraintWrapperPtr
  73   createConstraintDistancePointPoint(std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
  74                                      std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint1,
  75                                      std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint2);
  76 static ConstraintWrapperPtr
  77   createConstraintDistancePointLine(std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
  78                                     std::shared_ptr<PlaneGCSSolver_PointWrapper>  thePoint,
  79                                     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity);
  80 static ConstraintWrapperPtr
  81   createConstraintHVDistance(const SketchSolver_ConstraintType& theType,
  82                              std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
  83                              std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint1,
  84                              std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint2);
  85 static ConstraintWrapperPtr
  86   createConstraintRadius(std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
  87                          std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity);
  88 static ConstraintWrapperPtr
  89   createConstraintAngle(ConstraintPtr theConstraint,
  90                         std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
  91                         std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity1,
  92                         std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity2);
  93 static ConstraintWrapperPtr
  94   createConstraintHorizVert(const SketchSolver_ConstraintType& theType,
  95                             std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity);
  96 static ConstraintWrapperPtr
  97   createConstraintParallel(std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity1,
  98                            std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity2);
  99 static ConstraintWrapperPtr
 100   createConstraintPerpendicular(std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity1,
 101                                 std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity2);
 102 static ConstraintWrapperPtr
 103   createConstraintEqual(const SketchSolver_ConstraintType& theType,
 104                         std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity1,
 105                         std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity2,
 106                         std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theIntermed);
 107 static ConstraintWrapperPtr
 108   createConstraintMiddlePoint(std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint,
 109                               std::shared_ptr<PlaneGCSSolver_EdgeWrapper>  theEntity,
 110                               std::shared_ptr<PlaneGCSSolver_PointWrapper> theAuxParameters);
 111
 112 static GCS::SET_pD scalarParameters(const ScalarWrapperPtr& theScalar);
 113 static GCS::SET_pD pointParameters(const PointWrapperPtr& thePoint);
 114 static GCS::SET_pD lineParameters(const EdgeWrapperPtr& theLine);
 115 static GCS::SET_pD circleParameters(const EdgeWrapperPtr& theCircle);
 116 static GCS::SET_pD arcParameters(const EdgeWrapperPtr& theArc);
 117 static GCS::SET_pD ellipseParameters(const EdgeWrapperPtr& theEllipse);
 118
 119
 120
 121
 122
 123 SolverConstraintPtr PlaneGCSSolver_Tools::createConstraint(ConstraintPtr theConstraint)
 124 {
 125   if (theConstraint->getKind() == SketchPlugin_ConstraintCoincidence::ID()) {
 126     return SolverConstraintPtr(new SketchSolver_ConstraintCoincidence(theConstraint));
 127   } else if (theConstraint->getKind() == SketchPlugin_ConstraintCollinear::ID()) {
 128     return SolverConstraintPtr(new SketchSolver_ConstraintCollinear(theConstraint));
 129   } else if (theConstraint->getKind() == SketchPlugin_ConstraintDistance::ID() ||
 130              theConstraint->getKind() == SketchPlugin_ConstraintDistanceHorizontal::ID() ||
 131              theConstraint->getKind() == SketchPlugin_ConstraintDistanceVertical::ID()) {
 132     return SolverConstraintPtr(new SketchSolver_ConstraintDistance(theConstraint));
 133   } else if (theConstraint->getKind() == SketchPlugin_ConstraintEqual::ID()) {
 134     return SolverConstraintPtr(new SketchSolver_ConstraintEqual(theConstraint));
 135   } else if (theConstraint->getKind() == SketchPlugin_ConstraintLength::ID()) {
 136     return SolverConstraintPtr(new SketchSolver_ConstraintLength(theConstraint));
 137   } else if (theConstraint->getKind() == SketchPlugin_ConstraintMiddle::ID()) {
 138     return SolverConstraintPtr(new SketchSolver_ConstraintMiddle(theConstraint));
 139   } else if (theConstraint->getKind() == SketchPlugin_ConstraintMirror::ID()) {
 140     return SolverConstraintPtr(new SketchSolver_ConstraintMirror(theConstraint));
 141   } else if (theConstraint->getKind() == SketchPlugin_ConstraintTangent::ID()) {
 142     return SolverConstraintPtr(new SketchSolver_ConstraintTangent(theConstraint));
 143   } else if (theConstraint->getKind() == SketchPlugin_ConstraintRigid::ID()) {
 144     return SolverConstraintPtr(new SketchSolver_ConstraintFixed(theConstraint));
 145   } else if (theConstraint->getKind() == SketchPlugin_MultiTranslation::ID()) {
 146     return SolverConstraintPtr(new SketchSolver_ConstraintMultiTranslation(theConstraint));
 147   } else if (theConstraint->getKind() == SketchPlugin_MultiRotation::ID()) {
 148     return SolverConstraintPtr(new SketchSolver_ConstraintMultiRotation(theConstraint));
 149   } else if (theConstraint->getKind() == SketchPlugin_ConstraintAngle::ID()) {
 150     return SolverConstraintPtr(new SketchSolver_ConstraintAngle(theConstraint));
 151   }
 152   // All other types of constraints
 153   return SolverConstraintPtr(new SketchSolver_Constraint(theConstraint));
 154 }
 155
 156 std::shared_ptr<SketchSolver_ConstraintMovement> PlaneGCSSolver_Tools::createMovementConstraint(
 157     FeaturePtr theMovedFeature)
 158 {
 159   return std::shared_ptr<SketchSolver_ConstraintMovement>(
 160       new SketchSolver_ConstraintMovement(theMovedFeature));
 161 }
 162
 163 std::shared_ptr<SketchSolver_ConstraintMovement> PlaneGCSSolver_Tools::createMovementConstraint(
 164     AttributePtr theMovedAttribute)
 165 {
 166   return std::shared_ptr<SketchSolver_ConstraintMovement>(
 167       new SketchSolver_ConstraintMovement(theMovedAttribute));
 168 }
 169
 170
 171
 172 ConstraintWrapperPtr PlaneGCSSolver_Tools::createConstraint(
 173     ConstraintPtr theConstraint,
 174     const SketchSolver_ConstraintType& theType,
 175     const EntityWrapperPtr& theValue,
 176     const EntityWrapperPtr& thePoint1,
 177     const EntityWrapperPtr& thePoint2,
 178     const EntityWrapperPtr& theEntity1,
 179     const EntityWrapperPtr& theEntity2)
 180 {
 181   ConstraintWrapperPtr aResult;
 182   ScalarWrapperPtr anIntermediate;
 183
 184   std::shared_ptr<PlaneGCSSolver_PointWrapper> aPoint1 = GCS_POINT_WRAPPER(thePoint1);
 185   std::shared_ptr<PlaneGCSSolver_PointWrapper> aPoint2 = GCS_POINT_WRAPPER(thePoint2);
 186
 187   switch (theType) {
 188   case CONSTRAINT_PT_PT_COINCIDENT:
 189     aResult = createConstraintCoincidence(aPoint1, aPoint2);
 190     break;
 191   case CONSTRAINT_PT_ON_LINE:
 192   case CONSTRAINT_PT_ON_CIRCLE:
 193     aResult = createConstraintPointOnEntity(theType, aPoint1, GCS_EDGE_WRAPPER(theEntity1));
 194     break;
 195   case CONSTRAINT_MIDDLE_POINT:
 196     aResult = createConstraintMiddlePoint(aPoint1, GCS_EDGE_WRAPPER(theEntity1), aPoint2);
 197     break;
 198   case CONSTRAINT_PT_PT_DISTANCE:
 199     aResult = createConstraintDistancePointPoint(GCS_SCALAR_WRAPPER(theValue), aPoint1, aPoint2);
 200     break;
 201   case CONSTRAINT_PT_LINE_DISTANCE:
 202     aResult = createConstraintDistancePointLine(GCS_SCALAR_WRAPPER(theValue),
 203                                                 aPoint1,
 204                                                 GCS_EDGE_WRAPPER(theEntity1));
 205     break;
 206   case CONSTRAINT_HORIZONTAL_DISTANCE:
 207   case CONSTRAINT_VERTICAL_DISTANCE:
 208     aResult = createConstraintHVDistance(theType, GCS_SCALAR_WRAPPER(theValue), aPoint1, aPoint2);
 209     break;
 210   case CONSTRAINT_RADIUS:
 211     aResult = createConstraintRadius(GCS_SCALAR_WRAPPER(theValue),
 212                                      GCS_EDGE_WRAPPER(theEntity1));
 213     break;
 214   case CONSTRAINT_ANGLE:
 215     aResult = createConstraintAngle(theConstraint,
 216                   GCS_SCALAR_WRAPPER(theValue),
 217                   GCS_EDGE_WRAPPER(theEntity1), GCS_EDGE_WRAPPER(theEntity2));
 218     break;
 219   case CONSTRAINT_FIXED:
 220     break;
 221   case CONSTRAINT_HORIZONTAL:
 222   case CONSTRAINT_VERTICAL:
 223     aResult = createConstraintHorizVert(theType, GCS_EDGE_WRAPPER(theEntity1));
 224     break;
 225   case CONSTRAINT_PARALLEL:
 226     aResult = createConstraintParallel(GCS_EDGE_WRAPPER(theEntity1),
 227                                        GCS_EDGE_WRAPPER(theEntity2));
 228     break;
 229   case CONSTRAINT_PERPENDICULAR:
 230     aResult = createConstraintPerpendicular(GCS_EDGE_WRAPPER(theEntity1),
 231                                             GCS_EDGE_WRAPPER(theEntity2));
 232     break;
 233   case CONSTRAINT_EQUAL_LINES:
 234     anIntermediate = GCS_SCALAR_WRAPPER(theValue); // parameter is used to store length of lines
 235   case CONSTRAINT_EQUAL_LINE_ARC:
 236   case CONSTRAINT_EQUAL_RADIUS:
 237     aResult = createConstraintEqual(theType,
 238                                     GCS_EDGE_WRAPPER(theEntity1),
 239                                     GCS_EDGE_WRAPPER(theEntity2),
 240                                     anIntermediate);
 241     break;
 242   default:
 243     break;
 244   }
 245
 246   return aResult;
 247 }
 248
 249 std::shared_ptr<GeomAPI_Pnt2d> PlaneGCSSolver_Tools::point(EntityWrapperPtr theEntity)
 250 {
 251   if (theEntity->type() != ENTITY_POINT)
 252     return std::shared_ptr<GeomAPI_Pnt2d>();
 253
 254   std::shared_ptr<PlaneGCSSolver_PointWrapper> aPointWrapper =
 255       std::dynamic_pointer_cast<PlaneGCSSolver_PointWrapper>(theEntity);
 256   const GCSPointPtr& aPoint = aPointWrapper->point();
 257   return std::shared_ptr<GeomAPI_Pnt2d>(new GeomAPI_Pnt2d(*aPoint->x, *aPoint->y));
 258 }
 259
 260 std::shared_ptr<GeomAPI_Lin2d> PlaneGCSSolver_Tools::line(EntityWrapperPtr theEntity)
 261 {
 262   if (theEntity->type() != ENTITY_LINE)
 263     return std::shared_ptr<GeomAPI_Lin2d>();
 264
 265   std::shared_ptr<PlaneGCSSolver_EdgeWrapper> anEntity =
 266       std::dynamic_pointer_cast<PlaneGCSSolver_EdgeWrapper>(theEntity);
 267   std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(anEntity->entity());
 268   return std::shared_ptr<GeomAPI_Lin2d>(
 269       new GeomAPI_Lin2d(*(aLine->p1.x), *(aLine->p1.y), *(aLine->p2.x), *(aLine->p2.y)));
 270 }
 271
 272 std::shared_ptr<GeomAPI_Lin2d> PlaneGCSSolver_Tools::line(FeaturePtr theFeature)
 273 {
 274   if (theFeature->getKind() != SketchPlugin_Line::ID())
 275     return std::shared_ptr<GeomAPI_Lin2d>();
 276
 277   AttributePoint2DPtr aStart = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
 278       theFeature->attribute(SketchPlugin_Line::START_ID()));
 279   AttributePoint2DPtr aEnd = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
 280       theFeature->attribute(SketchPlugin_Line::END_ID()));
 281
 282   return std::shared_ptr<GeomAPI_Lin2d>(new GeomAPI_Lin2d(aStart->pnt(), aEnd->pnt()));
 283 }
 284
 285
 286 GCS::SET_pD PlaneGCSSolver_Tools::parameters(const EntityWrapperPtr& theEntity)
 287 {
 288   switch (theEntity->type()) {
 289   case ENTITY_SCALAR:
 290   case ENTITY_ANGLE:
 291     return scalarParameters(GCS_SCALAR_WRAPPER(theEntity));
 292   case ENTITY_POINT:
 293     return pointParameters(GCS_POINT_WRAPPER(theEntity));
 294   case ENTITY_LINE:
 295     return lineParameters(GCS_EDGE_WRAPPER(theEntity));
 296   case ENTITY_CIRCLE:
 297     return circleParameters(GCS_EDGE_WRAPPER(theEntity));
 298   case ENTITY_ARC:
 299     return arcParameters(GCS_EDGE_WRAPPER(theEntity));
 300   case ENTITY_ELLIPSE:
 301     return ellipseParameters(GCS_EDGE_WRAPPER(theEntity));
 302   default: break;
 303   }
 304   return GCS::SET_pD();
 305 }
 306
 307
 308
 309
 310
 311
 312 // ================   Auxiliary functions   ==========================
 313 ConstraintWrapperPtr createConstraintCoincidence(
 314     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint1,
 315     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint2)
 316 {
 317   GCSPointPtr aPoint1 = thePoint1->point();
 318   GCSPointPtr aPoint2 = thePoint2->point();
 319
 320   // Create equality constraint for corresponding attributes of the points
 321   std::list<GCSConstraintPtr> aConstrList;
 322   aConstrList.push_back(
 323       GCSConstraintPtr(new GCS::ConstraintEqual(aPoint1->x, aPoint2->x)));
 324   aConstrList.push_back(
 325       GCSConstraintPtr(new GCS::ConstraintEqual(aPoint1->y, aPoint2->y)));
 326
 327   return ConstraintWrapperPtr(new PlaneGCSSolver_ConstraintWrapper(
 328       aConstrList, CONSTRAINT_PT_PT_COINCIDENT));
 329 }
 330
 331 ConstraintWrapperPtr createConstraintPointOnEntity(
 332     const SketchSolver_ConstraintType& theType,
 333     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint,
 334     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity)
 335 {
 336   GCSConstraintPtr aNewConstr;
 337
 338   switch (theEntity->type()) {
 339   case ENTITY_LINE: {
 340     std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(theEntity->entity());
 341     aNewConstr = GCSConstraintPtr(new GCS::ConstraintPointOnLine(*(thePoint->point()), *aLine));
 342     break;
 343     }
 344   case ENTITY_ARC:
 345   case ENTITY_CIRCLE: {
 346     std::shared_ptr<GCS::Circle> aCirc =
 347       std::dynamic_pointer_cast<GCS::Circle>(theEntity->entity());
 348     aNewConstr = GCSConstraintPtr(
 349         new GCS::ConstraintP2PDistance(*(thePoint->point()), aCirc->center, aCirc->rad));
 350     break;
 351     }
 352   case ENTITY_ELLIPSE:
 353   case ENTITY_ELLIPTICAL_ARC: {
 354     std::shared_ptr<GCS::Ellipse> anEllipse =
 355         std::dynamic_pointer_cast<GCS::Ellipse>(theEntity->entity());
 356     aNewConstr = GCSConstraintPtr(
 357         new GCS::ConstraintPointOnEllipse(*(thePoint->point()), *anEllipse));
 358     break;
 359     }
 360   default:
 361     return ConstraintWrapperPtr();
 362   }
 363
 364   return ConstraintWrapperPtr(new PlaneGCSSolver_ConstraintWrapper(aNewConstr, theType));
 365 }
 366
 367 ConstraintWrapperPtr createConstraintMiddlePoint(
 368     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint,
 369     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity,
 370     std::shared_ptr<PlaneGCSSolver_PointWrapper> theAuxParameters)
 371 {
 372   std::list<GCSConstraintPtr> aConstrList;
 373
 374   GCSPointPtr aPoint = thePoint->point();
 375   std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(theEntity->entity());
 376   if (aLine) {
 377     aConstrList.push_back(GCSConstraintPtr(new GCS::ConstraintPointOnLine(*aPoint, *aLine)));
 378     aConstrList.push_back(
 379         GCSConstraintPtr(new GCS::ConstraintPointOnPerpBisector(*aPoint, aLine->p1, aLine->p2)));
 380   }
 381   else {
 382     std::shared_ptr<GCS::Arc> anArc = std::dynamic_pointer_cast<GCS::Arc>(theEntity->entity());
 383     if (anArc) {
 384       double* u = theAuxParameters->point()->x;
 385       double* diff = theAuxParameters->point()->y;
 386       *u = (*anArc->startAngle + *anArc->endAngle) * 0.5;
 387       *diff = (*anArc->endAngle - *anArc->startAngle) * 0.5;
 388
 389       aConstrList.push_back(GCSConstraintPtr(
 390           new GCS::ConstraintCurveValue(*aPoint, aPoint->x, *anArc, u)));
 391       aConstrList.push_back(GCSConstraintPtr(
 392           new GCS::ConstraintCurveValue(*aPoint, aPoint->y, *anArc, u)));
 393       aConstrList.push_back(GCSConstraintPtr(
 394           new GCS::ConstraintDifference(anArc->startAngle, u, diff)));
 395       aConstrList.push_back(GCSConstraintPtr(
 396           new GCS::ConstraintDifference(u, anArc->endAngle, diff)));
 397     }
 398   }
 399
 400   return aConstrList.empty() ? ConstraintWrapperPtr() : ConstraintWrapperPtr(
 401       new PlaneGCSSolver_ConstraintWrapper(aConstrList, CONSTRAINT_MIDDLE_POINT));
 402 }
 403
 404
 405 ConstraintWrapperPtr createConstraintDistancePointPoint(
 406     std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
 407     std::shared_ptr<PlaneGCSSolver_PointWrapper>  thePoint1,
 408     std::shared_ptr<PlaneGCSSolver_PointWrapper>  thePoint2)
 409 {
 410   GCSConstraintPtr aNewConstr(new GCS::ConstraintP2PDistance(
 411       *(thePoint1->point()), *(thePoint2->point()), theValue->scalar()));
 412   std::shared_ptr<PlaneGCSSolver_ConstraintWrapper> aResult(
 413       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_PT_PT_DISTANCE));
 414   aResult->setValueParameter(theValue);
 415   return aResult;
 416 }
 417
 418 ConstraintWrapperPtr createConstraintDistancePointLine(
 419     std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
 420     std::shared_ptr<PlaneGCSSolver_PointWrapper>  thePoint,
 421     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity)
 422 {
 423   std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(theEntity->entity());
 424   GCSConstraintPtr aNewConstr(new GCS::ConstraintP2LDistance(
 425       *(thePoint->point()), *(aLine), theValue->scalar()));
 426   std::shared_ptr<PlaneGCSSolver_ConstraintWrapper> aResult(
 427       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_PT_LINE_DISTANCE));
 428   aResult->setValueParameter(theValue);
 429   return aResult;
 430 }
 431
 432 ConstraintWrapperPtr createConstraintHVDistance(
 433     const SketchSolver_ConstraintType& theType,
 434     std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
 435     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint1,
 436     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint2)
 437 {
 438   GCSPointPtr aPoint1 = thePoint1->point();
 439   GCSPointPtr aPoint2 = thePoint2->point();
 440
 441   double *aParam1, *aParam2;
 442   if (theType == CONSTRAINT_HORIZONTAL_DISTANCE) {
 443     aParam1 = aPoint1->x;
 444     aParam2 = aPoint2->x;
 445   } else if (theType == CONSTRAINT_VERTICAL_DISTANCE) {
 446     aParam1 = aPoint1->y;
 447     aParam2 = aPoint2->y;
 448   }
 449
 450   GCSConstraintPtr aNewConstr(new GCS::ConstraintDifference(aParam1, aParam2, theValue->scalar()));
 451
 452   std::shared_ptr<PlaneGCSSolver_ConstraintWrapper> aResult(
 453       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, theType));
 454   aResult->setValueParameter(theValue);
 455   return aResult;
 456 }
 457
 458 ConstraintWrapperPtr createConstraintRadius(
 459     std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
 460     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity)
 461 {
 462   std::shared_ptr<GCS::Circle> aCircle =
 463     std::dynamic_pointer_cast<GCS::Circle>(theEntity->entity());
 464   GCSConstraintPtr aNewConstr(new GCS::ConstraintEqual(aCircle->rad, theValue->scalar()));
 465   std::shared_ptr<PlaneGCSSolver_ConstraintWrapper> aResult(
 466       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_RADIUS));
 467   aResult->setValueParameter(theValue);
 468   return aResult;
 469 }
 470
 471 ConstraintWrapperPtr createConstraintAngle(
 472     ConstraintPtr theConstraint,
 473     std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
 474     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity1,
 475     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity2)
 476 {
 477   std::shared_ptr<GCS::Line> aLine1 = std::dynamic_pointer_cast<GCS::Line>(theEntity1->entity());
 478   bool isLine1Rev = theConstraint->boolean(
 479       SketchPlugin_ConstraintAngle::ANGLE_REVERSED_FIRST_LINE_ID())->value();
 480   GCS::Point aLine1Pt1 = isLine1Rev ? aLine1->p2 : aLine1->p1;
 481   GCS::Point aLine1Pt2 = isLine1Rev ? aLine1->p1 : aLine1->p2;
 482
 483   std::shared_ptr<GCS::Line> aLine2 = std::dynamic_pointer_cast<GCS::Line>(theEntity2->entity());
 484   bool isLine2Rev = theConstraint->boolean(
 485       SketchPlugin_ConstraintAngle::ANGLE_REVERSED_SECOND_LINE_ID())->value();
 486   GCS::Point aLine2Pt1 = isLine2Rev ? aLine2->p2 : aLine2->p1;
 487   GCS::Point aLine2Pt2 = isLine2Rev ? aLine2->p1 : aLine2->p2;
 488
 489   GCSConstraintPtr aNewConstr(new GCS::ConstraintL2LAngle(
 490       aLine1Pt1, aLine1Pt2, aLine2Pt1, aLine2Pt2, theValue->scalar()));
 491
 492   std::shared_ptr<PlaneGCSSolver_ConstraintWrapper> aResult(
 493       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_ANGLE));
 494   aResult->setValueParameter(theValue);
 495   return aResult;
 496 }
 497
 498 ConstraintWrapperPtr createConstraintHorizVert(
 499     const SketchSolver_ConstraintType& theType,
 500     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity)
 501 {
 502   std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(theEntity->entity());
 503   GCSConstraintPtr aNewConstr;
 504   if (theType == CONSTRAINT_HORIZONTAL)
 505     aNewConstr = GCSConstraintPtr(new GCS::ConstraintEqual(aLine->p1.y, aLine->p2.y));
 506   else
 507     aNewConstr = GCSConstraintPtr(new GCS::ConstraintEqual(aLine->p1.x, aLine->p2.x));
 508
 509   return ConstraintWrapperPtr(new PlaneGCSSolver_ConstraintWrapper(aNewConstr, theType));
 510 }
 511
 512 ConstraintWrapperPtr createConstraintParallel(
 513     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity1,
 514     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity2)
 515 {
 516   std::shared_ptr<GCS::Line> aLine1 = std::dynamic_pointer_cast<GCS::Line>(theEntity1->entity());
 517   std::shared_ptr<GCS::Line> aLine2 = std::dynamic_pointer_cast<GCS::Line>(theEntity2->entity());
 518   GCSConstraintPtr aNewConstr(new GCS::ConstraintParallel(*(aLine1), *(aLine2)));
 519
 520   return ConstraintWrapperPtr(
 521       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_PARALLEL));
 522 }
 523
 524 ConstraintWrapperPtr createConstraintPerpendicular(
 525     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity1,
 526     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity2)
 527 {
 528   std::shared_ptr<GCS::Line> aLine1 = std::dynamic_pointer_cast<GCS::Line>(theEntity1->entity());
 529   std::shared_ptr<GCS::Line> aLine2 = std::dynamic_pointer_cast<GCS::Line>(theEntity2->entity());
 530
 531   std::shared_ptr<GCS::Circle> aCirc1 =
 532       std::dynamic_pointer_cast<GCS::Circle>(theEntity1->entity());
 533   std::shared_ptr<GCS::Circle> aCirc2 =
 534       std::dynamic_pointer_cast<GCS::Circle>(theEntity2->entity());
 535
 536   GCSConstraintPtr aNewConstr;
 537   if (aLine1 && aLine2)
 538     aNewConstr.reset(new GCS::ConstraintPerpendicular(*(aLine1), *(aLine2)));
 539   else {
 540     if (aLine1 && aCirc2)
 541       aCirc1 = aCirc2;
 542     else if (aLine2 && aCirc1)
 543       aLine1 = aLine2;
 544
 545     aNewConstr.reset(new GCS::ConstraintPointOnLine(aCirc1->center, *aLine1));
 546   }
 547
 548   return ConstraintWrapperPtr(
 549       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_PERPENDICULAR));
 550 }
 551
 552 ConstraintWrapperPtr createConstraintEqual(
 553     const SketchSolver_ConstraintType& theType,
 554     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity1,
 555     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity2,
 556     std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theIntermed)
 557 {
 558   if (theType == CONSTRAINT_EQUAL_LINE_ARC)
 559     return ConstraintWrapperPtr(); // line-arc equivalence is not supported yet
 560
 561   std::list<GCSConstraintPtr> aConstrList;
 562   if (theType == CONSTRAINT_EQUAL_LINES) {
 563     std::shared_ptr<GCS::Line> aLine1 = std::dynamic_pointer_cast<GCS::Line>(theEntity1->entity());
 564     std::shared_ptr<GCS::Line> aLine2 = std::dynamic_pointer_cast<GCS::Line>(theEntity2->entity());
 565
 566     aConstrList.push_back(GCSConstraintPtr(
 567         new GCS::ConstraintP2PDistance(aLine1->p1, aLine1->p2, theIntermed->scalar())));
 568     aConstrList.push_back(GCSConstraintPtr(
 569         new GCS::ConstraintP2PDistance(aLine2->p1, aLine2->p2, theIntermed->scalar())));
 570     // update value of intermediate parameter
 571     double x = *aLine1->p1.x - *aLine1->p2.x;
 572     double y = *aLine1->p1.y - *aLine1->p2.y;
 573     double aLen = sqrt(x*x + y*y);
 574     theIntermed->setValue(aLen);
 575   } else {
 576     std::shared_ptr<GCS::Circle> aCirc1 =
 577         std::dynamic_pointer_cast<GCS::Circle>(theEntity1->entity());
 578     std::shared_ptr<GCS::Circle> aCirc2 =
 579         std::dynamic_pointer_cast<GCS::Circle>(theEntity2->entity());
 580
 581     if (aCirc1 && aCirc2)
 582       aConstrList.push_back(GCSConstraintPtr(new GCS::ConstraintEqual(aCirc1->rad, aCirc2->rad)));
 583     else {
 584       std::shared_ptr<GCS::Ellipse> anEllipse1 =
 585           std::dynamic_pointer_cast<GCS::Ellipse>(theEntity1->entity());
 586       std::shared_ptr<GCS::Ellipse> anEllipse2 =
 587           std::dynamic_pointer_cast<GCS::Ellipse>(theEntity2->entity());
 588
 589       aConstrList.push_back(GCSConstraintPtr(
 590           new GCS::ConstraintEqual(anEllipse1->radmin, anEllipse2->radmin)));
 591       aConstrList.push_back(GCSConstraintPtr(
 592           new GCS::ConstraintEqualMajorAxesConic(anEllipse1.get(), anEllipse2.get())));
 593     }
 594   }
 595
 596   std::shared_ptr<PlaneGCSSolver_ConstraintWrapper> aResult(
 597       new PlaneGCSSolver_ConstraintWrapper(aConstrList, theType));
 598   if (theIntermed)
 599     aResult->setValueParameter(theIntermed);
 600   return aResult;
 601 }
 602
 603 GCS::SET_pD scalarParameters(const ScalarWrapperPtr& theScalar)
 604 {
 605   GCS::SET_pD aParams;
 606   aParams.insert(theScalar->scalar());
 607   return aParams;
 608 }
 609
 610 GCS::SET_pD pointParameters(const PointWrapperPtr& thePoint)
 611 {
 612   GCS::SET_pD aParams;
 613   aParams.insert(thePoint->point()->x);
 614   aParams.insert(thePoint->point()->y);
 615   return aParams;
 616 }
 617
 618 GCS::SET_pD lineParameters(const EdgeWrapperPtr& theLine)
 619 {
 620   GCS::SET_pD aParams;
 621   std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(theLine->entity());
 622   aParams.insert(aLine->p1.x);
 623   aParams.insert(aLine->p1.y);
 624   aParams.insert(aLine->p2.x);
 625   aParams.insert(aLine->p2.y);
 626   return aParams;
 627 }
 628
 629 GCS::SET_pD circleParameters(const EdgeWrapperPtr& theCircle)
 630 {
 631   GCS::SET_pD aParams;
 632   std::shared_ptr<GCS::Circle> aCirc = std::dynamic_pointer_cast<GCS::Circle>(theCircle->entity());
 633   aParams.insert(aCirc->center.x);
 634   aParams.insert(aCirc->center.y);
 635   aParams.insert(aCirc->rad);
 636   return aParams;
 637 }
 638
 639 GCS::SET_pD arcParameters(const EdgeWrapperPtr& theArc)
 640 {
 641   GCS::SET_pD aParams;
 642   std::shared_ptr<GCS::Arc> anArc = std::dynamic_pointer_cast<GCS::Arc>(theArc->entity());
 643   aParams.insert(anArc->center.x);
 644   aParams.insert(anArc->center.y);
 645   aParams.insert(anArc->start.x);
 646   aParams.insert(anArc->start.y);
 647   aParams.insert(anArc->end.x);
 648   aParams.insert(anArc->end.y);
 649   aParams.insert(anArc->startAngle);
 650   aParams.insert(anArc->endAngle);
 651   aParams.insert(anArc->rad);
 652   return aParams;
 653 }
 654
 655 GCS::SET_pD ellipseParameters(const EdgeWrapperPtr& theEllipse)
 656 {
 657   GCS::SET_pD aParams;
 658   std::shared_ptr<GCS::Ellipse> anEllipse =
 659       std::dynamic_pointer_cast<GCS::Ellipse>(theEllipse->entity());
 660   aParams.insert(anEllipse->center.x);
 661   aParams.insert(anEllipse->center.y);
 662   aParams.insert(anEllipse->focus1.x);
 663   aParams.insert(anEllipse->focus1.y);
 664   aParams.insert(anEllipse->radmin);
 665   return aParams;
 666 }