Integration of OCCT 6.5.0 from SVN

src/IntImp/IntImp_ComputeTangence.cxx

@@ -0,0 +1,159 @@
+//-- File IntImp_ComputeTangence.cxx
+
+#include <IntImp_ConstIsoparametric.hxx>
+
+static const IntImp_ConstIsoparametric staticChoixRef [4] = {
+IntImp_UIsoparametricOnCaro1,
+IntImp_VIsoparametricOnCaro1,
+IntImp_UIsoparametricOnCaro2,
+IntImp_VIsoparametricOnCaro2,
+};
+
+Standard_EXPORT const IntImp_ConstIsoparametric *ChoixRef = staticChoixRef ;
+
+#include <IntImp_ComputeTangence.hxx>
+
+//Standard_EXPORT IntImp_ConstIsoparametric *ChoixRef = staticChoixRef ;
+
+Standard_Boolean IntImp_ComputeTangence(const gp_Vec DPuv[],
+					const Standard_Real EpsUV[],
+					Standard_Real Tgduv[],
+					IntImp_ConstIsoparametric TabIso[]) 
+//                 arguments d entree:
+// DPuv [0] =derivee en u sur caro 1    
+// DPuv [1] =derivee en v sur caro 1
+// DPuv [2] =derivee en u sur caro 2
+// DPuv [3] =derivee en v sur caro 2
+// EpsUV[0] tolerance en u sur caro1
+// EpsUV[1] tolerance en v sur caro1
+// EpsUV[2] tolerance en u sur caro2
+// EpsUV[3] tolerance en v sur caro2
+//                 arguments de sortie:
+// Tgduv[0] composante sup dp/du de caro1 de la tangente a l intersection
+// Tgduv[1] composante sup dp/dv de caro1 de la tangente a l intersection
+// Tgduv[2] composante sup dp/du de caro2 de la tangente a l intersection
+// Tgduv[3] composante sup dp/dv de caro2 de la tangente a l intersection
+// TabIso[0...3] meilleure iso range par ordre decroissant candidate 
+//               a l intersection
+//         algorithme
+// calculer la tangente a l 'intersection ;en utilisant la propriete suivante
+// du produit scalaire a^(b^c)=b(ac)-c(ab) on obtient les composantes de la
+// tangente a l intersection dans les 2 plans tangents (t=n1^n2 ou n1 normale
+// au premier carreau n2 au 2ieme)
+// on s assurera que les plans tangents des 2 carreaux ne sont pas //
+// les composantes de l intersection dans les plans tangents permettent de 
+//determiner l  angle entre les isoparametriques d un carreau avec le carreau
+//reciproque 
+//on triera par ordre croissant les cosinus :le plus petit cosinus determine le
+// meilleure angle donc la meilleure iso a choisir pour trouver
+// l intersection 
+
+{
+   Standard_Real NormDuv[4];
+//   Standard_Real Tampon;
+//   Standard_Integer Irang[4],i,j;
+   Standard_Integer i;
+
+
+   NormDuv[0] = DPuv[0].Magnitude();    
+   if(NormDuv[0]<=1e-16) { 
+     return(Standard_True);
+   } 
+   NormDuv[1] = DPuv[1].Magnitude();
+   if(NormDuv[1]<=1e-16) { 
+     return(Standard_True);
+   } 
+   NormDuv[2] = DPuv[2].Magnitude();
+   if(NormDuv[2]<=1e-16) { 
+     return(Standard_True);
+   } 
+   NormDuv[3] = DPuv[3].Magnitude();
+   if(NormDuv[3]<=1e-16) { 
+     return(Standard_True);
+   } 
+   
+   
+
+   gp_Vec N1 = DPuv[0];
+   N1.Cross(DPuv[1]);
+
+   gp_Vec N2 = DPuv[2];
+   N2.Cross(DPuv[3]);
+
+   N1.Normalize();
+   N2.Normalize();
+
+   Tgduv[0] = -DPuv[1].Dot(N2);
+   Tgduv[1] =  DPuv[0].Dot(N2);
+   Tgduv[2] =  DPuv[3].Dot(N1); 
+   Tgduv[3] = -DPuv[2].Dot(N1);
+
+
+   Standard_Boolean tangent = (Abs(Tgduv[0]) <= EpsUV[0]*NormDuv[1] &&
+			       Abs(Tgduv[1]) <= EpsUV[1]*NormDuv[0] &&
+			       Abs(Tgduv[2]) <= EpsUV[2]*NormDuv[3] &&
+			       Abs(Tgduv[3]) <= EpsUV[3]*NormDuv[2]  );
+   if(!tangent) { 
+     Standard_Real t=N1.Dot(N2);
+     if(t<0.0) t=-t;
+     if(t>0.999999999) { 
+       tangent=Standard_True; 
+     }
+   }
+
+   if (!tangent) {
+     NormDuv[0] = Abs(Tgduv[1]) /NormDuv[0]; //iso u sur caro1
+     NormDuv[1] = Abs(Tgduv[0]) /NormDuv[1]; //iso v sur caro1
+     NormDuv[2] = Abs(Tgduv[3]) /NormDuv[2]; // iso u sur caro2
+     NormDuv[3] = Abs(Tgduv[2]) /NormDuv[3]; //iso v sur caro2
+
+
+
+     //-- Tri sur NormDuv  ( en para. avec ChoixRef ) 
+     Standard_Boolean triOk = Standard_False;
+     Standard_Real t;
+     IntImp_ConstIsoparametric ti;
+     for ( i=0;i<=3;i++)  TabIso[i] = ChoixRef[i];
+     do { 
+       triOk = Standard_True;
+       for(i=1;i<=3;i++) { 
+	 if(NormDuv[i-1]>NormDuv[i]) { 
+	   triOk=Standard_False;
+	   t=NormDuv[i]; 
+	   NormDuv[i]=NormDuv[i-1];
+	   NormDuv[i-1]=t;
+	   
+	   ti = TabIso[i];
+	   TabIso[i] = TabIso[i-1];
+	   TabIso[i-1] = ti;
+	 }
+       }
+     }
+     while(!triOk);
+
+
+#if 0     
+     // trier par ordre croissant le tableau NormDuv
+     Standard_Integer II;
+     for (j =0;j<=3;j++) Irang[j]=j;
+     for (j =0;j<=3;j++) {
+       Tampon = NormDuv[j];
+       II=j;
+       for (i =j+1;i<=3;i++) {
+         if (NormDuv[i] < Tampon) {
+	   Tampon = NormDuv[i];
+	   II = i;
+         }
+       }
+       Irang[j] = Irang[II];
+       Irang[II] = j;
+       NormDuv[II] = NormDuv[j];
+       NormDuv[j] = Tampon;
+     }
+     for (j=0; j<=3;j++) TabIso[j]=ChoixRef[Irang[j]];     
+#endif
+   }
+   return tangent;
+ }
+
+