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