makeUniform（mat）

admin1

1. AcGeMatrix3d &makeUniformNoRounding(AcGeMatrix3d &mat);
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. }
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);
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;
45.         return (fabs(mant1 - mant2) < tol);
46. }
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);
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);
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);
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.         }
87.         if (bSetKoSys)
88.                 mat.setCoordSystem(origin, eX, eY, eZ);
90.         return mat;
91. }

复制代码

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

复制代码