55 # define VTK_DBL_MIN 2.2250738585072014e-308
57 # define VTK_DBL_MIN DBL_MIN
61 # define VTK_DBL_EPSILON 2.2204460492503131e-16
63 # define VTK_DBL_EPSILON DBL_EPSILON
66 #ifndef VTK_DBL_EPSILON
68 # define VTK_DBL_EPSILON 2.2204460492503131e-16
70 # define VTK_DBL_EPSILON DBL_EPSILON
71 # endif // DBL_EPSILON
72 #endif // VTK_DBL_EPSILON
76 class vtkMathInternal;
88 static double Pi() {
return 3.141592653589793; };
92 static float RadiansFromDegrees(
float degrees);
93 static double RadiansFromDegrees(
double degrees);
98 static float DegreesFromRadians(
float radians);
99 static double DegreesFromRadians(
double radians);
105 return static_cast<int>( f + ( f >= 0 ? 0.5 : -0.5 ) ); }
107 return static_cast<int>( f + ( f >= 0 ? 0.5 : -0.5 ) ); }
112 static int Floor(
double x);
116 static int Ceil(
double x);
121 static int CeilLog2(vtkTypeUInt64 x);
124 static bool IsPowerOfTwo(vtkTypeUInt64 x);
129 static int NearestPowerOfTwo(
int x);
133 static vtkTypeInt64 Factorial(
int N );
138 static vtkTypeInt64 Binomial(
int m,
int n );
146 static int* BeginCombination(
int m,
int n );
154 static int NextCombination(
int m,
int n,
int* combination );
157 static void FreeCombination(
int* combination);
170 static void RandomSeed(
int s);
180 static int GetSeed();
191 static double Random();
201 static double Random(
double min,
double max );
211 static double Gaussian();
222 static double Gaussian(
double mean,
double std );
226 static void Add(
const float a[3],
const float b[3],
float c[3]) {
227 for (
int i = 0; i < 3; ++i)
234 static void Add(
const double a[3],
const double b[3],
double c[3]) {
235 for (
int i = 0; i < 3; ++i)
243 static void Subtract(
const float a[3],
const float b[3],
float c[3]) {
244 for (
int i = 0; i < 3; ++i)
252 static void Subtract(
const double a[3],
const double b[3],
double c[3]) {
253 for (
int i = 0; i < 3; ++i)
262 for (
int i = 0; i < 3; ++i)
271 for (
int i = 0; i < 2; ++i)
280 for (
int i = 0; i < 3; ++i)
289 for (
int i = 0; i < 2; ++i)
296 static float Dot(
const float x[3],
const float y[3]) {
297 return ( x[0] * y[0] + x[1] * y[1] + x[2] * y[2] );};
302 static double Dot(
const double x[3],
const double y[3]) {
303 return ( x[0] * y[0] + x[1] * y[1] + x[2] * y[2] );};
308 static void Outer(
const float x[3],
const float y[3],
float A[3][3]) {
309 for (
int i=0; i < 3; i++)
310 for (
int j=0; j < 3; j++)
311 A[i][j] = x[i] * y[j];
316 static void Outer(
const double x[3],
const double y[3],
double A[3][3]) {
317 for (
int i=0; i < 3; i++)
318 for (
int j=0; j < 3; j++)
319 A[i][j] = x[i] * y[j];
324 static void Cross(
const float x[3],
const float y[3],
float z[3]);
328 static void Cross(
const double x[3],
const double y[3],
double z[3]);
332 static float Norm(
const float* x,
int n);
333 static double Norm(
const double* x,
int n);
338 static float Norm(
const float x[3]) {
339 return static_cast<float> (sqrt( x[0] * x[0] + x[1] * x[1] + x[2] * x[2] ) );};
344 static double Norm(
const double x[3]) {
345 return sqrt( x[0] * x[0] + x[1] * x[1] + x[2] * x[2] );};
349 static float Normalize(
float x[3]);
353 static double Normalize(
double x[3]);
361 static void Perpendiculars(
const double x[3],
double y[3],
double z[3],
363 static void Perpendiculars(
const float x[3],
float y[3],
float z[3],
371 static bool ProjectVector(
const float a[3],
const float b[3],
float projection[3]);
372 static bool ProjectVector(
const double a[3],
const double b[3],
double projection[3]);
380 static bool ProjectVector2D(
const float a[2],
const float b[2],
float projection[2]);
381 static bool ProjectVector2D(
const double a[2],
const double b[2],
double projection[2]);
385 static float Distance2BetweenPoints(
const float x[3],
const float y[3]);
389 static double Distance2BetweenPoints(
const double x[3],
const double y[3]);
392 static double AngleBetweenVectors(
const double v1[3],
const double v2[3]);
397 static double GaussianAmplitude(
const double variance,
const double distanceFromMean);
402 static double GaussianAmplitude(
const double mean,
const double variance,
const double position);
408 static double GaussianWeight(
const double variance,
const double distanceFromMean);
414 static double GaussianWeight(
const double mean,
const double variance,
const double position);
418 static float Dot2D(
const float x[2],
const float y[2]) {
419 return ( x[0] * y[0] + x[1] * y[1] );};
424 static double Dot2D(
const double x[2],
const double y[2]) {
425 return ( x[0] * y[0] + x[1] * y[1] );};
430 static void Outer2D(
const float x[2],
const float y[2],
float A[2][2])
432 for (
int i=0; i < 2; i++)
434 for (
int j=0; j < 2; j++)
436 A[i][j] = x[i] * y[j];
443 static void Outer2D(
const double x[2],
const double y[2],
double A[2][2])
445 for (
int i=0; i < 2; i++)
447 for (
int j=0; j < 2; j++)
449 A[i][j] = x[i] * y[j];
458 return static_cast<float> (sqrt( x[0] * x[0] + x[1] * x[1] ) );};
463 static double Norm2D(
const double x[2]) {
464 return sqrt( x[0] * x[0] + x[1] * x[1] );};
468 static float Normalize2D(
float x[2]);
472 static double Normalize2D(
double x[2]);
477 return (c1[0] * c2[1] - c2[0] * c1[1] );};
483 return (a * d - b * c);};
485 return (c1[0] * c2[1] - c2[0] * c1[1] );};
490 static void LUFactor3x3(
float A[3][3],
int index[3]);
491 static void LUFactor3x3(
double A[3][3],
int index[3]);
496 static void LUSolve3x3(
const float A[3][3],
const int index[3],
498 static void LUSolve3x3(
const double A[3][3],
const int index[3],
505 static void LinearSolve3x3(
const float A[3][3],
const float x[3],
507 static void LinearSolve3x3(
const double A[3][3],
const double x[3],
513 static void Multiply3x3(
const float A[3][3],
const float in[3],
515 static void Multiply3x3(
const double A[3][3],
const double in[3],
521 static void Multiply3x3(
const float A[3][3],
const float B[3][3],
523 static void Multiply3x3(
const double A[3][3],
const double B[3][3],
530 static void MultiplyMatrix(
double **A,
double **B,
531 unsigned int rowA,
unsigned int colA,
532 unsigned int rowB,
unsigned int colB,
539 static void Transpose3x3(
const float A[3][3],
float AT[3][3]);
540 static void Transpose3x3(
const double A[3][3],
double AT[3][3]);
546 static void Invert3x3(
const float A[3][3],
float AI[3][3]);
547 static void Invert3x3(
const double A[3][3],
double AI[3][3]);
552 static void Identity3x3(
float A[3][3]);
553 static void Identity3x3(
double A[3][3]);
558 static double Determinant3x3(
float A[3][3]);
559 static double Determinant3x3(
double A[3][3]);
564 static float Determinant3x3(
const float c1[3],
571 static double Determinant3x3(
const double c1[3],
579 static double Determinant3x3(
double a1,
double a2,
double a3,
580 double b1,
double b2,
double b3,
581 double c1,
double c2,
double c3);
589 static void QuaternionToMatrix3x3(
const float quat[4],
float A[3][3]);
590 static void QuaternionToMatrix3x3(
const double quat[4],
double A[3][3]);
599 static void Matrix3x3ToQuaternion(
const float A[3][3],
float quat[4]);
600 static void Matrix3x3ToQuaternion(
const double A[3][3],
double quat[4]);
607 static void MultiplyQuaternion(
const float q1[4],
const float q2[4],
float q[4] );
608 static void MultiplyQuaternion(
const double q1[4],
const double q2[4],
double q[4] );
615 static void Orthogonalize3x3(
const float A[3][3],
float B[3][3]);
616 static void Orthogonalize3x3(
const double A[3][3],
double B[3][3]);
624 static void Diagonalize3x3(
const float A[3][3],
float w[3],
float V[3][3]);
625 static void Diagonalize3x3(
const double A[3][3],
double w[3],
double V[3][3]);
636 static void SingularValueDecomposition3x3(
const float A[3][3],
637 float U[3][3],
float w[3],
639 static void SingularValueDecomposition3x3(
const double A[3][3],
640 double U[3][3],
double w[3],
648 static int SolveLinearSystem(
double **A,
double *x,
int size);
653 static int InvertMatrix(
double **A,
double **AI,
int size);
658 static int InvertMatrix(
double **A,
double **AI,
int size,
659 int *tmp1Size,
double *tmp2Size);
677 static int LUFactorLinearSystem(
double **A,
int *
index,
int size);
682 static int LUFactorLinearSystem(
double **A,
int *
index,
int size,
693 static void LUSolveLinearSystem(
double **A,
int *
index,
694 double *x,
int size);
704 static double EstimateMatrixCondition(
double **A,
int size);
712 static int Jacobi(
float **a,
float *w,
float **v);
713 static int Jacobi(
double **a,
double *w,
double **v);
723 static int JacobiN(
float **a,
int n,
float *w,
float **v);
724 static int JacobiN(
double **a,
int n,
double *w,
double **v);
738 static int SolveHomogeneousLeastSquares(
int numberOfSamples,
double **xt,
int xOrder,
755 static int SolveLeastSquares(
int numberOfSamples,
double **xt,
int xOrder,
756 double **yt,
int yOrder,
double **mt,
int checkHomogeneous=1);
764 static void RGBToHSV(
const float rgb[3],
float hsv[3])
765 { RGBToHSV(rgb[0], rgb[1], rgb[2], hsv, hsv+1, hsv+2); }
766 static void RGBToHSV(
float r,
float g,
float b,
float *h,
float *s,
float *v);
767 static double* RGBToHSV(
const double rgb[3]);
768 static double* RGBToHSV(
double r,
double g,
double b);
769 static void RGBToHSV(
const double rgb[3],
double hsv[3])
770 { RGBToHSV(rgb[0], rgb[1], rgb[2], hsv, hsv+1, hsv+2); }
771 static void RGBToHSV(
double r,
double g,
double b,
double *h,
double *s,
double *v);
779 static void HSVToRGB(
const float hsv[3],
float rgb[3])
780 { HSVToRGB(hsv[0], hsv[1], hsv[2], rgb, rgb+1, rgb+2); }
781 static void HSVToRGB(
float h,
float s,
float v,
float *r,
float *g,
float *b);
782 static double* HSVToRGB(
const double hsv[3]);
783 static double* HSVToRGB(
double h,
double s,
double v);
784 static void HSVToRGB(
const double hsv[3],
double rgb[3])
785 { HSVToRGB(hsv[0], hsv[1], hsv[2], rgb, rgb+1, rgb+2); }
786 static void HSVToRGB(
double h,
double s,
double v,
double *r,
double *g,
double *b);
791 static void LabToXYZ(
const double lab[3],
double xyz[3]) {
792 LabToXYZ(lab[0], lab[1], lab[2], xyz+0, xyz+1, xyz+2);
794 static void LabToXYZ(
double L,
double a,
double b,
795 double *x,
double *y,
double *z);
796 static double *LabToXYZ(
const double lab[3]);
801 static void XYZToLab(
const double xyz[3],
double lab[3]) {
802 XYZToLab(xyz[0], xyz[1], xyz[2], lab+0, lab+1, lab+2);
804 static void XYZToLab(
double x,
double y,
double z,
805 double *L,
double *a,
double *b);
806 static double *XYZToLab(
const double xyz[3]);
811 static void XYZToRGB(
const double xyz[3],
double rgb[3]) {
812 XYZToRGB(xyz[0], xyz[1], xyz[2], rgb+0, rgb+1, rgb+2);
814 static void XYZToRGB(
double x,
double y,
double z,
815 double *r,
double *g,
double *b);
816 static double *XYZToRGB(
const double xyz[3]);
821 static void RGBToXYZ(
const double rgb[3],
double xyz[3]) {
822 RGBToXYZ(rgb[0], rgb[1], rgb[2], xyz+0, xyz+1, xyz+2);
824 static void RGBToXYZ(
double r,
double g,
double b,
825 double *x,
double *y,
double *z);
826 static double *RGBToXYZ(
const double rgb[3]);
833 static void RGBToLab(
const double rgb[3],
double lab[3]) {
834 RGBToLab(rgb[0], rgb[1], rgb[2], lab+0, lab+1, lab+2);
836 static void RGBToLab(
double red,
double green,
double blue,
837 double *L,
double *a,
double *b);
838 static double *RGBToLab(
const double rgb[3]);
843 static void LabToRGB(
const double lab[3],
double rgb[3]) {
844 LabToRGB(lab[0], lab[1], lab[2], rgb+0, rgb+1, rgb+2);
846 static void LabToRGB(
double L,
double a,
double b,
847 double *red,
double *green,
double *blue);
848 static double *LabToRGB(
const double lab[3]);
866 if ( bounds[1]-bounds[0]<0.0 )
877 static void ClampValue(
double *
value,
const double range[2]);
878 static void ClampValue(
double value,
const double range[2],
double *clamped_value);
879 static void ClampValues(
880 double *values,
int nb_values,
const double range[2]);
881 static void ClampValues(
882 const double *values,
int nb_values,
const double range[2],
double *clamped_values);
889 static double ClampAndNormalizeValue(
double value,
890 const double range[2]);
900 static int GetScalarTypeFittingRange(
901 double range_min,
double range_max,
902 double scale = 1.0,
double shift = 0.0);
912 static int GetAdjustedScalarRange(
918 static int ExtentIsWithinOtherExtent(
int extent1[6],
int extent2[6]);
923 static int BoundsIsWithinOtherBounds(
double bounds1[6],
double bounds2[6],
double delta[3]);
928 static int PointIsWithinBounds(
double point[3],
double bounds[6],
double delta[3]);
938 static double Solve3PointCircle(
const double p1[3],
const double p2[3],
const double p3[3],
double center[3]);
944 static double NegInf();
951 static int IsInf(
double x);
955 static int IsNan(
double x);
959 static bool IsFinite(
double x);
968 void operator=(
const vtkMath&);
974 return x * 0.017453292f;
980 return x * 0.017453292519943295;
986 return x * 57.2957795131f;
992 return x * 57.29577951308232;
998 return ((x != 0) & ((x & (x - 1)) == 0));
1005 unsigned int z = ((x > 0) ? x - 1 : 0);
1011 return static_cast<int>(z + 1);
1019 int i =
static_cast<int>(x);
1020 return i - ( i > x );
1028 int i =
static_cast<int>(x);
1029 return i + ( i < x );
1038 for (
int i=0; i < 3; i++)
1052 for (
int i=0; i < 3; i++)
1066 for (
int i=0; i < 2; i++)
1080 for (
int i=0; i < 2; i++)
1093 return c1[0] * c2[1] * c3[2] + c2[0] * c3[1] * c1[2] + c3[0] * c1[1] * c2[2] -
1094 c1[0] * c3[1] * c2[2] - c2[0] * c1[1] * c3[2] - c3[0] * c2[1] * c1[2];
1102 return c1[0] * c2[1] * c3[2] + c2[0] * c3[1] * c1[2] + c3[0] * c1[1] * c2[2] -
1103 c1[0] * c3[1] * c2[2] - c2[0] * c1[1] * c3[2] - c3[0] * c2[1] * c1[2];
1108 double b1,
double b2,
double b3,
1109 double c1,
double c2,
double c3)
1120 return ( ( x[0] - y[0] ) * ( x[0] - y[0] )
1121 + ( x[1] - y[1] ) * ( x[1] - y[1] )
1122 + ( x[2] - y[2] ) * ( x[2] - y[2] ) );
1129 return ( ( x[0] - y[0] ) * ( x[0] - y[0] )
1130 + ( x[1] - y[1] ) * ( x[1] - y[1] )
1131 + ( x[2] - y[2] ) * ( x[2] - y[2] ) );
1138 float Zx = x[1] * y[2] - x[2] * y[1];
1139 float Zy = x[2] * y[0] - x[0] * y[2];
1140 float Zz = x[0] * y[1] - x[1] * y[0];
1141 z[0] = Zx; z[1] = Zy; z[2] = Zz;
1148 double Zx = x[1] * y[2] - x[2] * y[1];
1149 double Zy = x[2] * y[0] - x[0] * y[2];
1150 double Zz = x[0] * y[1] - x[1] * y[0];
1151 z[0] = Zx; z[1] = Zy; z[2] = Zz;
1159 return A[0][0] * A[1][1] * A[2][2] + A[1][0] * A[2][1] * A[0][2] +
1160 A[2][0] * A[0][1] * A[1][2] - A[0][0] * A[2][1] * A[1][2] -
1161 A[1][0] * A[0][1] * A[2][2] - A[2][0] * A[1][1] * A[0][2];
1182 if (*value < range[0])
1186 else if (*value > range[1])
1195 double value,
const double range[2],
double *clamped_value)
1197 if (range && clamped_value)
1199 if (value < range[0])
1201 *clamped_value = range[0];
1203 else if (value > range[1])
1205 *clamped_value = range[1];
1209 *clamped_value =
value;
1216 const double range[2])
1218 assert(
"pre: valid_range" && range[0]<=range[1]);
1221 if(range[0]==range[1])
1245 result=( result - range[0] ) / ( range[1] - range[0] );
1248 assert(
"post: valid_result" && result>=0.0 && result<=1.0);
1254 #if defined(VTK_HAS_ISINF) || defined(VTK_HAS_STD_ISINF)
1255 #define VTK_MATH_ISINF_IS_INLINE
1258 #if defined(VTK_HAS_STD_ISINF)
1259 return std::isinf(x);
1261 return (isinf(x) != 0);
1267 #if defined(VTK_HAS_ISNAN) || defined(VTK_HAS_STD_ISNAN)
1268 #define VTK_MATH_ISNAN_IS_INLINE
1271 #if defined(VTK_HAS_STD_ISNAN)
1272 return std::isnan(x);
1274 return (isnan(x) != 0);
1280 #if defined(VTK_HAS_ISFINITE) || defined(VTK_HAS_STD_ISFINITE) || defined(VTK_HAS_FINITE)
1281 #define VTK_MATH_ISFINITE_IS_INLINE
1284 #if defined(VTK_HAS_STD_ISFINITE)
1285 return std::isfinite(x);
1286 #elif defined(VTK_HAS_ISFINITE)
1287 return (isfinite(x) != 0);
1289 return (finite(x) != 0);
static void MultiplyScalar2D(float a[2], float s)
static bool IsFinite(double x)
static float Dot2D(const float x[2], const float y[2])
static void Cross(const float x[3], const float y[3], float z[3])
static int IsInf(double x)
abstract base class for most VTK objects
static void LabToXYZ(const double lab[3], double xyz[3])
static double Norm(const double x[3])
static void ClampValue(double *value, const double range[2])
static bool IsPowerOfTwo(vtkTypeUInt64 x)
static void Outer(const float x[3], const float y[3], float A[3][3])
static float Determinant2x2(const float c1[2], const float c2[2])
#define VTKCOMMONCORE_EXPORT
static void RGBToHSV(const double rgb[3], double hsv[3])
static int Round(float f)
static void RGBToHSV(const float rgb[3], float hsv[3])
static int AreBoundsInitialized(double bounds[6])
static double ClampAndNormalizeValue(double value, const double range[2])
static void Outer(const double x[3], const double y[3], double A[3][3])
static void Add(const double a[3], const double b[3], double c[3])
static void XYZToRGB(const double xyz[3], double rgb[3])
static float Norm2D(const float x[2])
static float Normalize2D(float x[2])
static void UninitializeBounds(double bounds[6])
static int NearestPowerOfTwo(int x)
virtual void PrintSelf(ostream &os, vtkIndent indent)
static void RGBToXYZ(const double rgb[3], double xyz[3])
a simple class to control print indentation
static float Dot(const float x[3], const float y[3])
static void Subtract(const float a[3], const float b[3], float c[3])
static void Subtract(const double a[3], const double b[3], double c[3])
static int Floor(double x)
abstract superclass for arrays of numeric data
static double Determinant2x2(double a, double b, double c, double d)
static float RadiansFromDegrees(float degrees)
static void HSVToRGB(const double hsv[3], double rgb[3])
Park and Miller Sequence of pseudo random numbers.
static void MultiplyScalar(double a[3], double s)
static double Determinant3x3(float A[3][3])
static float Normalize(float x[3])
static void RGBToLab(const double rgb[3], double lab[3])
static float DegreesFromRadians(float radians)
static void Outer2D(const double x[2], const double y[2], double A[2][2])
static void Outer2D(const float x[2], const float y[2], float A[2][2])
static int Ceil(double x)
performs common math operations
static double Dot2D(const double x[2], const double y[2])
static double Dot(const double x[3], const double y[3])
static void MultiplyScalar(float a[3], float s)
static void HSVToRGB(const float hsv[3], float rgb[3])
static double Norm2D(const double x[2])
static int Round(double f)
VTKWRAPPINGJAVA_EXPORT jlong q(JNIEnv *env, jobject obj)
static void MultiplyScalar2D(double a[2], double s)
static void LabToRGB(const double lab[3], double rgb[3])
static vtkMathInternal Internal
double vtkDeterminant3x3(T A[3][3])
static float Norm(const float *x, int n)
static float Distance2BetweenPoints(const float x[3], const float y[3])
static int IsNan(double x)
Gaussian sequence of pseudo random numbers implemented with the Box-Mueller transform.
static double Determinant2x2(const double c1[2], const double c2[2])
static float Norm(const float x[3])
static void Add(const float a[3], const float b[3], float c[3])
represent and manipulate 3D points
static void XYZToLab(const double xyz[3], double lab[3])