1 // Copyright (C) 2014-20xx CEA/DEN, EDF R&D -->
3 // File: SketchPlugin_ConstraintDistance.cpp
4 // Created: 23 May 2014
5 // Author: Artem ZHIDKOV
7 #include "SketchPlugin_ConstraintDistance.h"
8 #include <SketchPlugin_Point.h>
9 #include <SketchPlugin_Circle.h>
10 #include <SketchPlugin_Line.h>
12 #include <GeomAPI_Lin2d.h>
13 #include <GeomAPI_Pnt2d.h>
14 #include <GeomDataAPI_Point2D.h>
16 #include <ModelAPI_AttributeDouble.h>
17 #include <ModelAPI_Data.h>
19 #include <Config_PropManager.h>
21 SketchPlugin_ConstraintDistance::SketchPlugin_ConstraintDistance()
25 //*************************************************************************************
26 void SketchPlugin_ConstraintDistance::initAttributes()
28 data()->addAttribute(SketchPlugin_Constraint::VALUE(), ModelAPI_AttributeDouble::type());
29 data()->addAttribute(SketchPlugin_Constraint::FLYOUT_VALUE_PNT(), GeomDataAPI_Point2D::type());
30 data()->addAttribute(SketchPlugin_Constraint::ENTITY_A(), ModelAPI_AttributeRefAttr::type());
31 data()->addAttribute(SketchPlugin_Constraint::ENTITY_B(), ModelAPI_AttributeRefAttr::type());
34 //*************************************************************************************
35 void SketchPlugin_ConstraintDistance::execute()
37 std::shared_ptr<ModelAPI_Data> aData = data();
38 AttributeDoublePtr anAttrValue = std::dynamic_pointer_cast<ModelAPI_AttributeDouble>(
39 aData->attribute(SketchPlugin_Constraint::VALUE()));
41 if(anAttrValue->isInitialized())
44 double aDistance = calculateCurrentDistance();
46 anAttrValue->setValue(aDistance);
50 bool SketchPlugin_ConstraintDistance::compute(const std::string& theAttributeId)
52 if (theAttributeId != SketchPlugin_Constraint::FLYOUT_VALUE_PNT())
58 DataPtr aData = data();
59 std::shared_ptr<GeomDataAPI_Point2D> aPoint_A = getFeaturePoint(
60 aData, SketchPlugin_Constraint::ENTITY_A());
61 std::shared_ptr<GeomDataAPI_Point2D> aPoint_B = getFeaturePoint(
62 aData, SketchPlugin_Constraint::ENTITY_B());
64 std::shared_ptr<GeomAPI_Pnt2d> aPnt_A;
65 std::shared_ptr<GeomAPI_Pnt2d> aPnt_B;
67 if (aPoint_A && aPoint_B) {
68 aPnt_A = aPoint_A->pnt();
69 aPnt_B = aPoint_B->pnt();
70 } else if (!aPoint_A && aPoint_B) {
71 std::shared_ptr<SketchPlugin_Line> aLine = getFeatureLine(
72 aData, SketchPlugin_Constraint::ENTITY_A());
74 aPnt_B = aPoint_B->pnt();
75 aPnt_A = getProjectionPoint(aLine, aPnt_B);
77 } else if (aPoint_A && !aPoint_B) {
78 std::shared_ptr<SketchPlugin_Line> aLine = getFeatureLine(
79 aData, SketchPlugin_Constraint::ENTITY_B());
81 aPnt_A = aPoint_A->pnt();
82 aPnt_B = getProjectionPoint(aLine, aPnt_A);
85 if (!aPnt_A || !aPnt_B)
88 std::shared_ptr<GeomDataAPI_Point2D> aFlyOutAttr = std::dynamic_pointer_cast<
89 GeomDataAPI_Point2D>(aData->attribute(theAttributeId));
91 std::shared_ptr<GeomAPI_Pnt> aPoint1 = sketch()->to3D(aPnt_A->x(), aPnt_A->y());
92 std::shared_ptr<GeomAPI_Pnt> aPoint2 = sketch()->to3D(aPnt_B->x(), aPnt_B->y());
93 std::shared_ptr<GeomAPI_Lin2d> aLine = std::shared_ptr<GeomAPI_Lin2d>(new GeomAPI_Lin2d(aPnt_A, aPnt_B));
94 double aDist = aPoint1->distance(aPoint2)/5.;
95 std::shared_ptr<GeomAPI_Pnt2d> aFPnt = aLine->shiftedLocation(aDist);
96 aFlyOutAttr->setValue(aFPnt);
101 //*************************************************************************************
102 AISObjectPtr SketchPlugin_ConstraintDistance::getAISObject(AISObjectPtr thePrevious)
107 std::shared_ptr<GeomAPI_Pln> aPlane = sketch()->plane();
109 DataPtr aData = data();
110 std::shared_ptr<GeomDataAPI_Point2D> aPoint_A = getFeaturePoint(
111 aData, SketchPlugin_Constraint::ENTITY_A());
112 std::shared_ptr<GeomDataAPI_Point2D> aPoint_B = getFeaturePoint(
113 aData, SketchPlugin_Constraint::ENTITY_B());
115 std::shared_ptr<GeomAPI_Pnt2d> aPnt_A;
116 std::shared_ptr<GeomAPI_Pnt2d> aPnt_B;
118 if (aPoint_A && aPoint_B) {
119 aPnt_A = aPoint_A->pnt();
120 aPnt_B = aPoint_B->pnt();
121 } else if (!aPoint_A && aPoint_B) {
122 std::shared_ptr<SketchPlugin_Line> aLine = getFeatureLine(
123 aData, SketchPlugin_Constraint::ENTITY_A());
125 aPnt_B = aPoint_B->pnt();
126 aPnt_A = getProjectionPoint(aLine, aPnt_B);
128 } else if (aPoint_A && !aPoint_B) {
129 std::shared_ptr<SketchPlugin_Line> aLine = getFeatureLine(
130 aData, SketchPlugin_Constraint::ENTITY_B());
132 aPnt_A = aPoint_A->pnt();
133 aPnt_B = getProjectionPoint(aLine, aPnt_A);
136 if (!aPnt_A || !aPnt_B)
137 return AISObjectPtr();
139 std::shared_ptr<GeomDataAPI_Point2D> aFlyOutAttr = std::dynamic_pointer_cast<
140 GeomDataAPI_Point2D>(aData->attribute(SketchPlugin_Constraint::FLYOUT_VALUE_PNT()));
142 std::shared_ptr<GeomAPI_Pnt> aPoint1 = sketch()->to3D(aPnt_A->x(), aPnt_A->y());
143 std::shared_ptr<GeomAPI_Pnt> aPoint2 = sketch()->to3D(aPnt_B->x(), aPnt_B->y());
144 if(!aFlyOutAttr->isInitialized())
145 compute(SketchPlugin_Constraint::FLYOUT_VALUE_PNT());
146 std::shared_ptr<GeomAPI_Pnt> aFlyoutPnt = sketch()->to3D(aFlyOutAttr->x(), aFlyOutAttr->y()/*aFPnt->x(), aFPnt->y()*/);
149 std::shared_ptr<ModelAPI_AttributeDouble> aValueAttr = std::dynamic_pointer_cast<
150 ModelAPI_AttributeDouble>(aData->attribute(SketchPlugin_Constraint::VALUE()));
152 // Issue #196: checking the positivity of the distance constraint
153 // there is a validator for a distance constraint, that the value should be positive
154 // in case if an invalid value is set, the current distance value is shown
155 if (aValueAttr->isInitialized())
156 aValue = aValueAttr->value();
158 AISObjectPtr anAIS = thePrevious;
160 anAIS = AISObjectPtr(new GeomAPI_AISObject);
161 anAIS->createDistance(aPoint1, aPoint2, aFlyoutPnt, aPlane, aValue);
163 // Set color from preferences
164 std::vector<int> aRGB = Config_PropManager::color("Visualization", "distance_color",
166 anAIS->setColor(aRGB[0], aRGB[1], aRGB[2]);
170 //*************************************************************************************
171 void SketchPlugin_ConstraintDistance::move(double theDeltaX, double theDeltaY)
173 std::shared_ptr<ModelAPI_Data> aData = data();
174 if (!aData->isValid())
177 std::shared_ptr<GeomDataAPI_Point2D> aPoint = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
178 aData->attribute(SketchPlugin_Constraint::FLYOUT_VALUE_PNT()));
179 aPoint->move(theDeltaX, theDeltaY);
182 double SketchPlugin_ConstraintDistance::calculateCurrentDistance() const
184 double aDistance = -1.;
186 std::shared_ptr<ModelAPI_Data> aData = data();
187 std::shared_ptr<GeomDataAPI_Point2D> aPointA =
188 getFeaturePoint(aData, SketchPlugin_Constraint::ENTITY_A());
189 std::shared_ptr<GeomDataAPI_Point2D> aPointB =
190 getFeaturePoint(aData, SketchPlugin_Constraint::ENTITY_B());
192 if (aPointA && aPointB) { // both points
193 aDistance = aPointA->pnt()->distance(aPointB->pnt());
195 if (!aPointA && aPointB) { //Line and point
196 std::shared_ptr<SketchPlugin_Line> aLine =
197 getFeatureLine(aData, SketchPlugin_Constraint::ENTITY_A());
199 aDistance = aLine->distanceToPoint(aPointB->pnt());
201 } else if (aPointA && !aPointB) { // Point and line
202 std::shared_ptr<SketchPlugin_Line> aLine =
203 getFeatureLine(aData, SketchPlugin_Constraint::ENTITY_B());
205 aDistance = aLine->distanceToPoint(aPointA->pnt());
212 void SketchPlugin_ConstraintDistance::attributeChanged(const std::string& theID) {
213 if (theID == SketchPlugin_Constraint::ENTITY_A() ||
214 theID == SketchPlugin_Constraint::ENTITY_B())
216 std::shared_ptr<ModelAPI_AttributeDouble> aValueAttr = std::dynamic_pointer_cast<
217 ModelAPI_AttributeDouble>(data()->attribute(SketchPlugin_Constraint::VALUE()));
218 if (!aValueAttr->isInitialized()) { // only if it is not initialized, try to compute the current value
219 double aDistance = calculateCurrentDistance();
220 if (aDistance > 0) { // set as value the length of updated references
221 aValueAttr->setValue(aDistance);
227 //*************************************************************************************
228 std::shared_ptr<GeomDataAPI_Point2D> getFeaturePoint(DataPtr theData,
229 const std::string& theAttribute)
231 std::shared_ptr<GeomDataAPI_Point2D> aPointAttr;
237 std::shared_ptr<ModelAPI_AttributeRefAttr> anAttr = std::dynamic_pointer_cast<
238 ModelAPI_AttributeRefAttr>(theData->attribute(theAttribute));
240 aFeature = ModelAPI_Feature::feature(anAttr->object());
242 if (aFeature && aFeature->getKind() == SketchPlugin_Point::ID())
243 aPointAttr = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
244 aFeature->data()->attribute(SketchPlugin_Point::COORD_ID()));
245 else if (aFeature && aFeature->getKind() == SketchPlugin_Circle::ID())
246 aPointAttr = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
247 aFeature->data()->attribute(SketchPlugin_Circle::CENTER_ID()));
248 else if (anAttr->attr()) {
249 aPointAttr = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(anAttr->attr());
254 //*************************************************************************************
255 std::shared_ptr<SketchPlugin_Line> getFeatureLine(DataPtr theData,
256 const std::string& theAttribute)
258 std::shared_ptr<SketchPlugin_Line> aLine;
262 std::shared_ptr<ModelAPI_AttributeRefAttr> anAttr = std::dynamic_pointer_cast<
263 ModelAPI_AttributeRefAttr>(theData->attribute(theAttribute));
265 FeaturePtr aFeature = ModelAPI_Feature::feature(anAttr->object());
266 if (aFeature && aFeature->getKind() == SketchPlugin_Line::ID()) {
267 aLine = std::dynamic_pointer_cast<SketchPlugin_Line>(aFeature);
273 //*************************************************************************************
274 std::shared_ptr<GeomAPI_Pnt2d> getProjectionPoint(
275 const std::shared_ptr<SketchPlugin_Line>& theLine,
276 const std::shared_ptr<GeomAPI_Pnt2d>& thePoint)
278 std::shared_ptr<ModelAPI_Data> aData = theLine->data();
279 std::shared_ptr<GeomDataAPI_Point2D> aPoint1 = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
280 aData->attribute(SketchPlugin_Line::START_ID()));
281 std::shared_ptr<GeomDataAPI_Point2D> aPoint2 = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
282 aData->attribute(SketchPlugin_Line::END_ID()));
284 GeomAPI_Lin2d aLin2d(aPoint1->x(), aPoint1->y(), aPoint2->x(), aPoint2->y());
285 return aLin2d.project(thePoint);