makeUniform（mat）

admin1

1. AcGeMatrix3d &makeUniformNoRounding(AcGeMatrix3d &mat);
   
2. 
   
3. // Make mat uniform
   
4. // Preserves:
   
5. //        + direction of the Z-axis
   
6. //        + ZX-plane
   
7. //  + "average" length of the base vectors
   
8. //  + all elements m[i][3] und m[3][j]
   
9. AcGeMatrix3d &makeUniform(AcGeMatrix3d &mat)
   
10. {
    
11.         // set values to 0 / 1 that only differ by 1e-12 from 0 / 1
    
12.         int i, j;
    
13.         double *dval;
    
14.         for (i = 0; i < 3; i++)
    
15.         {
    
16.                 for (j = 0; j < 3; j++)
    
17.                 {
    
18.                         dval = &(mat(i, j));
    
19.                         if (fabs(*dval) < 1e-12)
    
20.                                 *dval = 0.0;
    
21.                         else if (fabs(*dval - 1.0) < 1e-6)
    
22.                                 *dval = 1.0;
    
23.                 }
    
24.                 dval = &(mat(i, 3));
    
25.                 if (fabs(*dval) < 1e-12)
    
26.                         *dval = 0.0;
    
27.         }
    
28.         makeUniformNoRounding(mat);
    
29.         return mat;
    
30. }
    
31. 
    
32. bool approx(const double &x1, const double &x2, const double &tol)
    
33. {
    
34.         int        exp1, exp2;
    
35.         double mant1 = frexp(x1, &exp1);
    
36.         double mant2 = frexp(x2, &exp2);
    
37. 
    
38.         if (abs(exp1 - exp2) > 1)
    
39.                 return FALSE;        // exp1 > 2*exp2 or exp2 > 2*exp1
    
40.         else if (exp1 > exp2)
    
41.                 mant2 *= 2;        // to same exponent
    
42.         else if (exp2 > exp1)
    
43.                 mant1 *= 2;
    
44. 
    
45.         return (fabs(mant1 - mant2) < tol);
    
46. }
    
47. 
    
48. AcGeMatrix3d &makeUniformNoRounding(AcGeMatrix3d &mat)
    
49. {
    
50.         AcGePoint3d origin;
    
51.         AcGeVector3d eX, eY, eZ;
    
52.         mat.getCoordSystem(origin, eX, eY, eZ);
    
53.         bool bSetKoSys = false;
    
54.         double        spXY = eX.dotProduct(eY),
    
55.                 spZX = eZ.dotProduct(eX),
    
56.                 spYZ = eY.dotProduct(eZ);
    
57. 
    
58.         // make pairwise perpendicular
    
59.         if (spXY != 0.0 || spZX != 0.0 || spYZ != 0.0)
    
60.         {
    
61.                 // keep eZ
    
62.                 AcGeVector3d eZnorm(eZ), eYnorm;
    
63.                 eZnorm.normalize();
    
64.                 eX -= eZnorm * eX.dotProduct(eZnorm);
    
65. 
    
66.                 // eX must be perpendicular to eY and eZ
    
67.                 eYnorm = eX.crossProduct(eZnorm).normalize();
    
68.                 double lY = eY.dotProduct(eYnorm);
    
69.                 eY = lY * eYnorm;
    
70.                 bSetKoSys = true;
    
71.         }
    
72.        
    
73.         double        slX = eX.dotProduct(eX), // = eX.lengthSqrd()
    
74.                 slY = eY.dotProduct(eY),
    
75.                 slZ = eZ.dotProduct(eZ);
    
76. 
    
77.         // make same length
    
78.         if (!approx(slX, slY, 1e-12) || !approx(slX, slZ, 1e-12))
    
79.         {
    
80.                 double lav = sqrt((slX + slY + slZ) / 3.0); // average length
    
81.                 eX.normalize(); eX *= lav;
    
82.                 eY.normalize(); eY *= lav;
    
83.                 eZ.normalize(); eZ *= lav;
    
84.                 bSetKoSys = true;
    
85.         }
    
86. 
    
87.         if (bSetKoSys)
    
88.                 mat.setCoordSystem(origin, eX, eY, eZ);
    
89. 
    
90.         return mat;
    
91. }

复制代码

1. Adesk::Boolean AcGeMatrix3d::isUniScaledOrtho(const AcGeTol& tol = AcGeContext::gTol()

复制代码