Salome HOME
Issue #1299 Angle constraint: support of additional and complementary angles: text...
[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 #include <Events_Error.h>
29
30 #define PI 3.1415926535897932
31
32 IMPLEMENT_STANDARD_HANDLE(SketcherPrs_Angle, AIS_AngleDimension);
33 IMPLEMENT_STANDARD_RTTIEXT(SketcherPrs_Angle, AIS_AngleDimension);
34
35 SketcherPrs_Angle::SketcherPrs_Angle(ModelAPI_Feature* theConstraint, 
36                                      const std::shared_ptr<GeomAPI_Ax3>& thePlane)
37 : AIS_AngleDimension(gp_Pnt(0,0,0), gp_Pnt(1,0,0), gp_Pnt(0,1,0)), myConstraint(theConstraint),
38   mySketcherPlane(thePlane),
39   myFirstPoint(gp_Pnt(0,0,0)), myCenterPoint(gp_Pnt(1,0,0)), mySecondPoint(gp_Pnt(0,1,0)),
40   myAngle(90), myValue("90"), myFlyOutPoint(0, 0.5, 0)
41 {
42   myAspect = new Prs3d_DimensionAspect();
43   myAspect->MakeArrows3d(false);
44   myAspect->MakeText3d(false);
45   myAspect->MakeTextShaded(false);
46   myAspect->MakeUnitsDisplayed(false);
47   myAspect->TextAspect()->SetHeight(SketcherPrs_Tools::getDefaultTextHeight());
48   myAspect->ArrowAspect()->SetLength(SketcherPrs_Tools::getArrowSize());
49   
50   SetDimensionAspect(myAspect);
51   SetSelToleranceForText2d(SketcherPrs_Tools::getDefaultTextHeight());
52
53   myStyleListener = new SketcherPrs_DimensionStyleListener();
54 }
55
56 SketcherPrs_Angle::~SketcherPrs_Angle()
57 {
58   delete myStyleListener;
59 }
60
61 bool SketcherPrs_Angle::IsReadyToDisplay(ModelAPI_Feature* theConstraint,
62                                          const std::shared_ptr<GeomAPI_Ax3>& thePlane)
63 {
64   gp_Pnt aFirstPoint, aSecondPoint, aCenterPoint;
65   return readyToDisplay(theConstraint, thePlane, aFirstPoint, aSecondPoint, aCenterPoint);
66 }
67
68 bool SketcherPrs_Angle::readyToDisplay(ModelAPI_Feature* theConstraint,
69                                        const std::shared_ptr<GeomAPI_Ax3>& thePlane,
70                                        gp_Pnt& theFirstPoint, gp_Pnt& theSecondPoint,
71                                        gp_Pnt& theCenterPoint)
72 {
73   bool aReadyToDisplay = false;
74
75   DataPtr aData = theConstraint->data();
76
77   // Flyout point
78   std::shared_ptr<GeomDataAPI_Point2D> aFlyoutAttr = 
79     std::dynamic_pointer_cast<GeomDataAPI_Point2D>
80     (aData->attribute(SketchPlugin_Constraint::FLYOUT_VALUE_PNT()));
81   if (!aFlyoutAttr->isInitialized())
82     return aReadyToDisplay; // can not create a good presentation
83
84   AttributeRefAttrPtr anAttr1 = aData->refattr(SketchPlugin_Constraint::ENTITY_A());
85   if (!anAttr1->isInitialized())
86     return aReadyToDisplay;
87
88   AttributeRefAttrPtr anAttr2 = aData->refattr(SketchPlugin_Constraint::ENTITY_B());
89   if (!anAttr2->isInitialized())
90     return aReadyToDisplay;
91
92   FeaturePtr aLineA = SketcherPrs_Tools::getFeatureLine(aData, SketchPlugin_Constraint::ENTITY_A());
93   FeaturePtr aLineB = SketcherPrs_Tools::getFeatureLine(aData, SketchPlugin_Constraint::ENTITY_B());
94
95   if (!aLineA.get() || !aLineB.get())
96     return aReadyToDisplay;
97
98   std::shared_ptr<GeomDataAPI_Point2D> aStartA = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
99       aLineA->attribute(SketchPlugin_Line::START_ID()));
100   std::shared_ptr<GeomDataAPI_Point2D> aEndA = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
101       aLineA->attribute(SketchPlugin_Line::END_ID()));
102   std::shared_ptr<GeomDataAPI_Point2D> aStartB = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
103       aLineB->attribute(SketchPlugin_Line::START_ID()));
104   std::shared_ptr<GeomDataAPI_Point2D> aEndB = std::dynamic_pointer_cast<GeomDataAPI_Point2D>(
105       aLineB->attribute(SketchPlugin_Line::END_ID()));
106
107   std::shared_ptr<GeomAPI_Angle2d> anAng;
108   if (!aData->attribute(SketchPlugin_ConstraintAngle::ANGLE_REVERSED_FIRST_LINE_ID())->isInitialized() ||
109       !aData->attribute(SketchPlugin_ConstraintAngle::ANGLE_REVERSED_SECOND_LINE_ID())->isInitialized())
110     anAng = std::shared_ptr<GeomAPI_Angle2d>(new GeomAPI_Angle2d(
111         aStartA->pnt(), aEndA->pnt(), aStartB->pnt(), aEndB->pnt()));
112   else {
113     std::shared_ptr<GeomAPI_Lin2d> aLine1(new GeomAPI_Lin2d(aStartA->pnt(), aEndA->pnt()));
114     bool isReversed1 = aData->boolean(SketchPlugin_ConstraintAngle::ANGLE_REVERSED_FIRST_LINE_ID())->value();
115     std::shared_ptr<GeomAPI_Lin2d> aLine2(new GeomAPI_Lin2d(aStartB->pnt(), aEndB->pnt()));
116     bool isReversed2 = aData->boolean(SketchPlugin_ConstraintAngle::ANGLE_REVERSED_SECOND_LINE_ID())->value();
117     anAng = std::shared_ptr<GeomAPI_Angle2d>(new GeomAPI_Angle2d(aLine1, isReversed1, aLine2, isReversed2));
118   }
119
120   gp_Pnt2d aFirstPoint = anAng->firstPoint()->impl<gp_Pnt2d>();
121   std::shared_ptr<GeomAPI_Pnt> aPoint = thePlane->to3D(aFirstPoint.X(), aFirstPoint.Y());
122   theFirstPoint = aPoint->impl<gp_Pnt>();
123
124   gp_Pnt2d aCenterPoint = anAng->center()->impl<gp_Pnt2d>();
125   aPoint = thePlane->to3D(aCenterPoint.X(), aCenterPoint.Y());
126   theCenterPoint = aPoint->impl<gp_Pnt>();
127
128   gp_Pnt2d aSecondPoint = anAng->secondPoint()->impl<gp_Pnt2d>();
129   aPoint = thePlane->to3D(aSecondPoint.X(), aSecondPoint.Y());
130   theSecondPoint = aPoint->impl<gp_Pnt>();
131
132   return true;
133 }
134
135
136 void SketcherPrs_Angle::Compute(const Handle(PrsMgr_PresentationManager3d)& thePresentationManager,
137                                 const Handle(Prs3d_Presentation)& thePresentation, 
138                                 const Standard_Integer theMode)
139 {
140   gp_Pnt aFirstPoint, aSecondPoint, aCenterPoint;
141   bool aReadyToDisplay = readyToDisplay(myConstraint, mySketcherPlane, aFirstPoint, aSecondPoint, aCenterPoint);
142   if (aReadyToDisplay) {
143     myFirstPoint = aFirstPoint;
144     mySecondPoint = aSecondPoint;
145     myCenterPoint = aCenterPoint;
146
147     DataPtr aData = myConstraint->data();
148     AttributeDoublePtr aVal = aData->real(SketchPlugin_ConstraintAngle::ANGLE_VALUE_ID());
149     myAngle = aVal->value();
150     myValue = aVal->text();
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       SetArrowVisible(Standard_False/*first*/, Standard_True/*second*/);
168       SetMeasuredGeometry(myFirstPoint, myCenterPoint, mySecondPoint);
169       bool isReversedPlanes = isAnglePlaneReversedToSketchPlane();
170       SetAngleReversed(!isReversedPlanes);
171     }
172     break;
173     case SketcherPrs_Tools::ANGLE_COMPLEMENTARY: {
174       double anEdge1Length = aCenterPoint.Distance(myFirstPoint);
175       //aDist = calculateDistanceToFlyoutPoint();
176       gp_Pnt aFirstPoint = aCenterPoint.Translated(
177                           gp_Vec(myCenterPoint, myFirstPoint).Normalized() * (-anEdge1Length));
178       SetMeasuredGeometry(aFirstPoint, myCenterPoint, mySecondPoint);
179       SetAngleReversed(false);
180     }
181     break;
182     case SketcherPrs_Tools::ANGLE_BACKWARD: {
183       SetArrowVisible(Standard_False/*first*/, Standard_True/*second*/);
184       SetMeasuredGeometry(myFirstPoint, myCenterPoint, mySecondPoint);
185       bool isReversedPlanes = isAnglePlaneReversedToSketchPlane();
186       SetAngleReversed(isReversedPlanes);
187     }
188     break;
189     default:
190       break;
191   }
192   if (aDist < 0) /// it was not calculated yet
193     aDist = calculateDistanceToFlyoutPoint();
194   SetFlyout(aDist);
195
196   // Angle value is in degrees
197   SetCustomValue(myAngle);
198
199   myAspect->SetExtensionSize(myAspect->ArrowAspect()->Length());
200   myAspect->SetArrowTailSize(myAspect->ArrowAspect()->Length());
201
202   // Update text visualization: parameter value or parameter text
203   myStyleListener->updateDimensions(this, myHasParameters, myValue);
204
205   AIS_AngleDimension::Compute(thePresentationManager, thePresentation, theMode);
206
207   if (!aReadyToDisplay)
208     SketcherPrs_Tools::sendEmptyPresentationError(myConstraint,
209                               "An empty AIS presentation: SketcherPrs_Angle");
210 }
211
212 void SketcherPrs_Angle::ComputeSelection(const Handle(SelectMgr_Selection)& aSelection,
213                                                    const Standard_Integer theMode)
214 {
215   Standard_Integer aMode;
216   switch (theMode) {
217   case 0: // we should use selection of all objects
218     aMode = 0;
219     break;
220   case SketcherPrs_Tools::Sel_Dimension_All:
221     aMode = 0;
222     break;
223   case SketcherPrs_Tools::Sel_Dimension_Line:
224     aMode = 1;
225     break;
226   case SketcherPrs_Tools::Sel_Dimension_Text:
227     aMode = 2;
228     break;
229   default: {
230     // there are own selection modes, so the others should be ignored
231     // otherwise, the text selection appears in the viewer
232     return; 
233   }
234   }
235   AIS_AngleDimension::ComputeSelection(aSelection, aMode);
236 }
237
238 bool SketcherPrs_Angle::isAnglePlaneReversedToSketchPlane()
239 {
240   bool aReversed = false;
241   if (!mySketcherPlane.get())
242     return aReversed;
243
244   gp_Pln aPlane = GetPlane();
245   gp_Dir aDir = aPlane.Axis().Direction();
246   double aDot = mySketcherPlane->normal()->dot(
247                 std::shared_ptr<GeomAPI_Dir>(new GeomAPI_Dir(aDir.X(), aDir.Y(), aDir.Z())));
248   return aDot < 0;
249 }
250
251 double SketcherPrs_Angle::calculateDistanceToFlyoutPoint()
252 {
253   gp_Dir aBisector((myFirstPoint.XYZ() + mySecondPoint.XYZ()) * 0.5 - myCenterPoint.XYZ());
254   //gp_Pnt aFlyPnt(aFlyoutPnt->x(), aFlyoutPnt->y(), aFlyoutPnt->z());
255   gp_XYZ aFlyDir = myFlyOutPoint.XYZ() - myCenterPoint.XYZ();
256   double aDistance = aFlyDir.Dot(aBisector.XYZ());
257   // make a positive distance in order to AIS angle presentation is not reversed
258   aDistance = fabs(aDistance);
259   return aDistance;
260 }