]> SALOME platform Git repositories - modules/shaper.git/blob - src/SketchPlugin/SketchPlugin_ConstraintDistance.cpp
Salome HOME
Fix compilation errors (part 2)
[modules/shaper.git] / src / SketchPlugin / SketchPlugin_ConstraintDistance.cpp
1 // Copyright (C) 2014-20xx CEA/DEN, EDF R&D -->
2
3 // File:    SketchPlugin_ConstraintDistance.cpp
4 // Created: 23 May 2014
5 // Author:  Artem ZHIDKOV
6
7 #include "SketchPlugin_ConstraintDistance.h"
8 #include <SketchPlugin_Point.h>
9 #include <SketchPlugin_Circle.h>
10 #include <SketchPlugin_Line.h>
11
12 #include <SketcherPrs_Tools.h>
13 #include <SketcherPrs_Factory.h>
14
15 #include <GeomAPI_Dir2d.h>
16 #include <GeomAPI_Lin2d.h>
17 #include <GeomAPI_Pnt2d.h>
18 #include <GeomAPI_XY.h>
19 #include <GeomDataAPI_Point2D.h>
20
21 #include <ModelAPI_AttributeDouble.h>
22 #include <ModelAPI_Data.h>
23
24 #include <Config_PropManager.h>
25
26 #include <math.h>
27
28 const double tolerance = 1e-7;
29
30
31 SketchPlugin_ConstraintDistance::SketchPlugin_ConstraintDistance()
32 {
33   myFlyoutUpdate = false;
34 }
35
36 //*************************************************************************************
37 void SketchPlugin_ConstraintDistance::initAttributes()
38 {
39   data()->addAttribute(SketchPlugin_Constraint::VALUE(), ModelAPI_AttributeDouble::typeId());
40   data()->addAttribute(SketchPlugin_Constraint::FLYOUT_VALUE_PNT(), GeomDataAPI_Point2D::typeId());
41   data()->addAttribute(SketchPlugin_Constraint::ENTITY_A(), ModelAPI_AttributeRefAttr::typeId());
42   data()->addAttribute(SketchPlugin_Constraint::ENTITY_B(), ModelAPI_AttributeRefAttr::typeId());
43 }
44
45 void SketchPlugin_ConstraintDistance::colorConfigInfo(std::string& theSection, std::string& theName,
46                                                       std::string& theDefault)
47 {
48   theSection = "Visualization";
49   theName = "sketch_dimension_color";
50   theDefault = SKETCH_DIMENSION_COLOR;
51 }
52
53 //*************************************************************************************
54 void SketchPlugin_ConstraintDistance::execute()
55 {
56   std::shared_ptr<ModelAPI_Data> aData = data();
57   AttributeDoublePtr anAttrValue = std::dynamic_pointer_cast<ModelAPI_AttributeDouble>(
58       aData->attribute(SketchPlugin_Constraint::VALUE()));
59
60   if(anAttrValue->isInitialized())
61     return;
62
63   double aDistance = calculateCurrentDistance();
64   if(aDistance >= 0)
65     anAttrValue->setValue(aDistance);
66 }
67
68 //*************************************************************************************
69 AISObjectPtr SketchPlugin_ConstraintDistance::getAISObject(AISObjectPtr thePrevious)
70 {
71   if (!sketch())
72     return thePrevious;
73
74   AISObjectPtr anAIS = SketcherPrs_Factory::lengthDimensionConstraint(this,
75                                                                       sketch()->coordinatePlane(),
76                                                                       thePrevious);
77   return anAIS;
78 }
79
80 //*************************************************************************************
81 void SketchPlugin_ConstraintDistance::move(double theDeltaX, double theDeltaY)
82 {
83   std::shared_ptr<ModelAPI_Data> aData = data();
84   if (!aData->isValid())
85     return;
86
87   // Recalculate a shift of flyout point in terms of local coordinates
88   std::shared_ptr<GeomAPI_XY> aDir(new GeomAPI_XY(theDeltaX, theDeltaY));
89   std::shared_ptr<GeomAPI_Ax3> aPlane = SketchPlugin_Sketch::plane(sketch());
90   std::shared_ptr<GeomDataAPI_Point2D> aPointA = SketcherPrs_Tools::getFeaturePoint(
91       data(), SketchPlugin_Constraint::ENTITY_A(), aPlane);
92   std::shared_ptr<GeomDataAPI_Point2D> aPointB = SketcherPrs_Tools::getFeaturePoint(
93       data(), SketchPlugin_Constraint::ENTITY_B(), aPlane);
94
95   std::shared_ptr<GeomAPI_XY> aStartPnt;
96   std::shared_ptr<GeomAPI_XY> aEndPnt;
97   if (aPointA && aPointB) {
98     aStartPnt = aPointA->pnt()->xy();
99     aEndPnt = aPointB->pnt()->xy();
100   } else if (aPointA) {
101     FeaturePtr aLine = SketcherPrs_Tools::getFeatureLine(data(),
102         SketchPlugin_Constraint::ENTITY_B());
103     if (!aLine)
104       return;
105     std::shared_ptr<GeomAPI_Pnt2d> aPoint = aPointA->pnt();
106     aStartPnt = aPoint->xy();
107     aEndPnt = SketcherPrs_Tools::getProjectionPoint(aLine, aPoint)->xy();
108   } else if (aPointB) {
109     FeaturePtr aLine = SketcherPrs_Tools::getFeatureLine(data(),
110         SketchPlugin_Constraint::ENTITY_A());
111     if (!aLine)
112       return;
113     std::shared_ptr<GeomAPI_Pnt2d> aPoint = aPointB->pnt();
114     aStartPnt = SketcherPrs_Tools::getProjectionPoint(aLine, aPoint)->xy();
115     aEndPnt = aPoint->xy();
116   } else
117     return;
118
119   std::shared_ptr<GeomAPI_Dir2d> aLineDir(new GeomAPI_Dir2d(aEndPnt->decreased(aStartPnt)));
120   double dX = aDir->dot(aLineDir->xy());
121   double dY = -aDir->cross(aLineDir->xy());
122
123   std::shared_ptr<GeomDataAPI_Point2D> aPoint = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
124       aData->attribute(SketchPlugin_Constraint::FLYOUT_VALUE_PNT()));
125   myFlyoutUpdate = true;
126   if (aPoint->isInitialized()) {
127     aPoint->setValue(aPoint->x() + dX, aPoint->y() + dY);
128   } else {
129     aPoint->setValue(dX, dY);
130   }
131   myFlyoutUpdate = false;
132 }
133
134 double SketchPlugin_ConstraintDistance::calculateCurrentDistance()
135 {
136   double aDistance = -1.;
137
138   std::shared_ptr<ModelAPI_Data> aData = data();
139   std::shared_ptr<GeomAPI_Ax3> aPlane = SketchPlugin_Sketch::plane(sketch());
140   std::shared_ptr<GeomDataAPI_Point2D> aPointA =
141     SketcherPrs_Tools::getFeaturePoint(aData, SketchPlugin_Constraint::ENTITY_A(), aPlane);
142   std::shared_ptr<GeomDataAPI_Point2D> aPointB =
143       SketcherPrs_Tools::getFeaturePoint(aData, SketchPlugin_Constraint::ENTITY_B(), aPlane);
144
145   if (aPointA.get() && aPointB.get()) {  // both points
146     aDistance = aPointA->pnt()->distance(aPointB->pnt());
147   } else {
148     FeaturePtr aLineFeature;
149     std::shared_ptr<SketchPlugin_Line> aLine;
150     if (!aPointA.get() && aPointB.get()) {  //Line and point
151       aLineFeature = SketcherPrs_Tools::getFeatureLine(aData, SketchPlugin_Constraint::ENTITY_A());
152       aLine = std::dynamic_pointer_cast<SketchPlugin_Line>(aLineFeature);
153       if (aLine.get()) {
154         aDistance = aLine->distanceToPoint(aPointB->pnt());
155       }
156     } else if (aPointA.get() && !aPointB.get()) {  // Point and line
157       aLineFeature = SketcherPrs_Tools::getFeatureLine(aData, SketchPlugin_Constraint::ENTITY_B());
158       aLine = std::dynamic_pointer_cast<SketchPlugin_Line>(aLineFeature);
159       if (aLine.get()) {
160         aDistance = aLine->distanceToPoint(aPointA->pnt());
161       }
162     }
163   }
164   return aDistance;
165 }
166
167 void SketchPlugin_ConstraintDistance::attributeChanged(const std::string& theID)
168 {
169   if (theID == SketchPlugin_Constraint::ENTITY_A() ||
170       theID == SketchPlugin_Constraint::ENTITY_B())
171   {
172     std::shared_ptr<ModelAPI_AttributeDouble> aValueAttr = std::dynamic_pointer_cast<
173         ModelAPI_AttributeDouble>(data()->attribute(SketchPlugin_Constraint::VALUE()));
174     if (!aValueAttr->isInitialized()) {
175       // only if it is not initialized, try to compute the current value
176       double aDistance = calculateCurrentDistance();
177       if (aDistance > 0) { // set as value the length of updated references
178         aValueAttr->setValue(aDistance);
179       }
180     }
181   } else if (theID == SketchPlugin_Constraint::FLYOUT_VALUE_PNT() && !myFlyoutUpdate) {
182     myFlyoutUpdate = true;
183     // Recalculate flyout point in local coordinates of the distance constraint:
184     // the X coordinate is a length of projection of the flyout point on the
185     //                  line binding two distanced points
186     //                  or a line of projection of the distanced point onto the distanced segment
187     // the Y coordinate is a distance from the flyout point to the line
188     std::shared_ptr<GeomDataAPI_Point2D> aFlyoutAttr =
189         std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
190         attribute(SketchPlugin_Constraint::FLYOUT_VALUE_PNT()));
191     std::shared_ptr<GeomAPI_Pnt2d> aFlyoutPnt = aFlyoutAttr->pnt();
192
193     std::shared_ptr<GeomAPI_Ax3> aPlane = SketchPlugin_Sketch::plane(sketch());
194     std::shared_ptr<GeomDataAPI_Point2D> aPointA = SketcherPrs_Tools::getFeaturePoint(
195         data(), SketchPlugin_Constraint::ENTITY_A(), aPlane);
196     std::shared_ptr<GeomDataAPI_Point2D> aPointB = SketcherPrs_Tools::getFeaturePoint(
197         data(), SketchPlugin_Constraint::ENTITY_B(), aPlane);
198
199     std::shared_ptr<GeomAPI_XY> aStartPnt;
200     std::shared_ptr<GeomAPI_XY> aEndPnt;
201     if (aPointA && aPointB) {
202       aStartPnt = aPointA->pnt()->xy();
203       aEndPnt = aPointB->pnt()->xy();
204     } else if (aPointA) {
205       FeaturePtr aLine = SketcherPrs_Tools::getFeatureLine(data(),
206           SketchPlugin_Constraint::ENTITY_B());
207       if (!aLine)
208         return;
209       std::shared_ptr<GeomAPI_Pnt2d> aPoint = aPointA->pnt();
210       aStartPnt = aPoint->xy();
211       aEndPnt = SketcherPrs_Tools::getProjectionPoint(aLine, aPoint)->xy();
212     } else if (aPointB) {
213       FeaturePtr aLine = SketcherPrs_Tools::getFeatureLine(data(),
214           SketchPlugin_Constraint::ENTITY_A());
215       if (!aLine)
216         return;
217       std::shared_ptr<GeomAPI_Pnt2d> aPoint = aPointB->pnt();
218       aStartPnt = SketcherPrs_Tools::getProjectionPoint(aLine, aPoint)->xy();
219       aEndPnt = aPoint->xy();
220     } else
221       return;
222
223     if (aEndPnt->distance(aStartPnt) < tolerance)
224       return;
225
226     std::shared_ptr<GeomAPI_Dir2d> aLineDir(new GeomAPI_Dir2d(aEndPnt->decreased(aStartPnt)));
227     std::shared_ptr<GeomAPI_XY> aFlyoutDir = aFlyoutPnt->xy()->decreased(aStartPnt);
228
229     double X = aFlyoutDir->dot(aLineDir->xy());
230     double Y = -aFlyoutDir->cross(aLineDir->xy());
231     aFlyoutAttr->setValue(X, Y);
232     myFlyoutUpdate = false;
233   }
234 }
235