Salome HOME
Precise calculation of the flyout point for Length and Distance constraints
[modules/shaper.git] / src / SketchPlugin / SketchPlugin_ConstraintLength.cpp
1 // Copyright (C) 2014-20xx CEA/DEN, EDF R&D -->
2
3 // File:    SketchPlugin_ConstraintLength.cpp
4 // Created: 30 May 2014
5 // Author:  Artem ZHIDKOV
6
7 #include "SketchPlugin_ConstraintLength.h"
8 #include <SketchPlugin_Line.h>
9
10 #include <GeomDataAPI_Point2D.h>
11
12 #include <SketcherPrs_Factory.h>
13
14 #include <ModelAPI_AttributeDouble.h>
15 #include <ModelAPI_Data.h>
16 #include <ModelAPI_Result.h>
17
18 #include <GeomDataAPI_Point2D.h>
19
20 #include <GeomAPI_Dir2d.h>
21 #include <GeomAPI_Lin2d.h>
22 #include <GeomAPI_Pnt2d.h>
23 #include <GeomAPI_XY.h>
24
25 #include <Config_PropManager.h>
26
27 #include <math.h>
28
29 const double tolerance = 1e-7;
30
31 SketchPlugin_ConstraintLength::SketchPlugin_ConstraintLength()
32 {
33   myFlyoutUpdate = false;
34 }
35
36 void SketchPlugin_ConstraintLength::initAttributes()
37 {
38   data()->addAttribute(SketchPlugin_Constraint::VALUE(), ModelAPI_AttributeDouble::typeId());
39   data()->addAttribute(SketchPlugin_Constraint::FLYOUT_VALUE_PNT(), GeomDataAPI_Point2D::typeId());
40   data()->addAttribute(SketchPlugin_Constraint::ENTITY_A(), ModelAPI_AttributeRefAttr::typeId());
41 }
42
43 void SketchPlugin_ConstraintLength::execute()
44 {
45   std::shared_ptr<ModelAPI_AttributeRefAttr> aRef = std::dynamic_pointer_cast<
46       ModelAPI_AttributeRefAttr>(data()->attribute(SketchPlugin_Constraint::ENTITY_A()));
47   FeaturePtr aFeature = ModelAPI_Feature::feature(aRef->object());
48   if (aFeature) {
49     // set length value
50     std::shared_ptr<GeomDataAPI_Point2D> aPoint1 = std::dynamic_pointer_cast<
51         GeomDataAPI_Point2D>(aFeature->data()->attribute(SketchPlugin_Line::START_ID()));
52     std::shared_ptr<GeomDataAPI_Point2D> aPoint2 = std::dynamic_pointer_cast<
53         GeomDataAPI_Point2D>(aFeature->data()->attribute(SketchPlugin_Line::END_ID()));
54
55     double aLenght = aPoint1->pnt()->distance(aPoint2->pnt());
56
57     //std::shared_ptr<ModelAPI_AttributeDouble> aValueAttr = std::dynamic_pointer_cast<
58     //    ModelAPI_AttributeDouble>(data()->attribute(SketchPlugin_Constraint::VALUE()));
59     //if(!aValueAttr->isInitialized()) {
60     //  aValueAttr->setValue(aLenght);
61     //}
62
63     // the value should to be computed here, not in the getAISObject in order to change the model value
64     // inside the object transaction. This is important for creating a constraint by preselection.
65     // The display of the presentation in this case happens after the transaction commit
66     AttributePtr aFlyOutAttribute = data()->attribute(SketchPlugin_Constraint::FLYOUT_VALUE_PNT());
67     if (!aFlyOutAttribute->isInitialized()) {
68       compute(SketchPlugin_Constraint::FLYOUT_VALUE_PNT());
69     }
70   }
71 }
72
73 bool SketchPlugin_ConstraintLength::compute(const std::string& theAttributeId)
74 {
75   if (theAttributeId != SketchPlugin_Constraint::FLYOUT_VALUE_PNT())
76     return false;
77
78   std::shared_ptr<GeomAPI_Pnt> aPoint1, aPoint2;
79   std::shared_ptr<GeomDataAPI_Point2D> aStartPoint, anEndPoint;
80   if (!getPoints(aPoint1, aPoint2, aStartPoint, anEndPoint))
81     return false;
82
83   std::shared_ptr<GeomDataAPI_Point2D> aFlyOutAttr = std::dynamic_pointer_cast<
84       GeomDataAPI_Point2D>(data()->attribute(theAttributeId));
85
86   std::shared_ptr<GeomAPI_Lin2d> aLine = 
87     std::shared_ptr<GeomAPI_Lin2d>(new GeomAPI_Lin2d(aStartPoint->pnt(), anEndPoint->pnt()));
88   if (fabs(aFlyOutAttr->x()) < tolerance && fabs(aFlyOutAttr->y()) < tolerance) {
89     double aDist = aPoint1->distance(aPoint2)/5.;
90     std::shared_ptr<GeomAPI_Pnt2d> aFPnt = aLine->shiftedLocation(aDist);
91     aFlyOutAttr->setValue(aFPnt);
92   }
93
94   return true;
95 }
96
97 bool SketchPlugin_ConstraintLength::getPoints(
98   std::shared_ptr<GeomAPI_Pnt>& thePoint1, std::shared_ptr<GeomAPI_Pnt>& thePoint2,
99   std::shared_ptr<GeomDataAPI_Point2D>& theStartPoint,
100   std::shared_ptr<GeomDataAPI_Point2D>& theEndPoint)
101 {
102   if (!sketch())
103     return false;
104   std::shared_ptr<GeomAPI_Pln> aPlane = sketch()->plane();
105   std::shared_ptr<ModelAPI_AttributeRefAttr> anAttr = std::dynamic_pointer_cast<
106       ModelAPI_AttributeRefAttr>(data()->attribute(SketchPlugin_Constraint::ENTITY_A()));
107   if (!anAttr)
108     return false;
109   FeaturePtr aFeature = ModelAPI_Feature::feature(anAttr->object());
110   if (!aFeature || aFeature->getKind() != SketchPlugin_Line::ID())
111     return false;
112   DataPtr aData = aFeature->data();
113   theStartPoint = std::dynamic_pointer_cast<
114       GeomDataAPI_Point2D>(aData->attribute(SketchPlugin_Line::START_ID()));
115   theEndPoint = std::dynamic_pointer_cast<
116       GeomDataAPI_Point2D>(aData->attribute(SketchPlugin_Line::END_ID()));
117   thePoint1 = sketch()->to3D(theStartPoint->x(), theStartPoint->y());
118   thePoint2 = sketch()->to3D(theEndPoint->x(), theEndPoint->y());
119   return true;
120 }
121
122 AISObjectPtr SketchPlugin_ConstraintLength::getAISObject(AISObjectPtr thePrevious)
123 {
124   if (!sketch())
125     return thePrevious;
126
127   AISObjectPtr anAIS = thePrevious;
128   if (!anAIS) {
129     anAIS = SketcherPrs_Factory::lengthDimensionConstraint(this, sketch()->coordinatePlane());
130   }
131
132   // Set color from preferences
133   std::vector<int> aRGB = Config_PropManager::color("Visualization", "sketch_dimension_color",
134                                                     SKETCH_DIMENSION_COLOR);
135   anAIS->setColor(aRGB[0], aRGB[1], aRGB[2]);
136   return anAIS;
137 }
138
139 void SketchPlugin_ConstraintLength::move(double theDeltaX, double theDeltaY)
140 {
141   std::shared_ptr<ModelAPI_Data> aData = data();
142   if (!aData->isValid())
143     return;
144
145   AttributeRefAttrPtr aLineAttr = std::dynamic_pointer_cast<ModelAPI_AttributeRefAttr>(
146       attribute(SketchPlugin_Constraint::ENTITY_A()));
147   if (!aLineAttr || !aLineAttr->isObject())
148     return;
149   FeaturePtr aLine = ModelAPI_Feature::feature(aLineAttr->object());
150   if (!aLine || aLine->getKind() != SketchPlugin_Line::ID())
151     return;
152
153   // Recalculate a shift of flyout point in terms of local coordinates
154   std::shared_ptr<GeomAPI_XY> aDir(new GeomAPI_XY(theDeltaX, theDeltaY));
155   std::shared_ptr<GeomAPI_XY> aStartPnt = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
156       aLine->attribute(SketchPlugin_Line::START_ID()))->pnt()->xy();
157   std::shared_ptr<GeomAPI_XY> aEndPnt = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
158       aLine->attribute(SketchPlugin_Line::END_ID()))->pnt()->xy();
159   std::shared_ptr<GeomAPI_Dir2d> aLineDir(new GeomAPI_Dir2d(aEndPnt->decreased(aStartPnt)));
160   double dX = aDir->dot(aLineDir->xy());
161   double dY = -aDir->cross(aLineDir->xy());
162
163   myFlyoutUpdate = true;
164   std::shared_ptr<GeomDataAPI_Point2D> aPoint = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
165       aData->attribute(SketchPlugin_Constraint::FLYOUT_VALUE_PNT()));
166   aPoint->setValue(aPoint->x() + dX, aPoint->y() + dY);
167   myFlyoutUpdate = false;
168 }
169
170 void SketchPlugin_ConstraintLength::attributeChanged(const std::string& theID) {
171   if (theID == SketchPlugin_Constraint::ENTITY_A()) 
172   {
173     std::shared_ptr<ModelAPI_AttributeDouble> aValueAttr = std::dynamic_pointer_cast<
174       ModelAPI_AttributeDouble>(attribute(SketchPlugin_Constraint::VALUE()));
175     if (!aValueAttr->isInitialized()) { // only if it is not initialized, try to compute the current value
176       std::shared_ptr<GeomAPI_Pnt> aPoint1, aPoint2;
177       std::shared_ptr<GeomDataAPI_Point2D> aStartPoint, anEndPoint;
178       if (getPoints(aPoint1, aPoint2, aStartPoint, anEndPoint)) {
179         double aLength = aPoint1->distance(aPoint2);
180         aValueAttr->setValue(aLength);
181       }
182     }
183   } else if (theID == SketchPlugin_Constraint::FLYOUT_VALUE_PNT() && !myFlyoutUpdate) {
184     myFlyoutUpdate = true;
185     // Recalculate flyout point in local coordinates of the line:
186     // the X coordinate is a length of projection of the flyout point on the line
187     // the Y coordinate is a distance from the 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     AttributeRefAttrPtr aLineAttr = std::dynamic_pointer_cast<ModelAPI_AttributeRefAttr>(
192         attribute(SketchPlugin_Constraint::ENTITY_A()));
193     if (!aLineAttr || !aLineAttr->isObject())
194       return;
195     FeaturePtr aLine = ModelAPI_Feature::feature(aLineAttr->object());
196     if (!aLine || aLine->getKind() != SketchPlugin_Line::ID())
197       return;
198
199     std::shared_ptr<GeomAPI_Pnt2d> aFlyoutPnt = aFlyoutAttr->pnt();
200     std::shared_ptr<GeomAPI_XY> aStartPnt = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
201         aLine->attribute(SketchPlugin_Line::START_ID()))->pnt()->xy();
202     std::shared_ptr<GeomAPI_XY> aEndPnt = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
203         aLine->attribute(SketchPlugin_Line::END_ID()))->pnt()->xy();
204
205     std::shared_ptr<GeomAPI_Dir2d> aLineDir(new GeomAPI_Dir2d(aEndPnt->decreased(aStartPnt)));
206     std::shared_ptr<GeomAPI_XY> aFlyoutDir = aFlyoutPnt->xy()->decreased(aStartPnt);
207     double X = aFlyoutDir->dot(aLineDir->xy());
208     double Y = -aFlyoutDir->cross(aLineDir->xy());
209     aFlyoutAttr->setValue(X, Y);
210     myFlyoutUpdate = false;
211   }
212 }