d176dbef134b9810c217e8b1ec8ecc412fffbd09
[occt.git] / src / Select3D / Select3D_SensitiveSegment.cxx
1 // Created on: 1995-01-25
2 // Created by: Mister rmi
3 // Copyright (c) 1995-1999 Matra Datavision
4 // Copyright (c) 1999-2012 OPEN CASCADE SAS
5 //
6 // The content of this file is subject to the Open CASCADE Technology Public
7 // License Version 6.5 (the "License"). You may not use the content of this file
8 // except in compliance with the License. Please obtain a copy of the License
9 // at http://www.opencascade.org and read it completely before using this file.
10 //
11 // The Initial Developer of the Original Code is Open CASCADE S.A.S., having its
12 // main offices at: 1, place des Freres Montgolfier, 78280 Guyancourt, France.
13 //
14 // The Original Code and all software distributed under the License is
15 // distributed on an "AS IS" basis, without warranty of any kind, and the
16 // Initial Developer hereby disclaims all such warranties, including without
17 // limitation, any warranties of merchantability, fitness for a particular
18 // purpose or non-infringement. Please see the License for the specific terms
19 // and conditions governing the rights and limitations under the License.
20
21
22
23 #include <Select3D_SensitiveSegment.ixx>
24 #include <SelectBasics_BasicTool.hxx>
25 #include <gp_Vec.hxx>
26 #include <gp_Vec2d.hxx>
27 #include <Bnd_Box2d.hxx>
28 #include <gp_Pnt2d.hxx>
29 #include <gp_Dir2d.hxx>
30 #include <gp_Lin2d.hxx>
31 #include <ElCLib.hxx>
32 #include <Extrema_ExtElC.hxx>
33 #include <Extrema_POnCurv.hxx>
34 #include <TColgp_Array1OfPnt2d.hxx>
35 #include <Precision.hxx>
36 #include <SelectBasics_ListIteratorOfListOfBox2d.hxx>
37
38 #include <CSLib_Class2d.hxx>
39
40 //=====================================================
41 // Function : Create
42 // Purpose  :Constructor
43 //=====================================================
44
45 Select3D_SensitiveSegment::
46 Select3D_SensitiveSegment(const Handle(SelectBasics_EntityOwner)& OwnerId,
47                           const gp_Pnt& FirstP,
48                           const gp_Pnt& LastP,
49                           const Standard_Integer MaxRect):
50 Select3D_SensitiveEntity(OwnerId),
51 mymaxrect(MaxRect)
52 {
53   mystart = FirstP;
54   myend = LastP;
55 }
56
57 //=====================================================
58 // Function :
59 // Purpose  :
60 //=====================================================
61
62 void Select3D_SensitiveSegment
63 ::Project(const Handle(Select3D_Projector)& aProj)
64 {
65   Select3D_SensitiveEntity::Project(aProj); // to set the field last proj...
66   gp_Pnt2d aPoint2dStart;
67   gp_Pnt2d aPoint2dEnd;
68
69   if(HasLocation())
70   {
71     gp_Pnt aStart(mystart.x, mystart.y, mystart.z);
72     gp_Pnt aEnd(myend.x, myend.y, myend.z);
73     aProj->Project(aStart.Transformed(Location().Transformation()),aPoint2dStart);
74     aProj->Project(aEnd.Transformed(Location().Transformation()),aPoint2dEnd);
75   }
76   else
77   {
78     aProj->Project(mystart,aPoint2dStart);
79     aProj->Project(myend,aPoint2dEnd);
80   }
81   myprojstart = aPoint2dStart;
82   myprojend = aPoint2dEnd;
83 }
84
85 //=====================================================
86 // Function : Areas
87 // Purpose  :
88 //=====================================================
89
90 void Select3D_SensitiveSegment
91 ::Areas(SelectBasics_ListOfBox2d& theareas)
92 {
93 //  gp_Dir2d dy (0.,1.);
94   gp_Pnt2d aPStart(myprojstart.x,myprojstart.y);
95   if(aPStart.Distance(myprojend)<=Precision::Confusion())
96   {
97       Bnd_Box2d curbox;
98       curbox.Set(myprojstart);
99       theareas.Append(curbox);
100   }
101   else
102   {
103     gp_Vec2d MyVec(myprojstart,myprojend);//,VAxx(gp_Dir2d(0.,1.));
104     Standard_Real theangle = Abs(gp_Dir2d(0.,1.).Angle(gp_Vec2d(myprojstart,myprojend)));
105     if(theangle>=M_PI/2.) theangle-=M_PI/2;
106     if(theangle>=M_PI/12. && theangle <=5*M_PI/12.)
107       {
108         TColgp_Array1OfPnt2d BoxPoint (1,mymaxrect+1);
109         BoxPoint (1) = myprojstart;
110         BoxPoint(mymaxrect+1)=myprojend;
111         gp_Vec2d Vtr = MyVec/mymaxrect;
112         Standard_Integer i;
113         for ( i=2;i<=mymaxrect;i++)
114         {
115           BoxPoint (i) = BoxPoint (i-1).Translated(Vtr);
116         }
117         for (i=2;i<=mymaxrect+1;i++)
118         {
119           Bnd_Box2d curbox;
120           curbox.Set(BoxPoint(i-1));
121           curbox.Add(BoxPoint(i));
122           theareas.Append(curbox);
123         }
124       }
125     else
126       {
127         Bnd_Box2d curbox;
128         curbox.Set(myprojstart);
129         curbox.Add(myprojend);
130         theareas.Append(curbox);
131       }
132   }
133 }
134
135 //=====================================================
136 // Function : Matches
137 // Purpose  :
138 //=====================================================
139
140 Standard_Boolean Select3D_SensitiveSegment
141 ::Matches(const Standard_Real X,
142           const Standard_Real Y,
143           const Standard_Real aTol,
144           Standard_Real&  DMin)
145 {
146   gp_Pnt2d aPStart(myprojstart.x,myprojstart.y);
147   gp_Pnt2d aPEnd(myprojend.x,myprojend.y);
148   if ( ! SelectBasics_BasicTool::MatchSegment (aPStart, aPEnd, X, Y, aTol, DMin) )
149     return Standard_False;
150   return Select3D_SensitiveEntity::Matches (X, Y, aTol, DMin); // compute and validate depth
151 }
152
153 //=====================================================
154 // Function : Matches
155 // Purpose  :
156 //=====================================================
157
158 Standard_Boolean Select3D_SensitiveSegment::
159 Matches (const Standard_Real XMin,
160          const Standard_Real YMin,
161          const Standard_Real XMax,
162          const Standard_Real YMax,
163          const Standard_Real aTol)
164 {
165   Bnd_Box2d BoundBox;
166   BoundBox.Update(XMin-aTol,YMin-aTol,XMax+aTol,YMax+aTol);
167   if(BoundBox.IsOut(myprojstart)) return Standard_False;
168   if( BoundBox.IsOut(myprojend)) return Standard_False;
169   return Standard_True;
170 }
171
172 //=======================================================================
173 //function : Matches
174 //purpose  :
175 //=======================================================================
176
177 Standard_Boolean Select3D_SensitiveSegment::
178 Matches (const TColgp_Array1OfPnt2d& aPoly,
179          const Bnd_Box2d& aBox,
180          const Standard_Real aTol)
181 {
182   Standard_Real Umin,Vmin,Umax,Vmax;
183   aBox.Get(Umin,Vmin,Umax,Vmax);
184   CSLib_Class2d aClassifier2d(aPoly,aTol,aTol,Umin,Vmin,Umax,Vmax);
185
186   Standard_Integer RES = aClassifier2d.SiDans(myprojstart);
187   if (RES!=1) return Standard_False;
188
189   RES = aClassifier2d.SiDans(myprojend);
190   if (RES!=1) return Standard_False;
191
192   return Standard_True;
193 }
194
195
196 //=======================================================================
197 //function : GetConnected
198 //purpose  :
199 //=======================================================================
200
201 Handle(Select3D_SensitiveEntity) Select3D_SensitiveSegment::
202 GetConnected(const TopLoc_Location& aLoc)
203 {
204   Handle(Select3D_SensitiveSegment) NiouEnt =
205     new Select3D_SensitiveSegment(myOwnerId,mystart,myend,mymaxrect);
206
207   if(HasLocation()) NiouEnt->SetLocation(Location());
208   NiouEnt->UpdateLocation(aLoc);
209   return NiouEnt;
210 }
211
212 //=======================================================================
213 //function : Dump
214 //purpose  :
215 //=======================================================================
216
217 void Select3D_SensitiveSegment::Dump(Standard_OStream& S,const Standard_Boolean /*FullDump*/) const
218 {
219   S<<"\tSensitivePoint 3D :"<<endl;
220   if(HasLocation())
221     S<<"\t\tExisting Location"<<endl;
222   S<<"\t\t P1 [ "<<mystart.x<<" , "<<mystart.y <<" , "<<mystart.z <<" ]"<<endl;
223   S<<"\t\t P2 [ "<<myend.x<<" , "<<myend.y <<" , "<<myend.z <<" ]"<<endl;
224   S<<"\t\t maxrect ="<<mymaxrect<<endl;
225
226 }
227 //=======================================================================
228 //function : ComputeDepth
229 //purpose  :
230 //=======================================================================
231
232 Standard_Real Select3D_SensitiveSegment::ComputeDepth(const gp_Lin& EyeLine) const
233 {
234   gp_Pnt aP0 = mystart;
235   gp_Pnt aP1 = myend;
236
237   // if segment is degenerated (zero length), just use depth of the end
238   gp_XYZ aV = aP1.XYZ() - aP0.XYZ();
239   Standard_Real aNorm = aV.Modulus();
240   if ( aNorm <= gp::Resolution() )
241     return ElCLib::Parameter (EyeLine, aP0);
242
243   // else compute point on segment closest to the line
244   gp_Lin aLine (aP0, aV);
245   Extrema_ExtElC aTool (aLine, EyeLine, Precision::Angular());
246   if ( aTool.IsDone() && ! aTool.IsParallel() )
247   {
248     for (Standard_Integer i=1; i <= aTool.NbExt(); i++)
249     {
250       Extrema_POnCurv POL1, POL2;
251       aTool.Points (i, POL1, POL2);
252       // use point found by extrema only if it is inside segment
253       if ( POL1.Parameter() > 0. && POL1.Parameter() < aNorm )
254         return ElCLib::Parameter (EyeLine, POL1.Value());
255     }
256   }
257
258   // if extrema failed or lines are parallel, return closest of the segment ends
259   return Min (ElCLib::Parameter (EyeLine, aP0),
260               ElCLib::Parameter (EyeLine, aP1));
261 }