src/SketchSolver/SketchSolver_ConstraintDistance.cpp

   1 #include <SketchSolver_ConstraintDistance.h>
   2 #include <SketchSolver_Group.h>
   3 #include <SketchSolver_Error.h>
   4
   5 #include <GeomAPI_XY.h>
   6
   7
   8 void SketchSolver_ConstraintDistance::process()
   9 {
  10   cleanErrorMsg();
  11   if (!myBaseConstraint || !myStorage || myGroup == 0) {
  12     /// TODO: Put error message here
  13     return;
  14   }
  15   if (!mySlvsConstraints.empty()) // some data is changed, update constraint
  16     update(myBaseConstraint);
  17
  18   double aValue;
  19   std::vector<Slvs_hEntity> anEntities;
  20   getAttributes(aValue, anEntities);
  21   if (!myErrorMsg.empty())
  22     return;
  23
  24   // Obtain entities to identify the type of distance
  25   static const int aNbPoints = 2;
  26   Slvs_hEntity aPoint[aNbPoints] = {SLVS_E_UNKNOWN, SLVS_E_UNKNOWN};
  27   Slvs_hEntity aLine = SLVS_E_UNKNOWN;
  28   myType = SLVS_C_PT_PT_DISTANCE;
  29   int aPtPos = 0;
  30   std::vector<Slvs_hEntity>::iterator anEntIter = anEntities.begin();
  31   for (; anEntIter != anEntities.end(); anEntIter++) {
  32     if (*anEntIter == SLVS_E_UNKNOWN)
  33       continue;
  34     Slvs_Entity anEnt = myStorage->getEntity(*anEntIter);
  35     if (anEnt.type == SLVS_E_POINT_IN_2D || anEnt.type == SLVS_E_POINT_IN_3D) {
  36       if (aPtPos >= aNbPoints) {
  37         myErrorMsg = SketchSolver_Error::INCORRECT_ATTRIBUTE();
  38         return;
  39       }
  40       aPoint[aPtPos++] = *anEntIter;
  41     }
  42     else if (anEnt.type == SLVS_E_LINE_SEGMENT) {
  43       if (myType == SLVS_C_PT_LINE_DISTANCE) {
  44         myErrorMsg = SketchSolver_Error::INCORRECT_ATTRIBUTE();
  45         return;
  46       }
  47       aLine = *anEntIter;
  48       myType = SLVS_C_PT_LINE_DISTANCE;
  49     }
  50   }
  51
  52   Slvs_Constraint aConstraint = Slvs_MakeConstraint(SLVS_C_UNKNOWN, myGroup->getId(),
  53       getType(), myGroup->getWorkplaneId(), aValue, aPoint[0], aPoint[1], aLine, SLVS_E_UNKNOWN);
  54   aConstraint.h = myStorage->addConstraint(aConstraint);
  55   mySlvsConstraints.push_back(aConstraint.h);
  56
  57   // Adjust point-line distance
  58   if (getType() != SLVS_C_PT_LINE_DISTANCE)
  59     return;
  60
  61   // Get constraint parameters and check the sign of constraint value
  62   std::vector<Slvs_hConstraint>::iterator aCIter = mySlvsConstraints.begin();
  63   for (; aCIter != mySlvsConstraints.end(); aCIter++) {
  64     Slvs_Constraint aConstraint = myStorage->getConstraint(*aCIter);
  65     Slvs_Entity aLine = myStorage->getEntity(aConstraint.entityA);
  66     // Obtain point and line coordinates
  67     Slvs_hEntity aPointID[3] = {aConstraint.ptA, aLine.point[0], aLine.point[1]};
  68     std::shared_ptr<GeomAPI_XY> aPoints[3];
  69     for (int i = 0; i < 3; i++) {
  70       Slvs_Entity aPoint = myStorage->getEntity(aPointID[i]);
  71       Slvs_Param aParams[2] = {
  72           myStorage->getParameter(aPoint.param[0]),
  73           myStorage->getParameter(aPoint.param[1])};
  74       aPoints[i] = std::shared_ptr<GeomAPI_XY>(new GeomAPI_XY(aParams[0].val, aParams[1].val));
  75     }
  76     std::shared_ptr<GeomAPI_XY> aLineVec = aPoints[2]->decreased(aPoints[1]);
  77     std::shared_ptr<GeomAPI_XY> aPtLineVec = aPoints[0]->decreased(aPoints[1]);
  78     if (aPtLineVec->cross(aLineVec) * aConstraint.valA < 0.0) {
  79       aConstraint.valA *= -1.0;
  80       myStorage->updateConstraint(aConstraint);
  81     }
  82   }
  83 }