occt/src/IntImp/IntImp_ComputeTangence.cxx

//-- 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;
 }