src/SketchSolver/SketchSolver_Group.cpp

   1 // Copyright (C) 2014-20xx CEA/DEN, EDF R&D
   2
   3 // File:    SketchSolver_Group.cpp
   4 // Created: 27 May 2014
   5 // Author:  Artem ZHIDKOV
   6
   7 #include "SketchSolver_Group.h"
   8
   9 #include <SketchSolver_Constraint.h>
  10 #include <SketchSolver_ConstraintCoincidence.h>
  11 #include <SketchSolver_ConstraintMulti.h>
  12 #include <SketchSolver_Error.h>
  13 #include <SketchSolver_Manager.h>
  14
  15 #include <Events_Error.h>
  16 #include <Events_Loop.h>
  17 #include <ModelAPI_AttributeString.h>
  18 #include <ModelAPI_Events.h>
  19 #include <ModelAPI_Session.h>
  20 #include <ModelAPI_Validator.h>
  21
  22 #include <SketchPlugin_ConstraintAngle.h>
  23 #include <SketchPlugin_ConstraintCoincidence.h>
  24 #include <SketchPlugin_ConstraintDistance.h>
  25 #include <SketchPlugin_ConstraintEqual.h>
  26 #include <SketchPlugin_ConstraintHorizontal.h>
  27 #include <SketchPlugin_ConstraintLength.h>
  28 #include <SketchPlugin_ConstraintFillet.h>
  29 #include <SketchPlugin_ConstraintMirror.h>
  30 #include <SketchPlugin_ConstraintParallel.h>
  31 #include <SketchPlugin_ConstraintPerpendicular.h>
  32 #include <SketchPlugin_ConstraintRadius.h>
  33 #include <SketchPlugin_ConstraintRigid.h>
  34 #include <SketchPlugin_ConstraintTangent.h>
  35 #include <SketchPlugin_ConstraintVertical.h>
  36 #include <SketchPlugin_MultiRotation.h>
  37 #include <SketchPlugin_MultiTranslation.h>
  38
  39 #include <math.h>
  40 #include <assert.h>
  41
  42
  43 /// \brief This class is used to give unique index to the groups
  44 class GroupIndexer
  45 {
  46 public:
  47   /// \brief Return vacant index
  48   static GroupID NEW_GROUP() { return ++myGroupIndex; }
  49   /// \brief Removes the index
  50   static void REMOVE_GROUP(const GroupID& theIndex) {
  51     if (myGroupIndex == theIndex)
  52       myGroupIndex--;
  53   }
  54
  55 private:
  56   GroupIndexer() {};
  57
  58   static GroupID myGroupIndex; ///< index of the group
  59 };
  60
  61 GroupID GroupIndexer::myGroupIndex = GID_OUTOFGROUP;
  62
  63
  64 static void sendMessage(const char* theMessageName)
  65 {
  66   std::shared_ptr<Events_Message> aMessage = std::shared_ptr<Events_Message>(
  67       new Events_Message(Events_Loop::eventByName(theMessageName)));
  68   Events_Loop::loop()->send(aMessage);
  69 }
  70
  71
  72
  73 // ========================================================
  74 // =========  SketchSolver_Group  ===============
  75 // ========================================================
  76
  77 SketchSolver_Group::SketchSolver_Group(
  78     std::shared_ptr<ModelAPI_CompositeFeature> theWorkplane)
  79     : myID(GroupIndexer::NEW_GROUP()),
  80       myPrevSolved(true)
  81 {
  82   // Initialize workplane
  83   myWorkplaneID = EID_UNKNOWN;
  84   addWorkplane(theWorkplane);
  85 }
  86
  87 SketchSolver_Group::~SketchSolver_Group()
  88 {
  89   myConstraints.clear();
  90   GroupIndexer::REMOVE_GROUP(myID);
  91 }
  92
  93 // ============================================================================
  94 //  Function: isBaseWorkplane
  95 //  Class:    SketchSolver_Group
  96 //  Purpose:  verify the group is based on the given workplane
  97 // ============================================================================
  98 bool SketchSolver_Group::isBaseWorkplane(CompositeFeaturePtr theWorkplane) const
  99 {
 100   return theWorkplane == mySketch;
 101 }
 102
 103 // ============================================================================
 104 //  Function: isInteract
 105 //  Class:    SketchSolver_Group
 106 //  Purpose:  verify are there any entities in the group used by given constraint
 107 // ============================================================================
 108 bool SketchSolver_Group::isInteract(FeaturePtr theFeature) const
 109 {
 110   // Empty group interacts with everything
 111   if (isEmpty())
 112     return true;
 113   // Check interaction with the storage
 114   return myStorage->isInteract(theFeature);
 115 }
 116
 117 // ============================================================================
 118 //  Function: changeConstraint
 119 //  Class:    SketchSolver_Group
 120 //  Purpose:  create/update the constraint in the group
 121 // ============================================================================
 122 bool SketchSolver_Group::changeConstraint(
 123     std::shared_ptr<SketchPlugin_Constraint> theConstraint)
 124 {
 125   // There is no workplane yet, something wrong
 126   if (myWorkplaneID == EID_UNKNOWN)
 127     return false;
 128
 129   if (!theConstraint || !theConstraint->data())
 130     return false;
 131
 132   if (!checkFeatureValidity(theConstraint))
 133     return false;
 134
 135   BuilderPtr aBuilder = SketchSolver_Manager::instance()->builder();
 136   myStorage->blockEvents(true);
 137
 138   bool isNewConstraint = myConstraints.find(theConstraint) == myConstraints.end();
 139   if (isNewConstraint) {
 140     // Add constraint to the current group
 141     SolverConstraintPtr aConstraint = aBuilder->createConstraint(theConstraint);
 142     if (!aConstraint)
 143       return false;
 144     aConstraint->process(myStorage, getId(), getWorkplaneId());
 145     if (!aConstraint->error().empty()) {
 146       if (aConstraint->error() == SketchSolver_Error::NOT_INITIALIZED())
 147         return false; // some attribute are not initialized yet, don't show message
 148       Events_Error::send(aConstraint->error(), this);
 149     }
 150     myConstraints[theConstraint] = aConstraint;
 151   }
 152   else
 153     myConstraints[theConstraint]->update();
 154
 155   // Fix mirror line
 156   if (theConstraint->getKind() == SketchPlugin_ConstraintMirror::ID()) {
 157     AttributeRefAttrPtr aRefAttr = std::dynamic_pointer_cast<ModelAPI_AttributeRefAttr>(
 158         theConstraint->attribute(SketchPlugin_ConstraintMirror::ENTITY_A()));
 159     if (aRefAttr && aRefAttr->isObject()) {
 160       std::shared_ptr<SketchPlugin_Feature> aFeature =
 161           std::dynamic_pointer_cast<SketchPlugin_Feature>(
 162           ModelAPI_Feature::feature(aRefAttr->object()));
 163       if (aFeature) {
 164         SolverConstraintPtr aConstraint = aBuilder->createFixedConstraint(aFeature);
 165         if (aConstraint) {
 166           aConstraint->process(myStorage, getId(), getWorkplaneId());
 167           setTemporary(aConstraint);
 168         }
 169       }
 170     }
 171   }
 172   return true;
 173 }
 174
 175
 176 void SketchSolver_Group::updateConstraints()
 177 {
 178   std::set<SolverConstraintPtr> aPostponed; // postponed constraints Multi-Rotation and Multi-Translation
 179
 180   ConstraintConstraintMap::iterator anIt = myConstraints.begin();
 181   for (; anIt != myConstraints.end(); ++anIt) {
 182     if (myChangedConstraints.find(anIt->first) == myChangedConstraints.end())
 183       continue;
 184     if (anIt->first->getKind() == SketchPlugin_MultiRotation::ID() ||
 185         anIt->first->getKind() == SketchPlugin_MultiTranslation::ID())
 186       aPostponed.insert(anIt->second);
 187     else
 188       anIt->second->update();
 189   }
 190
 191   // Update postponed constraints
 192   std::set<SolverConstraintPtr>::iterator aSCIter = aPostponed.begin();
 193   for (; aSCIter != aPostponed.end(); ++aSCIter)
 194     (*aSCIter)->update();
 195
 196   myChangedConstraints.clear();
 197 }
 198
 199 static void updateMultiConstraints(ConstraintConstraintMap& theConstraints, FeaturePtr theFeature)
 200 {
 201   ConstraintConstraintMap::iterator aCIt = theConstraints.begin();
 202   for (; aCIt != theConstraints.end(); ++aCIt) {
 203     if ((aCIt->second->getType() == CONSTRAINT_MULTI_ROTATION ||
 204          aCIt->second->getType() == CONSTRAINT_MULTI_TRANSLATION)
 205         && aCIt->second->isUsed(theFeature))
 206       std::dynamic_pointer_cast<SketchSolver_ConstraintMulti>(aCIt->second)->update(true);
 207   }
 208 }
 209
 210 bool SketchSolver_Group::updateFeature(FeaturePtr theFeature)
 211 {
 212   if (!checkFeatureValidity(theFeature))
 213     return false;
 214
 215   myStorage->blockEvents(true);
 216   myStorage->refresh(true);
 217   bool isUpdated = myStorage->update(theFeature);
 218
 219   updateMultiConstraints(myConstraints, theFeature);
 220   return isUpdated;
 221 }
 222
 223 void SketchSolver_Group::moveFeature(FeaturePtr theFeature)
 224 {
 225   BuilderPtr aBuilder = SketchSolver_Manager::instance()->builder();
 226
 227   // Firstly, revert changes in the fixed entities
 228   myStorage->blockEvents(true);
 229   myStorage->refresh(true);
 230
 231   // Then, create temporary Fixed constraint
 232   SolverConstraintPtr aConstraint = aBuilder->createMovementConstraint(theFeature);
 233   if (!aConstraint)
 234     return;
 235   aConstraint->process(myStorage, getId(), getWorkplaneId());
 236   if (aConstraint->error().empty())
 237     setTemporary(aConstraint);
 238
 239   // Secondly, search attributes of the feature in the list of the Multi constraints and update them
 240   updateMultiConstraints(myConstraints, theFeature);
 241 }
 242
 243 // ============================================================================
 244 //  Function: addWorkplane
 245 //  Class:    SketchSolver_Group
 246 //  Purpose:  create workplane for the group
 247 // ============================================================================
 248 bool SketchSolver_Group::addWorkplane(CompositeFeaturePtr theSketch)
 249 {
 250   if (myWorkplaneID != EID_UNKNOWN || theSketch->getKind() != SketchPlugin_Sketch::ID())
 251     return false;  // the workplane already exists or the function parameter is not Sketch
 252
 253   mySketch = theSketch;
 254   if (!updateWorkplane()) {
 255     mySketch = CompositeFeaturePtr();
 256     return false;
 257   }
 258   return true;
 259 }
 260
 261 // ============================================================================
 262 //  Function: updateWorkplane
 263 //  Class:    SketchSolver_Group
 264 //  Purpose:  update parameters of workplane
 265 // ============================================================================
 266 bool SketchSolver_Group::updateWorkplane()
 267 {
 268   BuilderPtr aBuilder = SketchSolver_Manager::instance()->builder();
 269   if (!myStorage) // Create storage if not exists
 270     myStorage = aBuilder->createStorage(getId());
 271
 272   // sketch should be unchanged, set it out of current group
 273   bool isUpdated = myStorage->update(FeaturePtr(mySketch), GID_OUTOFGROUP);
 274   if (isUpdated) {
 275     EntityWrapperPtr anEntity = myStorage->entity(FeaturePtr(mySketch));
 276     myWorkplaneID = anEntity->id();
 277   }
 278   return isUpdated;
 279 }
 280
 281 // ============================================================================
 282 //  Function: resolveConstraints
 283 //  Class:    SketchSolver_Group
 284 //  Purpose:  solve the set of constraints for the current group
 285 // ============================================================================
 286 bool SketchSolver_Group::resolveConstraints()
 287 {
 288   if (!myChangedConstraints.empty())
 289     updateConstraints();
 290
 291   bool aResolved = false;
 292   bool isGroupEmpty = isEmpty();
 293   if (myStorage->isNeedToResolve() && !isGroupEmpty) {
 294     if (!mySketchSolver)
 295       mySketchSolver = SketchSolver_Manager::instance()->builder()->createSolver();
 296
 297     mySketchSolver->setGroup(myID);
 298     mySketchSolver->calculateFailedConstraints(false);
 299     myStorage->initializeSolver(mySketchSolver);
 300     mySketchSolver->prepare();
 301
 302     SketchSolver_SolveStatus aResult = STATUS_OK;
 303     try {
 304       if (myStorage->hasDuplicatedConstraint())
 305         aResult = STATUS_INCONSISTENT;
 306       else {
 307         // To avoid overconstraint situation, we will remove temporary constraints one-by-one
 308         // and try to find the case without overconstraint
 309         bool isLastChance = false;
 310         while (true) {
 311           aResult = mySketchSolver->solve();
 312           if (aResult == STATUS_OK || aResult == STATUS_EMPTYSET || isLastChance)
 313             break;
 314           // try to update parameters and resolve once again
 315           ConstraintConstraintMap::iterator aConstrIt = myConstraints.begin();
 316           for (; aConstrIt != myConstraints.end(); ++aConstrIt)
 317             aConstrIt->second->update();
 318           isLastChance = true;
 319
 320           removeTemporaryConstraints();
 321           mySketchSolver->calculateFailedConstraints(true); // something failed => need to find it
 322           myStorage->initializeSolver(mySketchSolver);
 323         }
 324       }
 325     } catch (...) {
 326 //      Events_Error::send(SketchSolver_Error::SOLVESPACE_CRASH(), this);
 327       getWorkplane()->string(SketchPlugin_Sketch::SOLVER_ERROR())->setValue(SketchSolver_Error::SOLVESPACE_CRASH());
 328       if (myPrevSolved) {
 329         // the error message should be changed before sending the message
 330         sendMessage(EVENT_SOLVER_FAILED);
 331         myPrevSolved = false;
 332       }
 333       mySketchSolver->undo();
 334       return false;
 335     }
 336     if (aResult == STATUS_OK || aResult == STATUS_EMPTYSET) {  // solution succeeded, store results into correspondent attributes
 337       myStorage->refresh();
 338       if (!myPrevSolved) {
 339         getWorkplane()->string(SketchPlugin_Sketch::SOLVER_ERROR())->setValue("");
 340         // the error message should be changed before sending the message
 341         sendMessage(EVENT_SOLVER_REPAIRED);
 342         myPrevSolved = true;
 343       }
 344     } else {
 345       mySketchSolver->undo();
 346       if (!myConstraints.empty()) {
 347 //      Events_Error::send(SketchSolver_Error::CONSTRAINTS(), this);
 348         getWorkplane()->string(SketchPlugin_Sketch::SOLVER_ERROR())->setValue(SketchSolver_Error::CONSTRAINTS());
 349         if (myPrevSolved) {
 350           // the error message should be changed before sending the message
 351           sendMessage(EVENT_SOLVER_FAILED);
 352           myPrevSolved = false;
 353         }
 354       }
 355     }
 356
 357     aResolved = true;
 358   } else if (!isGroupEmpty) {
 359     // Check there are constraints Fixed. If they exist, update parameters by stored values
 360     ConstraintConstraintMap::iterator aCIt = myConstraints.begin();
 361     for (; aCIt != myConstraints.end(); ++aCIt)
 362       if (aCIt->first->getKind() == SketchPlugin_ConstraintRigid::ID()) {
 363         aResolved = true;
 364         break;
 365       }
 366     if (aCIt != myConstraints.end())
 367       myStorage->refresh();
 368   }
 369   removeTemporaryConstraints();
 370   myStorage->blockEvents(false);
 371   myStorage->setNeedToResolve(false);
 372   return aResolved;
 373 }
 374
 375 // ============================================================================
 376 //  Function: mergeGroups
 377 //  Class:    SketchSolver_Group
 378 //  Purpose:  append specified group to the current group
 379 // ============================================================================
 380 void SketchSolver_Group::mergeGroups(const SketchSolver_Group& theGroup)
 381 {
 382   // If specified group is empty, no need to merge
 383   if (theGroup.isEmpty())
 384     return;
 385
 386   std::set<ObjectPtr> aConstraints;
 387   ConstraintConstraintMap::const_iterator aConstrIter = theGroup.myConstraints.begin();
 388   for (; aConstrIter != theGroup.myConstraints.end(); aConstrIter++)
 389     aConstraints.insert(aConstrIter->first);
 390
 391   std::list<FeaturePtr> aSortedConstraints = selectApplicableFeatures(aConstraints);
 392   std::list<FeaturePtr>::iterator aSCIter = aSortedConstraints.begin();
 393   for (; aSCIter != aSortedConstraints.end(); ++aSCIter) {
 394     ConstraintPtr aConstr = std::dynamic_pointer_cast<SketchPlugin_Constraint>(*aSCIter);
 395     if (!aConstr)
 396       continue;
 397     changeConstraint(aConstr);
 398   }
 399 }
 400
 401 // ============================================================================
 402 //  Function: splitGroup
 403 //  Class:    SketchSolver_Group
 404 //  Purpose:  divide the group into several subgroups
 405 // ============================================================================
 406 void SketchSolver_Group::splitGroup(std::list<SketchSolver_Group*>& theCuts)
 407 {
 408   // New storage will be used in trimmed way to store the list of constraint interacted together.
 409   StoragePtr aNewStorage = SketchSolver_Manager::instance()->builder()->createStorage(getId());
 410   std::list<ConstraintWrapperPtr> aDummyVec; // empty vector to avoid creation of solver's constraints
 411
 412   // Obtain constraints, which should be separated
 413   std::list<ConstraintPtr> anUnusedConstraints;
 414   ConstraintConstraintMap::iterator aCIter = myConstraints.begin();
 415   for ( ; aCIter != myConstraints.end(); aCIter++) {
 416     if (aNewStorage->isInteract(FeaturePtr(aCIter->first)))
 417       aNewStorage->addConstraint(aCIter->first, aDummyVec);
 418     else
 419       anUnusedConstraints.push_back(aCIter->first);
 420   }
 421
 422   // Check the unused constraints once again, because they may become interacted with new storage since adding constraints
 423   std::list<ConstraintPtr>::iterator aUnuseIt = anUnusedConstraints.begin();
 424   while (aUnuseIt != anUnusedConstraints.end()) {
 425     if (aNewStorage->isInteract(FeaturePtr(*aUnuseIt))) {
 426       aNewStorage->addConstraint(*aUnuseIt, aDummyVec);
 427       anUnusedConstraints.erase(aUnuseIt);
 428       aUnuseIt = anUnusedConstraints.begin();
 429       continue;
 430     }
 431     aUnuseIt++;
 432   }
 433
 434   std::list<SketchSolver_Group*>::iterator aCutsIter;
 435   aUnuseIt = anUnusedConstraints.begin();
 436   for ( ; aUnuseIt != anUnusedConstraints.end(); ++aUnuseIt) {
 437     // Remove unused constraints
 438     removeConstraint(*aUnuseIt);
 439     // Try to append constraint to already existent group
 440     for (aCutsIter = theCuts.begin(); aCutsIter != theCuts.end(); ++aCutsIter)
 441       if ((*aCutsIter)->isInteract(*aUnuseIt)) {
 442         (*aCutsIter)->changeConstraint(*aUnuseIt);
 443         break;
 444       }
 445     if (aCutsIter == theCuts.end()) {
 446       // Add new group
 447       SketchSolver_Group* aGroup = new SketchSolver_Group(mySketch);
 448       aGroup->changeConstraint(*aUnuseIt);
 449       theCuts.push_back(aGroup);
 450     } else {
 451       // Find other groups interacting with constraint
 452       std::list<SketchSolver_Group*>::iterator aBaseGroupIt = aCutsIter;
 453       for (++aCutsIter; aCutsIter != theCuts.end(); ++aCutsIter)
 454         if ((*aCutsIter)->isInteract(*aUnuseIt)) {
 455           (*aBaseGroupIt)->mergeGroups(**aCutsIter);
 456           std::list<SketchSolver_Group*>::iterator aRemoveIt = aCutsIter--;
 457           theCuts.erase(aRemoveIt);
 458         }
 459     }
 460   }
 461 }
 462
 463 // ============================================================================
 464 //  Function: isConsistent
 465 //  Class:    SketchSolver_Group
 466 //  Purpose:  search removed entities and constraints
 467 // ============================================================================
 468 bool SketchSolver_Group::isConsistent()
 469 {
 470   if (isEmpty()) // no one constraint is initialized yet
 471     return true;
 472
 473   // Check the features and constraint is the storage are valid
 474   bool aResult = myStorage->isConsistent();
 475   if (aResult) {
 476     // additional check of consistency of the Fixed constraint,
 477     // because they are not added to the storage
 478     ConstraintConstraintMap::iterator aCIter = myConstraints.begin();
 479     for (; aCIter != myConstraints.end(); ++aCIter)
 480       if (aCIter->first->getKind() == SketchPlugin_ConstraintRigid::ID() &&
 481          (!aCIter->first->data() || !aCIter->first->data()->isValid())) {
 482         aResult = false;
 483         break;
 484       }
 485   }
 486   if (!aResult) {
 487     // remove invalid constraints
 488     std::set<ConstraintPtr> anInvalidConstraints;
 489     ConstraintConstraintMap::iterator aCIter = myConstraints.begin();
 490     for (; aCIter != myConstraints.end(); ++aCIter) {
 491       if (!aCIter->first->data() || !aCIter->first->data()->isValid())
 492         anInvalidConstraints.insert(aCIter->first);
 493     }
 494     std::set<ConstraintPtr>::const_iterator aRemoveIt = anInvalidConstraints.begin();
 495     for (; aRemoveIt != anInvalidConstraints.end(); ++aRemoveIt)
 496       removeConstraint(*aRemoveIt);
 497     // remove invalid features
 498     myStorage->removeInvalidEntities();
 499   }
 500   return aResult;
 501 }
 502
 503 // ============================================================================
 504 //  Function: removeTemporaryConstraints
 505 //  Class:    SketchSolver_Group
 506 //  Purpose:  remove all transient SLVS_C_WHERE_DRAGGED constraints after
 507 //            resolving the set of constraints
 508 // ============================================================================
 509 void SketchSolver_Group::removeTemporaryConstraints()
 510 {
 511   std::set<SolverConstraintPtr>::iterator aTmpIt = myTempConstraints.begin();
 512   for (; aTmpIt != myTempConstraints.end(); ++aTmpIt)
 513     (*aTmpIt)->remove();
 514
 515   if (!myTempConstraints.empty())
 516     myStorage->verifyFixed();
 517   myStorage->setNeedToResolve(false);
 518   myTempConstraints.clear();
 519 }
 520
 521 // ============================================================================
 522 //  Function: removeConstraint
 523 //  Class:    SketchSolver_Group
 524 //  Purpose:  remove constraint and all unused entities
 525 // ============================================================================
 526 void SketchSolver_Group::removeConstraint(ConstraintPtr theConstraint)
 527 {
 528   bool isFullyRemoved = true;
 529   ConstraintConstraintMap::iterator aCIter = myConstraints.begin();
 530   for (; aCIter != myConstraints.end(); aCIter++)
 531     if (aCIter->first == theConstraint) {
 532       aCIter->second->remove(); // the constraint is not fully removed
 533       break;
 534     }
 535   if (aCIter != myConstraints.end())
 536     myConstraints.erase(aCIter);
 537 }
 538
 539 // ============================================================================
 540 //  Function: isComplexConstraint
 541 //  Class:    SketchSolver_Group
 542 //  Purpose:  verifies the constraint is complex, i.e. it needs another constraints to be created before
 543 // ============================================================================
 544 bool SketchSolver_Group::isComplexConstraint(FeaturePtr theConstraint)
 545 {
 546   return theConstraint->getKind() == SketchPlugin_ConstraintFillet::ID() ||
 547          theConstraint->getKind() == SketchPlugin_ConstraintMirror::ID() ||
 548          theConstraint->getKind() == SketchPlugin_ConstraintTangent::ID();
 549 }
 550
 551 // ============================================================================
 552 //  Function: setTemporary
 553 //  Class:    SketchSolver_Group
 554 //  Purpose:  append given constraint to the group of temporary constraints
 555 // ============================================================================
 556 void SketchSolver_Group::setTemporary(SolverConstraintPtr theConstraint)
 557 {
 558   myTempConstraints.insert(theConstraint);
 559 }
 560
 561
 562 // ============================================================================
 563 //  Function: checkFeatureValidity
 564 //  Class:    SketchSolver_Group
 565 //  Purpose:  verifies is the feature valid
 566 // ============================================================================
 567 bool SketchSolver_Group::checkFeatureValidity(FeaturePtr theFeature)
 568 {
 569   if (!theFeature || !theFeature->data()->isValid())
 570     return true;
 571
 572   SessionPtr aMgr = ModelAPI_Session::get();
 573   ModelAPI_ValidatorsFactory* aFactory = aMgr->validators();
 574   return aFactory->validate(theFeature);
 575 }
 576
 577
 578
 579
 580 // ===========   Auxiliary functions   ========================================
 581 static double featureToVal(FeaturePtr theFeature)
 582 {
 583   if (theFeature->getKind() == SketchPlugin_Sketch::ID())
 584     return 0.0; // sketch
 585   ConstraintPtr aConstraint = std::dynamic_pointer_cast<SketchPlugin_Constraint>(theFeature);
 586   if (!aConstraint)
 587     return 1.0; // features (arc, circle, line, point)
 588
 589   const std::string& anID = aConstraint->getKind();
 590   if (anID == SketchPlugin_ConstraintCoincidence::ID()) {
 591     AttributeRefAttrPtr anAttrA = std::dynamic_pointer_cast<ModelAPI_AttributeRefAttr>(
 592         aConstraint->attribute(SketchPlugin_Constraint::ENTITY_A()));
 593     AttributeRefAttrPtr anAttrB = std::dynamic_pointer_cast<ModelAPI_AttributeRefAttr>(
 594         aConstraint->attribute(SketchPlugin_Constraint::ENTITY_B()));
 595     if (anAttrA && anAttrB && (anAttrA->isObject() || anAttrB->isObject()))
 596       return 2.0; // point-on-line and point-on-circle should go before points coincidence constraint
 597     return 2.5;
 598   }
 599   if (anID == SketchPlugin_ConstraintDistance::ID() ||
 600       anID == SketchPlugin_ConstraintLength::ID() ||
 601       anID == SketchPlugin_ConstraintRadius::ID())
 602     return 3.0;
 603   if (anID == SketchPlugin_ConstraintAngle::ID())
 604     return 3.5;
 605   if (anID == SketchPlugin_ConstraintHorizontal::ID() ||
 606       anID == SketchPlugin_ConstraintVertical::ID() ||
 607       anID == SketchPlugin_ConstraintParallel::ID() ||
 608       anID == SketchPlugin_ConstraintPerpendicular::ID())
 609     return 4.0;
 610   if (anID == SketchPlugin_ConstraintEqual::ID())
 611     return 5.0;
 612   if (anID == SketchPlugin_ConstraintTangent::ID() ||
 613       anID == SketchPlugin_ConstraintMirror::ID())
 614     return 6.0;
 615   if (anID == SketchPlugin_ConstraintRigid::ID())
 616     return 7.0;
 617   if (anID == SketchPlugin_MultiRotation::ID() ||
 618       anID == SketchPlugin_MultiTranslation::ID())
 619     return 8.0;
 620
 621   // all other constraints are placed between Equal and Tangent constraints
 622   return 5.5;
 623 }
 624
 625 static bool isLess(FeaturePtr theFeature1, FeaturePtr theFeature2)
 626 {
 627   return featureToVal(theFeature1) < featureToVal(theFeature2);
 628 }
 629
 630 std::list<FeaturePtr> SketchSolver_Group::selectApplicableFeatures(const std::set<ObjectPtr>& theObjects)
 631 {
 632   std::list<FeaturePtr> aResult;
 633   std::list<FeaturePtr>::iterator aResIt;
 634
 635   std::set<ObjectPtr>::const_iterator anObjIter = theObjects.begin();
 636   for (; anObjIter != theObjects.end(); ++anObjIter) {
 637     // Operate sketch itself and SketchPlugin features only.
 638     // Also, the Fillet need to be skipped, because there are several separated constraints composing it.
 639     FeaturePtr aFeature = std::dynamic_pointer_cast<ModelAPI_Feature>(*anObjIter);
 640     if (!aFeature)
 641       continue;
 642     std::shared_ptr<SketchPlugin_Feature> aSketchFeature =
 643         std::dynamic_pointer_cast<SketchPlugin_Feature>(aFeature);
 644     if ((aFeature->getKind() != SketchPlugin_Sketch::ID() && !aSketchFeature) ||
 645         aFeature->getKind() == SketchPlugin_ConstraintFillet::ID())
 646       continue;
 647
 648     // Find the place where to insert a feature
 649     for (aResIt = aResult.begin(); aResIt != aResult.end(); ++aResIt)
 650       if (isLess(aFeature, *aResIt))
 651         break;
 652     aResult.insert(aResIt, aFeature);
 653   }
 654
 655   return aResult;
 656 }
 657