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 <SketchPlugin_ConstraintCoincidenceInternal.h>
  30 #include <SketchSolver_ConstraintCollinear.h>
  31 #include <SketchSolver_ConstraintDistance.h>
  32 #include <SketchSolver_ConstraintEqual.h>
  33 #include <SketchSolver_ConstraintFixed.h>
  34 #include <SketchSolver_ConstraintLength.h>
  35 #include <SketchSolver_ConstraintMiddle.h>
  36 #include <SketchSolver_ConstraintMirror.h>
  37 #include <SketchSolver_ConstraintPerpendicular.h>
  38 #include <SketchSolver_ConstraintTangent.h>
  39 #include <SketchSolver_ConstraintMultiRotation.h>
  40 #include <SketchSolver_ConstraintMultiTranslation.h>
  41
  42 #include <SketchPlugin_ConstraintAngle.h>
  43 #include <SketchPlugin_ConstraintCoincidence.h>
  44 #include <SketchPlugin_ConstraintCollinear.h>
  45 #include <SketchPlugin_ConstraintDistance.h>
  46 #include <SketchPlugin_ConstraintDistanceHorizontal.h>
  47 #include <SketchPlugin_ConstraintDistanceVertical.h>
  48 #include <SketchPlugin_ConstraintEqual.h>
  49 #include <SketchPlugin_ConstraintLength.h>
  50 #include <SketchPlugin_ConstraintMiddle.h>
  51 #include <SketchPlugin_ConstraintMirror.h>
  52 #include <SketchPlugin_ConstraintRigid.h>
  53 #include <SketchPlugin_ConstraintPerpendicular.h>
  54 #include <SketchPlugin_ConstraintTangent.h>
  55 #include <SketchPlugin_Line.h>
  56 #include <SketchPlugin_MultiRotation.h>
  57 #include <SketchPlugin_MultiTranslation.h>
  58
  59 #include <GeomAPI_Circ2d.h>
  60 #include <GeomAPI_Dir2d.h>
  61 #include <GeomAPI_Ellipse2d.h>
  62 #include <GeomAPI_Lin2d.h>
  63 #include <GeomAPI_Pnt2d.h>
  64
  65 #include <cmath>
  66
  67
  68 #define GCS_EDGE_WRAPPER(x)   std::dynamic_pointer_cast<PlaneGCSSolver_EdgeWrapper>(x)
  69 #define GCS_POINT_WRAPPER(x)  std::dynamic_pointer_cast<PlaneGCSSolver_PointWrapper>(x)
  70 #define GCS_SCALAR_WRAPPER(x) std::dynamic_pointer_cast<PlaneGCSSolver_ScalarWrapper>(x)
  71
  72
  73
  74 static ConstraintWrapperPtr
  75   createConstraintCoincidence(std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint1,
  76                               std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint2);
  77 static ConstraintWrapperPtr
  78   createConstraintPointOnEntity(const SketchSolver_ConstraintType& theType,
  79                                 std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint,
  80                                 std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity);
  81 static ConstraintWrapperPtr
  82   createConstraintPointsCollinear(std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint1,
  83                                   std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint2,
  84                                   std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint3);
  85 static ConstraintWrapperPtr
  86   createConstraintDistancePointPoint(std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
  87                                      std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint1,
  88                                      std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint2);
  89 static ConstraintWrapperPtr
  90   createConstraintDistancePointLine(std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
  91                                     std::shared_ptr<PlaneGCSSolver_PointWrapper>  thePoint,
  92                                     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity);
  93 static ConstraintWrapperPtr
  94   createConstraintHVDistance(const SketchSolver_ConstraintType& theType,
  95                              std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
  96                              std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint1,
  97                              std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint2);
  98 static ConstraintWrapperPtr
  99   createConstraintRadius(std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
 100                          std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity);
 101 static ConstraintWrapperPtr
 102   createConstraintAngle(ConstraintPtr theConstraint,
 103                         std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
 104                         std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity1,
 105                         std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity2);
 106 static ConstraintWrapperPtr
 107   createConstraintHorizVert(const SketchSolver_ConstraintType& theType,
 108                             std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity);
 109 static ConstraintWrapperPtr
 110   createConstraintParallel(std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity1,
 111                            std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity2);
 112 static ConstraintWrapperPtr
 113   createConstraintPerpendicular(std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity1,
 114                                 std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity2);
 115 static ConstraintWrapperPtr
 116   createConstraintEqual(const SketchSolver_ConstraintType& theType,
 117                         std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity1,
 118                         std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity2,
 119                         std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theIntermed);
 120 static ConstraintWrapperPtr
 121   createConstraintMiddlePoint(std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint,
 122                               std::shared_ptr<PlaneGCSSolver_EdgeWrapper>  theEntity,
 123                               std::shared_ptr<PlaneGCSSolver_PointWrapper> theAuxParameters);
 124 static ConstraintWrapperPtr
 125   createConstraintAngleBetweenCurves(std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
 126                                      std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint,
 127                                      std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity1,
 128                                      std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity2);
 129
 130 static GCS::SET_pD scalarParameters(const ScalarWrapperPtr& theScalar);
 131 static GCS::SET_pD pointParameters(const PointWrapperPtr& thePoint);
 132 static GCS::SET_pD lineParameters(const EdgeWrapperPtr& theLine);
 133 static GCS::SET_pD circleParameters(const EdgeWrapperPtr& theCircle);
 134 static GCS::SET_pD arcParameters(const EdgeWrapperPtr& theArc);
 135 static GCS::SET_pD ellipseParameters(const EdgeWrapperPtr& theEllipse);
 136 static GCS::SET_pD ellipticArcParameters(const EdgeWrapperPtr& theEllipticArc);
 137
 138 static double distance(const GCS::Point& thePnt1, const GCS::Point& thePnt2);
 139
 140
 141
 142
 143
 144 SolverConstraintPtr PlaneGCSSolver_Tools::createConstraint(ConstraintPtr theConstraint)
 145 {
 146   if (theConstraint->getKind() == SketchPlugin_ConstraintCoincidence::ID() ||
 147       theConstraint->getKind() == SketchPlugin_ConstraintCoincidenceInternal::ID()) {
 148     return SolverConstraintPtr(new SketchSolver_ConstraintCoincidence(theConstraint));
 149   } else if (theConstraint->getKind() == SketchPlugin_ConstraintCollinear::ID()) {
 150     return SolverConstraintPtr(new SketchSolver_ConstraintCollinear(theConstraint));
 151   } else if (theConstraint->getKind() == SketchPlugin_ConstraintDistance::ID() ||
 152              theConstraint->getKind() == SketchPlugin_ConstraintDistanceHorizontal::ID() ||
 153              theConstraint->getKind() == SketchPlugin_ConstraintDistanceVertical::ID()) {
 154     return SolverConstraintPtr(new SketchSolver_ConstraintDistance(theConstraint));
 155   } else if (theConstraint->getKind() == SketchPlugin_ConstraintEqual::ID()) {
 156     return SolverConstraintPtr(new SketchSolver_ConstraintEqual(theConstraint));
 157   } else if (theConstraint->getKind() == SketchPlugin_ConstraintLength::ID()) {
 158     return SolverConstraintPtr(new SketchSolver_ConstraintLength(theConstraint));
 159   } else if (theConstraint->getKind() == SketchPlugin_ConstraintMiddle::ID()) {
 160     return SolverConstraintPtr(new SketchSolver_ConstraintMiddle(theConstraint));
 161   } else if (theConstraint->getKind() == SketchPlugin_ConstraintMirror::ID()) {
 162     return SolverConstraintPtr(new SketchSolver_ConstraintMirror(theConstraint));
 163   } else if (theConstraint->getKind() == SketchPlugin_ConstraintTangent::ID()) {
 164     return SolverConstraintPtr(new SketchSolver_ConstraintTangent(theConstraint));
 165   } else if (theConstraint->getKind() == SketchPlugin_ConstraintRigid::ID()) {
 166     return SolverConstraintPtr(new SketchSolver_ConstraintFixed(theConstraint));
 167   } else if (theConstraint->getKind() == SketchPlugin_MultiTranslation::ID()) {
 168     return SolverConstraintPtr(new SketchSolver_ConstraintMultiTranslation(theConstraint));
 169   } else if (theConstraint->getKind() == SketchPlugin_MultiRotation::ID()) {
 170     return SolverConstraintPtr(new SketchSolver_ConstraintMultiRotation(theConstraint));
 171   } else if (theConstraint->getKind() == SketchPlugin_ConstraintAngle::ID()) {
 172     return SolverConstraintPtr(new SketchSolver_ConstraintAngle(theConstraint));
 173   } else if (theConstraint->getKind() == SketchPlugin_ConstraintPerpendicular::ID()) {
 174     return SolverConstraintPtr(new SketchSolver_ConstraintPerpendicular(theConstraint));
 175   }
 176   // All other types of constraints
 177   return SolverConstraintPtr(new SketchSolver_Constraint(theConstraint));
 178 }
 179
 180 std::shared_ptr<SketchSolver_ConstraintMovement> PlaneGCSSolver_Tools::createMovementConstraint(
 181     FeaturePtr theMovedFeature)
 182 {
 183   return std::shared_ptr<SketchSolver_ConstraintMovement>(
 184       new SketchSolver_ConstraintMovement(theMovedFeature));
 185 }
 186
 187 std::shared_ptr<SketchSolver_ConstraintMovement> PlaneGCSSolver_Tools::createMovementConstraint(
 188     AttributePtr theMovedAttribute)
 189 {
 190   return std::shared_ptr<SketchSolver_ConstraintMovement>(
 191       new SketchSolver_ConstraintMovement(theMovedAttribute));
 192 }
 193
 194 std::shared_ptr<SketchSolver_ConstraintMovement> PlaneGCSSolver_Tools::createMovementConstraint(
 195     const std::pair<AttributePtr, int>& theMovedPointInArray)
 196 {
 197   return std::shared_ptr<SketchSolver_ConstraintMovement>(
 198       new SketchSolver_ConstraintMovement(theMovedPointInArray.first, theMovedPointInArray.second));
 199 }
 200
 201
 202
 203 ConstraintWrapperPtr PlaneGCSSolver_Tools::createConstraint(
 204     ConstraintPtr theConstraint,
 205     const SketchSolver_ConstraintType& theType,
 206     const EntityWrapperPtr& theValue,
 207     const EntityWrapperPtr& thePoint1,
 208     const EntityWrapperPtr& thePoint2,
 209     const EntityWrapperPtr& theEntity1,
 210     const EntityWrapperPtr& theEntity2)
 211 {
 212   ConstraintWrapperPtr aResult;
 213   ScalarWrapperPtr anIntermediate;
 214
 215   std::shared_ptr<PlaneGCSSolver_PointWrapper> aPoint1 = GCS_POINT_WRAPPER(thePoint1);
 216   std::shared_ptr<PlaneGCSSolver_PointWrapper> aPoint2 = GCS_POINT_WRAPPER(thePoint2);
 217   std::shared_ptr<PlaneGCSSolver_EdgeWrapper> anEntity1 = GCS_EDGE_WRAPPER(theEntity1);
 218
 219   switch (theType) {
 220   case CONSTRAINT_PT_PT_COINCIDENT:
 221     aResult = createConstraintCoincidence(aPoint1, aPoint2);
 222     break;
 223   case CONSTRAINT_PT_ON_CURVE:
 224     aResult = anEntity1 ? createConstraintPointOnEntity(theType, aPoint1, anEntity1):
 225               createConstraintPointsCollinear(aPoint1, aPoint2, GCS_POINT_WRAPPER(theEntity1));
 226     break;
 227   case CONSTRAINT_MIDDLE_POINT:
 228     aResult = createConstraintMiddlePoint(aPoint1, GCS_EDGE_WRAPPER(theEntity1), aPoint2);
 229     break;
 230   case CONSTRAINT_PT_PT_DISTANCE:
 231     aResult = createConstraintDistancePointPoint(GCS_SCALAR_WRAPPER(theValue), aPoint1, aPoint2);
 232     break;
 233   case CONSTRAINT_PT_LINE_DISTANCE:
 234     aResult = createConstraintDistancePointLine(GCS_SCALAR_WRAPPER(theValue),
 235                                                 aPoint1,
 236                                                 anEntity1);
 237     break;
 238   case CONSTRAINT_HORIZONTAL_DISTANCE:
 239   case CONSTRAINT_VERTICAL_DISTANCE:
 240     aResult = createConstraintHVDistance(theType, GCS_SCALAR_WRAPPER(theValue), aPoint1, aPoint2);
 241     break;
 242   case CONSTRAINT_RADIUS:
 243     aResult = createConstraintRadius(GCS_SCALAR_WRAPPER(theValue), anEntity1);
 244     break;
 245   case CONSTRAINT_ANGLE:
 246     aResult = createConstraintAngle(theConstraint,
 247                   GCS_SCALAR_WRAPPER(theValue),
 248                   anEntity1, GCS_EDGE_WRAPPER(theEntity2));
 249     break;
 250   case CONSTRAINT_FIXED:
 251     break;
 252   case CONSTRAINT_HORIZONTAL:
 253   case CONSTRAINT_VERTICAL:
 254     aResult = createConstraintHorizVert(theType, anEntity1);
 255     break;
 256   case CONSTRAINT_PARALLEL:
 257     aResult = createConstraintParallel(anEntity1, GCS_EDGE_WRAPPER(theEntity2));
 258     break;
 259   case CONSTRAINT_PERPENDICULAR:
 260     aResult = createConstraintPerpendicular(anEntity1, GCS_EDGE_WRAPPER(theEntity2));
 261     break;
 262   case CONSTRAINT_PERPENDICULAR_CURVES:
 263     aResult = createConstraintAngleBetweenCurves(GCS_SCALAR_WRAPPER(theValue),
 264                   aPoint1, anEntity1, GCS_EDGE_WRAPPER(theEntity2));
 265     break;
 266   case CONSTRAINT_EQUAL_LINES:
 267   case CONSTRAINT_EQUAL_ELLIPSES:
 268     anIntermediate = GCS_SCALAR_WRAPPER(theValue); // parameter is used to store length of lines
 269   case CONSTRAINT_EQUAL_LINE_ARC:
 270   case CONSTRAINT_EQUAL_RADIUS:
 271     aResult = createConstraintEqual(theType,
 272                                     anEntity1,
 273                                     GCS_EDGE_WRAPPER(theEntity2),
 274                                     anIntermediate);
 275     break;
 276   default:
 277     break;
 278   }
 279
 280   return aResult;
 281 }
 282
 283 std::shared_ptr<GeomAPI_Pnt2d> PlaneGCSSolver_Tools::point(EntityWrapperPtr theEntity)
 284 {
 285   if (theEntity->type() != ENTITY_POINT)
 286     return std::shared_ptr<GeomAPI_Pnt2d>();
 287
 288   std::shared_ptr<PlaneGCSSolver_PointWrapper> aPointWrapper =
 289       std::dynamic_pointer_cast<PlaneGCSSolver_PointWrapper>(theEntity);
 290   const GCSPointPtr& aPoint = aPointWrapper->point();
 291   return std::shared_ptr<GeomAPI_Pnt2d>(new GeomAPI_Pnt2d(*aPoint->x, *aPoint->y));
 292 }
 293
 294 std::shared_ptr<GeomAPI_Lin2d> PlaneGCSSolver_Tools::line(EntityWrapperPtr theEntity)
 295 {
 296   if (theEntity->type() != ENTITY_LINE)
 297     return std::shared_ptr<GeomAPI_Lin2d>();
 298
 299   std::shared_ptr<PlaneGCSSolver_EdgeWrapper> anEntity =
 300       std::dynamic_pointer_cast<PlaneGCSSolver_EdgeWrapper>(theEntity);
 301   std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(anEntity->entity());
 302   return std::shared_ptr<GeomAPI_Lin2d>(
 303       new GeomAPI_Lin2d(*(aLine->p1.x), *(aLine->p1.y), *(aLine->p2.x), *(aLine->p2.y)));
 304 }
 305
 306 std::shared_ptr<GeomAPI_Lin2d> PlaneGCSSolver_Tools::line(FeaturePtr theFeature)
 307 {
 308   if (theFeature->getKind() != SketchPlugin_Line::ID())
 309     return std::shared_ptr<GeomAPI_Lin2d>();
 310
 311   AttributePoint2DPtr aStart = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
 312       theFeature->attribute(SketchPlugin_Line::START_ID()));
 313   AttributePoint2DPtr aEnd = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
 314       theFeature->attribute(SketchPlugin_Line::END_ID()));
 315
 316   return std::shared_ptr<GeomAPI_Lin2d>(new GeomAPI_Lin2d(aStart->pnt(), aEnd->pnt()));
 317 }
 318
 319 std::shared_ptr<GeomAPI_Circ2d> PlaneGCSSolver_Tools::circle(EntityWrapperPtr theEntity)
 320 {
 321   if (theEntity->type() != ENTITY_CIRCLE && theEntity->type() != ENTITY_ARC)
 322     return std::shared_ptr<GeomAPI_Circ2d>();
 323
 324   std::shared_ptr<PlaneGCSSolver_EdgeWrapper> anEntity =
 325     std::dynamic_pointer_cast<PlaneGCSSolver_EdgeWrapper>(theEntity);
 326   std::shared_ptr<GCS::Circle> aCirc = std::dynamic_pointer_cast<GCS::Circle>(anEntity->entity());
 327   return std::shared_ptr<GeomAPI_Circ2d>(
 328     new GeomAPI_Circ2d(*(aCirc->center.x), *(aCirc->center.y), *(aCirc->rad)));
 329 }
 330
 331 std::shared_ptr<GeomAPI_Ellipse2d> PlaneGCSSolver_Tools::ellipse(EntityWrapperPtr theEntity)
 332 {
 333   if (theEntity->type() != ENTITY_ELLIPSE && theEntity->type() != ENTITY_ELLIPTIC_ARC)
 334     return std::shared_ptr<GeomAPI_Ellipse2d>();
 335
 336   std::shared_ptr<PlaneGCSSolver_EdgeWrapper> anEntity =
 337     std::dynamic_pointer_cast<PlaneGCSSolver_EdgeWrapper>(theEntity);
 338   std::shared_ptr<GCS::Ellipse> anEllipse =
 339       std::dynamic_pointer_cast<GCS::Ellipse>(anEntity->entity());
 340
 341   std::shared_ptr<GeomAPI_Pnt2d> aCenter(
 342       new GeomAPI_Pnt2d(*(anEllipse->center.x), *(anEllipse->center.y)));
 343   std::shared_ptr<GeomAPI_Dir2d> anAxis(new GeomAPI_Dir2d(
 344       *(anEllipse->focus1.x) - *(anEllipse->center.x),
 345       *(anEllipse->focus1.y) - *(anEllipse->center.y)));
 346
 347   return std::shared_ptr<GeomAPI_Ellipse2d>(
 348       new GeomAPI_Ellipse2d(aCenter, anAxis, anEllipse->getRadMaj(), *anEllipse->radmin));
 349 }
 350
 351 void PlaneGCSSolver_Tools::recalculateArcParameters(EntityWrapperPtr theArc)
 352 {
 353   std::shared_ptr<PlaneGCSSolver_EdgeWrapper> anEdge =
 354       std::dynamic_pointer_cast<PlaneGCSSolver_EdgeWrapper>(theArc);
 355   if (!anEdge)
 356     return;
 357
 358   if (anEdge->type() == ENTITY_ARC) {
 359     std::shared_ptr<GCS::Arc> anArc = std::dynamic_pointer_cast<GCS::Arc>(anEdge->entity());
 360
 361     GCS::Point aCenter = anArc->center;
 362     GCS::Point aStartPnt = anArc->start;
 363     GCS::Point aEndPnt = anArc->end;
 364
 365     *anArc->rad = distance(aCenter, aStartPnt);
 366
 367     static GeomDir2dPtr OX(new GeomAPI_Dir2d(1.0, 0.0));
 368
 369     GeomDir2dPtr aDir(new GeomAPI_Dir2d(*aStartPnt.x - *aCenter.x, *aStartPnt.y - *aCenter.y));
 370     *anArc->startAngle = OX->angle(aDir);
 371
 372     aDir.reset(new GeomAPI_Dir2d(*aEndPnt.x - *aCenter.x, *aEndPnt.y - *aCenter.y));
 373     *anArc->endAngle = OX->angle(aDir);
 374   }
 375   else if (anEdge->type() == ENTITY_ELLIPTIC_ARC) {
 376     std::shared_ptr<GCS::ArcOfEllipse> aEllArc =
 377         std::dynamic_pointer_cast<GCS::ArcOfEllipse>(anEdge->entity());
 378
 379     GeomPnt2dPtr aCenter(new GeomAPI_Pnt2d(*aEllArc->center.x, *aEllArc->center.y));
 380     GeomPnt2dPtr aStartPnt(new GeomAPI_Pnt2d(*aEllArc->start.x, *aEllArc->start.y));
 381     GeomPnt2dPtr aEndPnt(new GeomAPI_Pnt2d(*aEllArc->end.x, *aEllArc->end.y));
 382
 383     GeomDir2dPtr anAxis(new GeomAPI_Dir2d(*aEllArc->focus1.x - aCenter->x(),
 384                                           *aEllArc->focus1.y - aCenter->y()));
 385     GeomAPI_Ellipse2d anEllipse(aCenter, anAxis, aEllArc->getRadMaj(), *aEllArc->radmin);
 386     anEllipse.parameter(aStartPnt, 1.e-4, *aEllArc->startAngle);
 387     anEllipse.parameter(aEndPnt, 1.e-4, *aEllArc->endAngle);
 388   }
 389 }
 390
 391
 392
 393 GCS::SET_pD PlaneGCSSolver_Tools::parameters(const EntityWrapperPtr& theEntity)
 394 {
 395   switch (theEntity->type()) {
 396   case ENTITY_SCALAR:
 397   case ENTITY_ANGLE:
 398     return scalarParameters(GCS_SCALAR_WRAPPER(theEntity));
 399   case ENTITY_POINT:
 400     return pointParameters(GCS_POINT_WRAPPER(theEntity));
 401   case ENTITY_LINE:
 402     return lineParameters(GCS_EDGE_WRAPPER(theEntity));
 403   case ENTITY_CIRCLE:
 404     return circleParameters(GCS_EDGE_WRAPPER(theEntity));
 405   case ENTITY_ARC:
 406     return arcParameters(GCS_EDGE_WRAPPER(theEntity));
 407   case ENTITY_ELLIPSE:
 408     return ellipseParameters(GCS_EDGE_WRAPPER(theEntity));
 409   case ENTITY_ELLIPTIC_ARC:
 410     return ellipticArcParameters(GCS_EDGE_WRAPPER(theEntity));
 411   default: break;
 412   }
 413   return GCS::SET_pD();
 414 }
 415
 416
 417
 418
 419
 420
 421 // ================   Auxiliary functions   ==========================
 422 ConstraintWrapperPtr createConstraintCoincidence(
 423     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint1,
 424     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint2)
 425 {
 426   GCSPointPtr aPoint1 = thePoint1->point();
 427   GCSPointPtr aPoint2 = thePoint2->point();
 428
 429   // Create equality constraint for corresponding attributes of the points
 430   std::list<GCSConstraintPtr> aConstrList;
 431   aConstrList.push_back(
 432       GCSConstraintPtr(new GCS::ConstraintEqual(aPoint1->x, aPoint2->x)));
 433   aConstrList.push_back(
 434       GCSConstraintPtr(new GCS::ConstraintEqual(aPoint1->y, aPoint2->y)));
 435
 436   return ConstraintWrapperPtr(new PlaneGCSSolver_ConstraintWrapper(
 437       aConstrList, CONSTRAINT_PT_PT_COINCIDENT));
 438 }
 439
 440 ConstraintWrapperPtr createConstraintPointOnEntity(
 441     const SketchSolver_ConstraintType& theType,
 442     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint,
 443     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity)
 444 {
 445   GCSConstraintPtr aNewConstr;
 446
 447   switch (theEntity->type()) {
 448   case ENTITY_LINE: {
 449     std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(theEntity->entity());
 450     aNewConstr = GCSConstraintPtr(new GCS::ConstraintPointOnLine(*(thePoint->point()), *aLine));
 451     break;
 452     }
 453   case ENTITY_ARC:
 454   case ENTITY_CIRCLE: {
 455     std::shared_ptr<GCS::Circle> aCirc =
 456       std::dynamic_pointer_cast<GCS::Circle>(theEntity->entity());
 457     aNewConstr = GCSConstraintPtr(
 458         new GCS::ConstraintP2PDistance(*(thePoint->point()), aCirc->center, aCirc->rad));
 459     break;
 460     }
 461   case ENTITY_ELLIPSE:
 462   case ENTITY_ELLIPTIC_ARC: {
 463     std::shared_ptr<GCS::Ellipse> anEllipse =
 464         std::dynamic_pointer_cast<GCS::Ellipse>(theEntity->entity());
 465     aNewConstr = GCSConstraintPtr(
 466         new GCS::ConstraintPointOnEllipse(*(thePoint->point()), *anEllipse));
 467     break;
 468     }
 469   default:
 470     return ConstraintWrapperPtr();
 471   }
 472
 473   return ConstraintWrapperPtr(new PlaneGCSSolver_ConstraintWrapper(aNewConstr, theType));
 474 }
 475
 476 ConstraintWrapperPtr createConstraintPointsCollinear(
 477     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint1,
 478     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint2,
 479     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint3)
 480 {
 481   GCSConstraintPtr aNewConstr(new GCS::ConstraintPointOnLine(
 482       *(thePoint1->point()), *(thePoint2->point()), *(thePoint3->point())));
 483   return ConstraintWrapperPtr(
 484       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_PT_ON_CURVE));
 485 }
 486
 487 template <typename ARCTYPE>
 488 void createConstraintMiddlePointOnArc(ARCTYPE theArc,
 489                                       GCSPointPtr thePoint,
 490                                       std::shared_ptr<PlaneGCSSolver_PointWrapper> theAuxParameters,
 491                                       std::list<GCSConstraintPtr>& theConstraints)
 492 {
 493   double* u = theAuxParameters->point()->x;
 494   double* diff = theAuxParameters->point()->y;
 495   *u = (*theArc->startAngle + *theArc->endAngle) * 0.5;
 496   *diff = (*theArc->endAngle - *theArc->startAngle) * 0.5;
 497
 498   theConstraints.push_back(GCSConstraintPtr(
 499       new GCS::ConstraintCurveValue(*thePoint, thePoint->x, *theArc, u)));
 500   theConstraints.push_back(GCSConstraintPtr(
 501       new GCS::ConstraintCurveValue(*thePoint, thePoint->y, *theArc, u)));
 502   theConstraints.push_back(GCSConstraintPtr(
 503       new GCS::ConstraintDifference(theArc->startAngle, u, diff)));
 504   theConstraints.push_back(GCSConstraintPtr(
 505       new GCS::ConstraintDifference(u, theArc->endAngle, diff)));
 506 }
 507
 508 ConstraintWrapperPtr createConstraintMiddlePoint(
 509     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint,
 510     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity,
 511     std::shared_ptr<PlaneGCSSolver_PointWrapper> theAuxParameters)
 512 {
 513   std::list<GCSConstraintPtr> aConstrList;
 514
 515   GCSPointPtr aPoint = thePoint->point();
 516   std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(theEntity->entity());
 517   if (aLine) {
 518     aConstrList.push_back(GCSConstraintPtr(new GCS::ConstraintPointOnLine(*aPoint, *aLine)));
 519     aConstrList.push_back(
 520         GCSConstraintPtr(new GCS::ConstraintPointOnPerpBisector(*aPoint, aLine->p1, aLine->p2)));
 521   }
 522   else {
 523     std::shared_ptr<GCS::Arc> anArc = std::dynamic_pointer_cast<GCS::Arc>(theEntity->entity());
 524     if (anArc)
 525       createConstraintMiddlePointOnArc(anArc, aPoint, theAuxParameters, aConstrList);
 526     else {
 527       std::shared_ptr<GCS::ArcOfEllipse> aEllArc =
 528           std::dynamic_pointer_cast<GCS::ArcOfEllipse>(theEntity->entity());
 529       if (aEllArc)
 530         createConstraintMiddlePointOnArc(aEllArc, aPoint, theAuxParameters, aConstrList);
 531     }
 532   }
 533
 534   return aConstrList.empty() ? ConstraintWrapperPtr() : ConstraintWrapperPtr(
 535       new PlaneGCSSolver_ConstraintWrapper(aConstrList, CONSTRAINT_MIDDLE_POINT));
 536 }
 537
 538
 539 ConstraintWrapperPtr createConstraintDistancePointPoint(
 540     std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
 541     std::shared_ptr<PlaneGCSSolver_PointWrapper>  thePoint1,
 542     std::shared_ptr<PlaneGCSSolver_PointWrapper>  thePoint2)
 543 {
 544   GCSConstraintPtr aNewConstr(new GCS::ConstraintP2PDistance(
 545       *(thePoint1->point()), *(thePoint2->point()), theValue->scalar()));
 546   std::shared_ptr<PlaneGCSSolver_ConstraintWrapper> aResult(
 547       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_PT_PT_DISTANCE));
 548   aResult->setValueParameter(theValue);
 549   return aResult;
 550 }
 551
 552 ConstraintWrapperPtr createConstraintDistancePointLine(
 553     std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
 554     std::shared_ptr<PlaneGCSSolver_PointWrapper>  thePoint,
 555     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity)
 556 {
 557   std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(theEntity->entity());
 558   GCSConstraintPtr aNewConstr(new GCS::ConstraintP2LDistance(
 559       *(thePoint->point()), *(aLine), theValue->scalar()));
 560   std::shared_ptr<PlaneGCSSolver_ConstraintWrapper> aResult(
 561       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_PT_LINE_DISTANCE));
 562   aResult->setValueParameter(theValue);
 563   return aResult;
 564 }
 565
 566 ConstraintWrapperPtr createConstraintHVDistance(
 567     const SketchSolver_ConstraintType& theType,
 568     std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
 569     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint1,
 570     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint2)
 571 {
 572   GCSPointPtr aPoint1 = thePoint1->point();
 573   GCSPointPtr aPoint2 = thePoint2->point();
 574
 575   double *aParam1, *aParam2;
 576   if (theType == CONSTRAINT_HORIZONTAL_DISTANCE) {
 577     aParam1 = aPoint1->x;
 578     aParam2 = aPoint2->x;
 579   } else if (theType == CONSTRAINT_VERTICAL_DISTANCE) {
 580     aParam1 = aPoint1->y;
 581     aParam2 = aPoint2->y;
 582   }
 583
 584   GCSConstraintPtr aNewConstr(new GCS::ConstraintDifference(aParam1, aParam2, theValue->scalar()));
 585
 586   std::shared_ptr<PlaneGCSSolver_ConstraintWrapper> aResult(
 587       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, theType));
 588   aResult->setValueParameter(theValue);
 589   return aResult;
 590 }
 591
 592 ConstraintWrapperPtr createConstraintRadius(
 593     std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
 594     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity)
 595 {
 596   std::shared_ptr<GCS::Circle> aCircle =
 597     std::dynamic_pointer_cast<GCS::Circle>(theEntity->entity());
 598   GCSConstraintPtr aNewConstr(new GCS::ConstraintEqual(aCircle->rad, theValue->scalar()));
 599   std::shared_ptr<PlaneGCSSolver_ConstraintWrapper> aResult(
 600       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_RADIUS));
 601   aResult->setValueParameter(theValue);
 602   return aResult;
 603 }
 604
 605 ConstraintWrapperPtr createConstraintAngle(
 606     ConstraintPtr theConstraint,
 607     std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
 608     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity1,
 609     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity2)
 610 {
 611   std::shared_ptr<GCS::Line> aLine1 = std::dynamic_pointer_cast<GCS::Line>(theEntity1->entity());
 612   std::shared_ptr<GCS::Line> aLine2 = std::dynamic_pointer_cast<GCS::Line>(theEntity2->entity());
 613
 614   GCSConstraintPtr aNewConstr(new GCS::ConstraintL2LAngle(
 615       aLine1->p1, aLine1->p2, aLine2->p1, aLine2->p2, theValue->scalar()));
 616
 617   std::shared_ptr<PlaneGCSSolver_ConstraintWrapper> aResult(
 618       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_ANGLE));
 619   aResult->setValueParameter(theValue);
 620   return aResult;
 621 }
 622
 623 ConstraintWrapperPtr createConstraintHorizVert(
 624     const SketchSolver_ConstraintType& theType,
 625     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity)
 626 {
 627   std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(theEntity->entity());
 628   GCSConstraintPtr aNewConstr;
 629   if (theType == CONSTRAINT_HORIZONTAL)
 630     aNewConstr = GCSConstraintPtr(new GCS::ConstraintEqual(aLine->p1.y, aLine->p2.y));
 631   else
 632     aNewConstr = GCSConstraintPtr(new GCS::ConstraintEqual(aLine->p1.x, aLine->p2.x));
 633
 634   return ConstraintWrapperPtr(new PlaneGCSSolver_ConstraintWrapper(aNewConstr, theType));
 635 }
 636
 637 ConstraintWrapperPtr createConstraintParallel(
 638     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity1,
 639     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity2)
 640 {
 641   std::shared_ptr<GCS::Line> aLine1 = std::dynamic_pointer_cast<GCS::Line>(theEntity1->entity());
 642   std::shared_ptr<GCS::Line> aLine2 = std::dynamic_pointer_cast<GCS::Line>(theEntity2->entity());
 643   GCSConstraintPtr aNewConstr(new GCS::ConstraintParallel(*(aLine1), *(aLine2)));
 644
 645   return ConstraintWrapperPtr(
 646       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_PARALLEL));
 647 }
 648
 649 ConstraintWrapperPtr createConstraintPerpendicular(
 650     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity1,
 651     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity2)
 652 {
 653   std::shared_ptr<GCS::Line> aLine1 = std::dynamic_pointer_cast<GCS::Line>(theEntity1->entity());
 654   std::shared_ptr<GCS::Line> aLine2 = std::dynamic_pointer_cast<GCS::Line>(theEntity2->entity());
 655
 656   std::shared_ptr<GCS::Circle> aCirc1 =
 657       std::dynamic_pointer_cast<GCS::Circle>(theEntity1->entity());
 658   std::shared_ptr<GCS::Circle> aCirc2 =
 659       std::dynamic_pointer_cast<GCS::Circle>(theEntity2->entity());
 660
 661   GCSConstraintPtr aNewConstr;
 662   if (aLine1 && aLine2)
 663     aNewConstr.reset(new GCS::ConstraintPerpendicular(*(aLine1), *(aLine2)));
 664   else {
 665     if (aLine1 && aCirc2)
 666       aCirc1 = aCirc2;
 667     else if (aLine2 && aCirc1)
 668       aLine1 = aLine2;
 669
 670     aNewConstr.reset(new GCS::ConstraintPointOnLine(aCirc1->center, *aLine1));
 671   }
 672
 673   return ConstraintWrapperPtr(
 674       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_PERPENDICULAR));
 675 }
 676
 677 ConstraintWrapperPtr createConstraintAngleBetweenCurves(
 678     std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theValue,
 679     std::shared_ptr<PlaneGCSSolver_PointWrapper> thePoint,
 680     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity1,
 681     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity2)
 682 {
 683   GCSConstraintPtr aNewConstr(new GCS::ConstraintAngleViaPoint(
 684       *theEntity1->entity(), *theEntity2->entity(), *thePoint->point(), theValue->scalar()));
 685   return ConstraintWrapperPtr(
 686       new PlaneGCSSolver_ConstraintWrapper(aNewConstr, CONSTRAINT_PERPENDICULAR_CURVES));
 687 }
 688
 689 ConstraintWrapperPtr createConstraintEqual(
 690     const SketchSolver_ConstraintType& theType,
 691     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity1,
 692     std::shared_ptr<PlaneGCSSolver_EdgeWrapper> theEntity2,
 693     std::shared_ptr<PlaneGCSSolver_ScalarWrapper> theIntermed)
 694 {
 695   if (theType == CONSTRAINT_EQUAL_LINE_ARC)
 696     return ConstraintWrapperPtr(); // line-arc equivalence is not supported yet
 697
 698   std::list<GCSConstraintPtr> aConstrList;
 699   if (theType == CONSTRAINT_EQUAL_LINES) {
 700     std::shared_ptr<GCS::Line> aLine1 = std::dynamic_pointer_cast<GCS::Line>(theEntity1->entity());
 701     std::shared_ptr<GCS::Line> aLine2 = std::dynamic_pointer_cast<GCS::Line>(theEntity2->entity());
 702
 703     aConstrList.push_back(GCSConstraintPtr(
 704         new GCS::ConstraintP2PDistance(aLine1->p1, aLine1->p2, theIntermed->scalar())));
 705     aConstrList.push_back(GCSConstraintPtr(
 706         new GCS::ConstraintP2PDistance(aLine2->p1, aLine2->p2, theIntermed->scalar())));
 707     // update value of intermediate parameter
 708     theIntermed->setValue(distance(aLine1->p1, aLine1->p2));
 709   }
 710   else if (theType == CONSTRAINT_EQUAL_ELLIPSES) {
 711     std::shared_ptr<GCS::Ellipse> anEllipse1 =
 712         std::dynamic_pointer_cast<GCS::Ellipse>(theEntity1->entity());
 713     std::shared_ptr<GCS::Ellipse> anEllipse2 =
 714         std::dynamic_pointer_cast<GCS::Ellipse>(theEntity2->entity());
 715
 716     aConstrList.push_back(GCSConstraintPtr(
 717         new GCS::ConstraintEqual(anEllipse1->radmin, anEllipse2->radmin)));
 718     aConstrList.push_back(GCSConstraintPtr(new GCS::ConstraintP2PDistance(
 719         anEllipse1->center, anEllipse1->focus1, theIntermed->scalar())));
 720     aConstrList.push_back(GCSConstraintPtr(new GCS::ConstraintP2PDistance(
 721         anEllipse2->center, anEllipse2->focus1, theIntermed->scalar())));
 722     // update value of intermediate parameter
 723     theIntermed->setValue(distance(anEllipse1->center, anEllipse1->focus1));
 724   }
 725   else {
 726     std::shared_ptr<GCS::Circle> aCirc1 =
 727         std::dynamic_pointer_cast<GCS::Circle>(theEntity1->entity());
 728     std::shared_ptr<GCS::Circle> aCirc2 =
 729         std::dynamic_pointer_cast<GCS::Circle>(theEntity2->entity());
 730     aConstrList.push_back(GCSConstraintPtr(new GCS::ConstraintEqual(aCirc1->rad, aCirc2->rad)));
 731   }
 732
 733   std::shared_ptr<PlaneGCSSolver_ConstraintWrapper> aResult(
 734       new PlaneGCSSolver_ConstraintWrapper(aConstrList, theType));
 735   if (theIntermed)
 736     aResult->setValueParameter(theIntermed);
 737   return aResult;
 738 }
 739
 740 GCS::SET_pD scalarParameters(const ScalarWrapperPtr& theScalar)
 741 {
 742   GCS::SET_pD aParams;
 743   aParams.insert(theScalar->scalar());
 744   return aParams;
 745 }
 746
 747 GCS::SET_pD pointParameters(const PointWrapperPtr& thePoint)
 748 {
 749   GCS::SET_pD aParams;
 750   aParams.insert(thePoint->point()->x);
 751   aParams.insert(thePoint->point()->y);
 752   return aParams;
 753 }
 754
 755 GCS::SET_pD lineParameters(const EdgeWrapperPtr& theLine)
 756 {
 757   GCS::SET_pD aParams;
 758   std::shared_ptr<GCS::Line> aLine = std::dynamic_pointer_cast<GCS::Line>(theLine->entity());
 759   aParams.insert(aLine->p1.x);
 760   aParams.insert(aLine->p1.y);
 761   aParams.insert(aLine->p2.x);
 762   aParams.insert(aLine->p2.y);
 763   return aParams;
 764 }
 765
 766 GCS::SET_pD circleParameters(const EdgeWrapperPtr& theCircle)
 767 {
 768   GCS::SET_pD aParams;
 769   std::shared_ptr<GCS::Circle> aCirc = std::dynamic_pointer_cast<GCS::Circle>(theCircle->entity());
 770   aParams.insert(aCirc->center.x);
 771   aParams.insert(aCirc->center.y);
 772   aParams.insert(aCirc->rad);
 773   return aParams;
 774 }
 775
 776 GCS::SET_pD arcParameters(const EdgeWrapperPtr& theArc)
 777 {
 778   GCS::SET_pD aParams = circleParameters(theArc);
 779   std::shared_ptr<GCS::Arc> anArc = std::dynamic_pointer_cast<GCS::Arc>(theArc->entity());
 780   aParams.insert(anArc->start.x);
 781   aParams.insert(anArc->start.y);
 782   aParams.insert(anArc->end.x);
 783   aParams.insert(anArc->end.y);
 784   aParams.insert(anArc->startAngle);
 785   aParams.insert(anArc->endAngle);
 786   return aParams;
 787 }
 788
 789 GCS::SET_pD ellipseParameters(const EdgeWrapperPtr& theEllipse)
 790 {
 791   GCS::SET_pD aParams;
 792   std::shared_ptr<GCS::Ellipse> anEllipse =
 793       std::dynamic_pointer_cast<GCS::Ellipse>(theEllipse->entity());
 794   aParams.insert(anEllipse->center.x);
 795   aParams.insert(anEllipse->center.y);
 796   aParams.insert(anEllipse->focus1.x);
 797   aParams.insert(anEllipse->focus1.y);
 798   aParams.insert(anEllipse->radmin);
 799   return aParams;
 800 }
 801
 802 GCS::SET_pD ellipticArcParameters(const EdgeWrapperPtr& theEllipticArc)
 803 {
 804   GCS::SET_pD aParams = ellipseParameters(theEllipticArc);
 805   std::shared_ptr<GCS::ArcOfEllipse> anArc =
 806       std::dynamic_pointer_cast<GCS::ArcOfEllipse>(theEllipticArc->entity());
 807   aParams.insert(anArc->start.x);
 808   aParams.insert(anArc->start.y);
 809   aParams.insert(anArc->end.x);
 810   aParams.insert(anArc->end.y);
 811   aParams.insert(anArc->startAngle);
 812   aParams.insert(anArc->endAngle);
 813   return aParams;
 814 }
 815
 816 double distance(const GCS::Point& thePnt1, const GCS::Point& thePnt2)
 817 {
 818   double x = *thePnt1.x - *thePnt2.x;
 819   double y = *thePnt1.y - *thePnt2.y;
 820   return sqrt(x*x + y*y);
 821 }