src/SketchPlugin/SketchPlugin_ConstraintDistance.cpp

   1 // File:    SketchPlugin_ConstraintDistance.cpp
   2 // Created: 23 May 2014
   3 // Author:  Artem ZHIDKOV
   4
   5 #include "SketchPlugin_ConstraintDistance.h"
   6 #include <SketchPlugin_Point.h>
   7 #include <SketchPlugin_Circle.h>
   8 #include <SketchPlugin_Line.h>
   9
  10 #include <GeomAPI_Lin2d.h>
  11 #include <GeomAPI_Pnt2d.h>
  12 #include <GeomDataAPI_Point2D.h>
  13
  14 #include <ModelAPI_AttributeDouble.h>
  15 #include <ModelAPI_Data.h>
  16
  17 #include <Config_PropManager.h>
  18
  19 SketchPlugin_ConstraintDistance::SketchPlugin_ConstraintDistance()
  20 {
  21 }
  22
  23 //*************************************************************************************
  24 void SketchPlugin_ConstraintDistance::initAttributes()
  25 {
  26   data()->addAttribute(SketchPlugin_Constraint::VALUE(), ModelAPI_AttributeDouble::type());
  27   data()->addAttribute(SketchPlugin_Constraint::FLYOUT_VALUE_PNT(), GeomDataAPI_Point2D::type());
  28   data()->addAttribute(SketchPlugin_Constraint::ENTITY_A(), ModelAPI_AttributeRefAttr::type());
  29   data()->addAttribute(SketchPlugin_Constraint::ENTITY_B(), ModelAPI_AttributeRefAttr::type());
  30 }
  31
  32 //*************************************************************************************
  33 void SketchPlugin_ConstraintDistance::execute()
  34 {
  35   boost::shared_ptr<ModelAPI_Data> aData = data();
  36   AttributeDoublePtr anAttr_Value = boost::dynamic_pointer_cast<ModelAPI_AttributeDouble>(
  37       aData->attribute(SketchPlugin_Constraint::VALUE()));
  38
  39   boost::shared_ptr<GeomDataAPI_Point2D> aPoint_A = getFeaturePoint(
  40       aData, SketchPlugin_Constraint::ENTITY_A());
  41   boost::shared_ptr<GeomDataAPI_Point2D> aPoint_B = getFeaturePoint(
  42       aData, SketchPlugin_Constraint::ENTITY_B());
  43
  44   if (aPoint_A && aPoint_B) {  // both points
  45     anAttr_Value->setValue(aPoint_A->pnt()->distance(aPoint_B->pnt()));
  46   } else {
  47     if (!aPoint_A && aPoint_B) {  //Line and point
  48       boost::shared_ptr<SketchPlugin_Line> aLine = getFeatureLine(
  49           aData, SketchPlugin_Constraint::ENTITY_A());
  50       if (aLine)
  51         anAttr_Value->setValue(aLine->distanceToPoint(aPoint_B->pnt()));
  52     } else if (aPoint_A && !aPoint_B) {  // Point and line
  53       boost::shared_ptr<SketchPlugin_Line> aLine = getFeatureLine(
  54           aData, SketchPlugin_Constraint::ENTITY_B());
  55       if (aLine)
  56         anAttr_Value->setValue(aLine->distanceToPoint(aPoint_A->pnt()));
  57     }
  58   }
  59 }
  60
  61 //*************************************************************************************
  62 AISObjectPtr SketchPlugin_ConstraintDistance::getAISObject(AISObjectPtr thePrevious)
  63 {
  64   if (!sketch())
  65     return thePrevious;
  66
  67   boost::shared_ptr<GeomAPI_Pln> aPlane = sketch()->plane();
  68
  69   DataPtr aData = data();
  70   boost::shared_ptr<GeomDataAPI_Point2D> aPoint_A = getFeaturePoint(
  71       aData, SketchPlugin_Constraint::ENTITY_A());
  72   boost::shared_ptr<GeomDataAPI_Point2D> aPoint_B = getFeaturePoint(
  73       aData, SketchPlugin_Constraint::ENTITY_B());
  74
  75   boost::shared_ptr<GeomAPI_Pnt2d> aPnt_A;
  76   boost::shared_ptr<GeomAPI_Pnt2d> aPnt_B;
  77
  78   if (aPoint_A && aPoint_B) {
  79     aPnt_A = aPoint_A->pnt();
  80     aPnt_B = aPoint_B->pnt();
  81   } else if (!aPoint_A && aPoint_B) {
  82     boost::shared_ptr<SketchPlugin_Line> aLine = getFeatureLine(
  83         aData, SketchPlugin_Constraint::ENTITY_A());
  84     if (aLine) {
  85       aPnt_B = aPoint_B->pnt();
  86       aPnt_A = getProjectionPoint(aLine, aPnt_B);
  87     }
  88   } else if (aPoint_A && !aPoint_B) {
  89     boost::shared_ptr<SketchPlugin_Line> aLine = getFeatureLine(
  90         aData, SketchPlugin_Constraint::ENTITY_B());
  91     if (aLine) {
  92       aPnt_A = aPoint_A->pnt();
  93       aPnt_B = getProjectionPoint(aLine, aPnt_A);
  94     }
  95   }
  96   if (!aPnt_A || !aPnt_B)
  97     return thePrevious;
  98
  99   boost::shared_ptr<GeomDataAPI_Point2D> aFlyOutAttr = boost::dynamic_pointer_cast<
 100       GeomDataAPI_Point2D>(aData->attribute(SketchPlugin_Constraint::FLYOUT_VALUE_PNT()));
 101
 102   boost::shared_ptr<GeomAPI_Pnt> aPoint1 = sketch()->to3D(aPnt_A->x(), aPnt_A->y());
 103   boost::shared_ptr<GeomAPI_Pnt> aPoint2 = sketch()->to3D(aPnt_B->x(), aPnt_B->y());
 104   boost::shared_ptr<GeomAPI_Pnt> aFlyoutPnt =
 105       aFlyOutAttr->isInitialized() ?
 106           sketch()->to3D(aFlyOutAttr->x(), aFlyOutAttr->y()) : boost::shared_ptr<GeomAPI_Pnt>();
 107
 108   // value calculation
 109   boost::shared_ptr<ModelAPI_AttributeDouble> aValueAttr = boost::dynamic_pointer_cast<
 110       ModelAPI_AttributeDouble>(aData->attribute(SketchPlugin_Constraint::VALUE()));
 111   double aValue = aValueAttr->value();
 112
 113   AISObjectPtr anAIS = thePrevious;
 114   if (!anAIS)
 115     anAIS = AISObjectPtr(new GeomAPI_AISObject);
 116   anAIS->createDistance(aPoint1, aPoint2, aFlyoutPnt, aPlane, aValue);
 117
 118   // Set color from preferences
 119   std::vector<int> aRGB = Config_PropManager::color("Visualization", "distance_color",
 120                                                     DISTANCE_COLOR);
 121   anAIS->setColor(aRGB[0], aRGB[1], aRGB[2]);
 122   return anAIS;
 123 }
 124
 125 //*************************************************************************************
 126 void SketchPlugin_ConstraintDistance::move(double theDeltaX, double theDeltaY)
 127 {
 128   boost::shared_ptr<ModelAPI_Data> aData = data();
 129   if (!aData->isValid())
 130     return;
 131
 132   boost::shared_ptr<GeomDataAPI_Point2D> aPoint1 = boost::dynamic_pointer_cast<GeomDataAPI_Point2D>(
 133       aData->attribute(SketchPlugin_Constraint::FLYOUT_VALUE_PNT()));
 134   aPoint1->setValue(aPoint1->x() + theDeltaX, aPoint1->y() + theDeltaY);
 135 }
 136
 137 //*************************************************************************************
 138 boost::shared_ptr<GeomDataAPI_Point2D> getFeaturePoint(DataPtr theData,
 139                                                        const std::string& theAttribute)
 140 {
 141   boost::shared_ptr<GeomDataAPI_Point2D> aPointAttr;
 142
 143   if (!theData)
 144     return aPointAttr;
 145
 146   FeaturePtr aFeature;
 147   boost::shared_ptr<ModelAPI_AttributeRefAttr> anAttr = boost::dynamic_pointer_cast<
 148       ModelAPI_AttributeRefAttr>(theData->attribute(theAttribute));
 149   if (anAttr)
 150     aFeature = ModelAPI_Feature::feature(anAttr->object());
 151
 152   if (aFeature && aFeature->getKind() == SketchPlugin_Point::ID())
 153     aPointAttr = boost::dynamic_pointer_cast<GeomDataAPI_Point2D>(
 154         aFeature->data()->attribute(SketchPlugin_Point::COORD_ID()));
 155   else if (aFeature && aFeature->getKind() == SketchPlugin_Circle::ID())
 156     aPointAttr = boost::dynamic_pointer_cast<GeomDataAPI_Point2D>(
 157         aFeature->data()->attribute(SketchPlugin_Circle::CENTER_ID()));
 158   else if (anAttr->attr()) {
 159     aPointAttr = boost::dynamic_pointer_cast<GeomDataAPI_Point2D>(anAttr->attr());
 160   }
 161   return aPointAttr;
 162 }
 163
 164 //*************************************************************************************
 165 boost::shared_ptr<SketchPlugin_Line> getFeatureLine(DataPtr theData,
 166                                                     const std::string& theAttribute)
 167 {
 168   boost::shared_ptr<SketchPlugin_Line> aLine;
 169   if (!theData)
 170     return aLine;
 171
 172   boost::shared_ptr<ModelAPI_AttributeRefAttr> anAttr = boost::dynamic_pointer_cast<
 173       ModelAPI_AttributeRefAttr>(theData->attribute(theAttribute));
 174   if (anAttr) {
 175     FeaturePtr aFeature = ModelAPI_Feature::feature(anAttr->object());
 176     if (aFeature && aFeature->getKind() == SketchPlugin_Line::ID()) {
 177       aLine = boost::dynamic_pointer_cast<SketchPlugin_Line>(aFeature);
 178     }
 179   }
 180   return aLine;
 181 }
 182
 183 //*************************************************************************************
 184 boost::shared_ptr<GeomAPI_Pnt2d> getProjectionPoint(
 185     const boost::shared_ptr<SketchPlugin_Line>& theLine,
 186     const boost::shared_ptr<GeomAPI_Pnt2d>& thePoint)
 187 {
 188   boost::shared_ptr<ModelAPI_Data> aData = theLine->data();
 189   boost::shared_ptr<GeomDataAPI_Point2D> aPoint1 = boost::dynamic_pointer_cast<GeomDataAPI_Point2D>(
 190       aData->attribute(SketchPlugin_Line::START_ID()));
 191   boost::shared_ptr<GeomDataAPI_Point2D> aPoint2 = boost::dynamic_pointer_cast<GeomDataAPI_Point2D>(
 192       aData->attribute(SketchPlugin_Line::END_ID()));
 193
 194   GeomAPI_Lin2d aLin2d(aPoint1->x(), aPoint1->y(), aPoint2->x(), aPoint2->y());
 195   return aLin2d.project(thePoint);
 196 }