Salome HOME
Issue #1822: Set fly out point before moving of points for radial directed objects
[modules/shaper.git] / src / SketcherPrs / SketcherPrs_Angle.cpp
1 // Copyright (C) 2014-20xx CEA/DEN, EDF R&D
2
3 // File:        SketcherPrs_Angle.cpp
4 // Created:     20 August 2015
5 // Author:      Vitaly SMETANNIKOV
6
7 #include "SketcherPrs_Angle.h"
8 #include "SketcherPrs_Tools.h"
9 #include "SketcherPrs_DimensionStyleListener.h"
10
11 #include <SketchPlugin_ConstraintAngle.h>
12 #include <SketchPlugin_Constraint.h>
13 #include <SketchPlugin_Line.h>
14
15 #include <GeomAPI_Edge.h>
16 #include <GeomAPI_Lin.h>
17 #include <GeomDataAPI_Point2D.h>
18 #include <GeomAPI_Angle2d.h>
19 #include <GeomAPI_Lin2d.h>
20
21 #include <ModelAPI_AttributeRefAttr.h>
22 #include <ModelAPI_AttributeDouble.h>
23 #include <ModelAPI_AttributeInteger.h>
24
25 #include <TopExp.hxx>
26 #include <BRep_Tool.hxx>
27
28 #define PI 3.1415926535897932
29
30 //#ifndef WNT
31 //  #define COMPILATION_CORRECTION
32 //#endif
33
34 IMPLEMENT_STANDARD_HANDLE(SketcherPrs_Angle, AIS_AngleDimension);
35 IMPLEMENT_STANDARD_RTTIEXT(SketcherPrs_Angle, AIS_AngleDimension);
36
37 SketcherPrs_Angle::SketcherPrs_Angle(ModelAPI_Feature* theConstraint, 
38                                      const std::shared_ptr<GeomAPI_Ax3>& thePlane)
39 : AIS_AngleDimension(gp_Pnt(0,0,0), gp_Pnt(1,0,0), gp_Pnt(0,1,0)), myConstraint(theConstraint),
40   mySketcherPlane(thePlane),
41   myFirstPoint(gp_Pnt(0,0,0)), myCenterPoint(gp_Pnt(1,0,0)), mySecondPoint(gp_Pnt(0,1,0)),
42   myValue(90., false, ""), myFlyOutPoint(0, 0.5, 0)
43 {
44   myAspect = new Prs3d_DimensionAspect();
45   myAspect->MakeArrows3d(false);
46   myAspect->MakeText3d(false);
47   myAspect->MakeTextShaded(false);
48   myAspect->MakeUnitsDisplayed(false);
49   myAspect->TextAspect()->SetHeight(SketcherPrs_Tools::getDefaultTextHeight());
50   myAspect->ArrowAspect()->SetLength(SketcherPrs_Tools::getArrowSize());
51   
52   SetDimensionAspect(myAspect);
53
54   myStyleListener = new SketcherPrs_DimensionStyleListener();
55 }
56
57 SketcherPrs_Angle::~SketcherPrs_Angle()
58 {
59   delete myStyleListener;
60 }
61
62 bool SketcherPrs_Angle::IsReadyToDisplay(ModelAPI_Feature* theConstraint,
63                                          const std::shared_ptr<GeomAPI_Ax3>& thePlane)
64 {
65   gp_Pnt aFirstPoint, aSecondPoint, aCenterPoint;
66   return readyToDisplay(theConstraint, thePlane, aFirstPoint, aSecondPoint, aCenterPoint);
67 }
68
69 bool SketcherPrs_Angle::readyToDisplay(ModelAPI_Feature* theConstraint,
70                                        const std::shared_ptr<GeomAPI_Ax3>& thePlane,
71                                        gp_Pnt& theFirstPoint, gp_Pnt& theSecondPoint,
72                                        gp_Pnt& theCenterPoint)
73 {
74   bool aReadyToDisplay = false;
75
76   DataPtr aData = theConstraint->data();
77
78   // Flyout point
79   std::shared_ptr<GeomDataAPI_Point2D> aFlyoutAttr = 
80     std::dynamic_pointer_cast<GeomDataAPI_Point2D>
81     (aData->attribute(SketchPlugin_Constraint::FLYOUT_VALUE_PNT()));
82   if (!aFlyoutAttr->isInitialized())
83     return aReadyToDisplay; // can not create a good presentation
84
85   AttributeRefAttrPtr anAttr1 = aData->refattr(SketchPlugin_Constraint::ENTITY_A());
86   if (!anAttr1->isInitialized())
87     return aReadyToDisplay;
88
89   AttributeRefAttrPtr anAttr2 = aData->refattr(SketchPlugin_Constraint::ENTITY_B());
90   if (!anAttr2->isInitialized())
91     return aReadyToDisplay;
92
93   FeaturePtr aLineA = SketcherPrs_Tools::getFeatureLine(aData, SketchPlugin_Constraint::ENTITY_A());
94   FeaturePtr aLineB = SketcherPrs_Tools::getFeatureLine(aData, SketchPlugin_Constraint::ENTITY_B());
95
96   if (!aLineA.get() || !aLineB.get())
97     return aReadyToDisplay;
98
99   std::shared_ptr<GeomDataAPI_Point2D> aStartA = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
100       aLineA->attribute(SketchPlugin_Line::START_ID()));
101   std::shared_ptr<GeomDataAPI_Point2D> aEndA = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
102       aLineA->attribute(SketchPlugin_Line::END_ID()));
103   std::shared_ptr<GeomDataAPI_Point2D> aStartB = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
104       aLineB->attribute(SketchPlugin_Line::START_ID()));
105   std::shared_ptr<GeomDataAPI_Point2D> aEndB = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
106       aLineB->attribute(SketchPlugin_Line::END_ID()));
107
108   std::shared_ptr<GeomAPI_Angle2d> anAng;
109   if (!aData->attribute(SketchPlugin_ConstraintAngle::ANGLE_REVERSED_FIRST_LINE_ID())->isInitialized() ||
110       !aData->attribute(SketchPlugin_ConstraintAngle::ANGLE_REVERSED_SECOND_LINE_ID())->isInitialized())
111     anAng = std::shared_ptr<GeomAPI_Angle2d>(new GeomAPI_Angle2d(
112         aStartA->pnt(), aEndA->pnt(), aStartB->pnt(), aEndB->pnt()));
113   else {
114     std::shared_ptr<GeomAPI_Lin2d> aLine1(new GeomAPI_Lin2d(aStartA->pnt(), aEndA->pnt()));
115     bool isReversed1 = aData->boolean(SketchPlugin_ConstraintAngle::ANGLE_REVERSED_FIRST_LINE_ID())->value();
116     std::shared_ptr<GeomAPI_Lin2d> aLine2(new GeomAPI_Lin2d(aStartB->pnt(), aEndB->pnt()));
117     bool isReversed2 = aData->boolean(SketchPlugin_ConstraintAngle::ANGLE_REVERSED_SECOND_LINE_ID())->value();
118     anAng = std::shared_ptr<GeomAPI_Angle2d>(new GeomAPI_Angle2d(aLine1, isReversed1, aLine2, isReversed2));
119   }
120
121   gp_Pnt2d aFirstPoint = anAng->firstPoint()->impl<gp_Pnt2d>();
122   std::shared_ptr<GeomAPI_Pnt> aPoint = thePlane->to3D(aFirstPoint.X(), aFirstPoint.Y());
123   theFirstPoint = aPoint->impl<gp_Pnt>();
124
125   gp_Pnt2d aCenterPoint = anAng->center()->impl<gp_Pnt2d>();
126   aPoint = thePlane->to3D(aCenterPoint.X(), aCenterPoint.Y());
127   theCenterPoint = aPoint->impl<gp_Pnt>();
128
129   gp_Pnt2d aSecondPoint = anAng->secondPoint()->impl<gp_Pnt2d>();
130   aPoint = thePlane->to3D(aSecondPoint.X(), aSecondPoint.Y());
131   theSecondPoint = aPoint->impl<gp_Pnt>();
132
133   return true;
134 }
135
136
137 void SketcherPrs_Angle::Compute(const Handle(PrsMgr_PresentationManager3d)& thePresentationManager,
138                                 const Handle(Prs3d_Presentation)& thePresentation, 
139                                 const Standard_Integer theMode)
140 {
141   gp_Pnt aFirstPoint, aSecondPoint, aCenterPoint;
142   bool aReadyToDisplay = readyToDisplay(myConstraint, mySketcherPlane, aFirstPoint, aSecondPoint, aCenterPoint);
143   if (aReadyToDisplay) {
144     myFirstPoint = aFirstPoint;
145     mySecondPoint = aSecondPoint;
146     myCenterPoint = aCenterPoint;
147
148     DataPtr aData = myConstraint->data();
149     AttributeDoublePtr anAttributeValue = aData->real(SketchPlugin_ConstraintAngle::ANGLE_VALUE_ID());
150     myValue.init(anAttributeValue);
151
152     std::shared_ptr<GeomDataAPI_Point2D> aFlyoutAttr = 
153                                 std::dynamic_pointer_cast<GeomDataAPI_Point2D>
154                                 (aData->attribute(SketchPlugin_Constraint::FLYOUT_VALUE_PNT()));
155     std::shared_ptr<GeomAPI_Pnt> aFlyoutPnt = mySketcherPlane->to3D(aFlyoutAttr->x(), aFlyoutAttr->y());
156     myFlyOutPoint = aFlyoutPnt->impl<gp_Pnt>();
157   }
158
159   DataPtr aData = myConstraint->data();
160   std::shared_ptr<ModelAPI_AttributeInteger> aTypeAttr = std::dynamic_pointer_cast<
161       ModelAPI_AttributeInteger>(aData->attribute(SketchPlugin_ConstraintAngle::TYPE_ID()));
162   SketcherPrs_Tools::AngleType anAngleType = (SketcherPrs_Tools::AngleType)(aTypeAttr->value());
163
164   double aDist = -1;
165   switch (anAngleType) {
166     case SketcherPrs_Tools::ANGLE_DIRECT: {
167 #ifndef COMPILATION_CORRECTION
168       SetArrowVisible(Standard_False/*first*/, Standard_True/*second*/);
169 #endif
170       SetMeasuredGeometry(myFirstPoint, myCenterPoint, mySecondPoint);
171 #ifndef COMPILATION_CORRECTION
172       bool isReversedPlanes = isAnglePlaneReversedToSketchPlane();
173       SetAngleReversed(!isReversedPlanes);
174 #endif
175     }
176     break;
177     case SketcherPrs_Tools::ANGLE_COMPLEMENTARY: {
178       double anEdge1Length = aCenterPoint.Distance(myFirstPoint);
179       //aDist = calculateDistanceToFlyoutPoint();
180       gp_Pnt aFirstPoint = aCenterPoint.Translated(
181                           gp_Vec(myCenterPoint, myFirstPoint).Normalized() * (-anEdge1Length));
182       SetMeasuredGeometry(aFirstPoint, myCenterPoint, mySecondPoint);
183 #ifndef COMPILATION_CORRECTION
184       SetAngleReversed(false);
185 #endif
186     }
187     break;
188     case SketcherPrs_Tools::ANGLE_BACKWARD: {
189 #ifndef COMPILATION_CORRECTION
190       SetArrowVisible(Standard_False/*first*/, Standard_True/*second*/);
191 #endif
192       SetMeasuredGeometry(myFirstPoint, myCenterPoint, mySecondPoint);
193       bool isReversedPlanes = isAnglePlaneReversedToSketchPlane();
194 #ifndef COMPILATION_CORRECTION
195       SetAngleReversed(isReversedPlanes);
196 #endif
197     }
198     break;
199     default:
200       break;
201   }
202   if (aDist < 0) /// it was not calculated yet
203     aDist = calculateDistanceToFlyoutPoint();
204   SetFlyout(aDist);
205
206   // Update text visualization: parameter value or parameter text
207   myStyleListener->updateDimensions(this, myValue);
208
209   myAspect->SetExtensionSize(myAspect->ArrowAspect()->Length());
210   myAspect->SetArrowTailSize(myAspect->ArrowAspect()->Length());
211
212   AIS_AngleDimension::Compute(thePresentationManager, thePresentation, theMode);
213
214   if (!aReadyToDisplay)
215     SketcherPrs_Tools::sendEmptyPresentationError(myConstraint,
216                               "An empty AIS presentation: SketcherPrs_Angle");
217 }
218
219 void SketcherPrs_Angle::ComputeSelection(const Handle(SelectMgr_Selection)& aSelection,
220                                                    const Standard_Integer theMode)
221 {
222   Standard_Integer aMode;
223   switch (theMode) {
224   case 0: // we should use selection of all objects
225     aMode = 0;
226     break;
227   case SketcherPrs_Tools::Sel_Dimension_All:
228     aMode = 0;
229     break;
230   case SketcherPrs_Tools::Sel_Dimension_Line:
231     aMode = 1;
232     break;
233   case SketcherPrs_Tools::Sel_Dimension_Text:
234     aMode = 2;
235     break;
236   default: {
237     // there are own selection modes, so the others should be ignored
238     // otherwise, the text selection appears in the viewer
239     return; 
240   }
241   }
242   SetSelToleranceForText2d(SketcherPrs_Tools::getTextHeight());
243   AIS_AngleDimension::ComputeSelection(aSelection, aMode);
244 }
245
246 bool SketcherPrs_Angle::isAnglePlaneReversedToSketchPlane()
247 {
248   bool aReversed = false;
249   if (!mySketcherPlane.get())
250     return aReversed;
251
252   gp_Pln aPlane = GetPlane();
253   gp_Dir aDir = aPlane.Axis().Direction();
254   double aDot = mySketcherPlane->normal()->dot(
255                 std::shared_ptr<GeomAPI_Dir>(new GeomAPI_Dir(aDir.X(), aDir.Y(), aDir.Z())));
256   return aDot < 0;
257 }
258
259 double SketcherPrs_Angle::calculateDistanceToFlyoutPoint()
260 {
261   //gp_Dir aBisector = gp_Dir((myFirstPoint.XYZ() + mySecondPoint.XYZ()) * 0.5 - myCenterPoint.XYZ());
262   //gp_XYZ aFlyDir = myFlyOutPoint.XYZ() - myCenterPoint.XYZ();
263
264   //double aDistance = aFlyDir.Dot(aBisector.XYZ());
265   //// make a positive distance in order to AIS angle presentation is not reversed
266   //aDistance = fabs(aDistance);
267   //return aDistance;
268   return myFlyOutPoint.Distance(myCenterPoint);
269 }