diff options
Diffstat (limited to 'source/blender/blenlib/intern/math_vector_inline.c')
-rw-r--r-- | source/blender/blenlib/intern/math_vector_inline.c | 347 |
1 files changed, 175 insertions, 172 deletions
diff --git a/source/blender/blenlib/intern/math_vector_inline.c b/source/blender/blenlib/intern/math_vector_inline.c index 9c26c1ee79a..62e582c89c4 100644 --- a/source/blender/blenlib/intern/math_vector_inline.c +++ b/source/blender/blenlib/intern/math_vector_inline.c @@ -17,7 +17,7 @@ * * The Original Code is Copyright (C) 2001-2002 by NaN Holding BV. * All rights reserved. - + * * The Original Code is: some of this file. * * ***** END GPL LICENSE BLOCK ***** @@ -37,131 +37,131 @@ MINLINE void zero_v2(float r[2]) { - r[0]= 0.0f; - r[1]= 0.0f; + r[0] = 0.0f; + r[1] = 0.0f; } MINLINE void zero_v3(float r[3]) { - r[0]= 0.0f; - r[1]= 0.0f; - r[2]= 0.0f; + r[0] = 0.0f; + r[1] = 0.0f; + r[2] = 0.0f; } MINLINE void zero_v4(float r[4]) { - r[0]= 0.0f; - r[1]= 0.0f; - r[2]= 0.0f; - r[3]= 0.0f; + r[0] = 0.0f; + r[1] = 0.0f; + r[2] = 0.0f; + r[3] = 0.0f; } MINLINE void copy_v2_v2(float r[2], const float a[2]) { - r[0]= a[0]; - r[1]= a[1]; + r[0] = a[0]; + r[1] = a[1]; } MINLINE void copy_v3_v3(float r[3], const float a[3]) { - r[0]= a[0]; - r[1]= a[1]; - r[2]= a[2]; + r[0] = a[0]; + r[1] = a[1]; + r[2] = a[2]; } MINLINE void copy_v4_v4(float r[4], const float a[4]) { - r[0]= a[0]; - r[1]= a[1]; - r[2]= a[2]; - r[3]= a[3]; + r[0] = a[0]; + r[1] = a[1]; + r[2] = a[2]; + r[3] = a[3]; } MINLINE void copy_v2_fl(float r[2], float f) { - r[0]= f; - r[1]= f; + r[0] = f; + r[1] = f; } MINLINE void copy_v3_fl(float r[3], float f) { - r[0]= f; - r[1]= f; - r[2]= f; + r[0] = f; + r[1] = f; + r[2] = f; } MINLINE void copy_v4_fl(float r[4], float f) { - r[0]= f; - r[1]= f; - r[2]= f; - r[3]= f; + r[0] = f; + r[1] = f; + r[2] = f; + r[3] = f; } /* short */ MINLINE void copy_v2_v2_char(char r[2], const char a[2]) { - r[0]= a[0]; - r[1]= a[1]; + r[0] = a[0]; + r[1] = a[1]; } MINLINE void copy_v3_v3_char(char r[3], const char a[3]) { - r[0]= a[0]; - r[1]= a[1]; - r[2]= a[2]; + r[0] = a[0]; + r[1] = a[1]; + r[2] = a[2]; } MINLINE void copy_v4_v4_char(char r[4], const char a[4]) { - r[0]= a[0]; - r[1]= a[1]; - r[2]= a[2]; - r[3]= a[3]; + r[0] = a[0]; + r[1] = a[1]; + r[2] = a[2]; + r[3] = a[3]; } /* short */ MINLINE void copy_v2_v2_short(short r[2], const short a[2]) { - r[0]= a[0]; - r[1]= a[1]; + r[0] = a[0]; + r[1] = a[1]; } MINLINE void copy_v3_v3_short(short r[3], const short a[3]) { - r[0]= a[0]; - r[1]= a[1]; - r[2]= a[2]; + r[0] = a[0]; + r[1] = a[1]; + r[2] = a[2]; } MINLINE void copy_v4_v4_short(short r[4], const short a[4]) { - r[0]= a[0]; - r[1]= a[1]; - r[2]= a[2]; - r[3]= a[3]; + r[0] = a[0]; + r[1] = a[1]; + r[2] = a[2]; + r[3] = a[3]; } /* int */ MINLINE void copy_v2_v2_int(int r[2], const int a[2]) { - r[0]= a[0]; - r[1]= a[1]; + r[0] = a[0]; + r[1] = a[1]; } MINLINE void copy_v3_v3_int(int r[3], const int a[3]) { - r[0]= a[0]; - r[1]= a[1]; - r[2]= a[2]; + r[0] = a[0]; + r[1] = a[1]; + r[2] = a[2]; } MINLINE void copy_v4_v4_int(int r[4], const int a[4]) { - r[0]= a[0]; - r[1]= a[1]; - r[2]= a[2]; - r[3]= a[3]; + r[0] = a[0]; + r[1] = a[1]; + r[2] = a[2]; + r[3] = a[3]; } /* double -> float */ @@ -208,7 +208,6 @@ MINLINE void copy_v4db_v4fl(double r[4], const float a[4]) r[3] = (double)a[3]; } - MINLINE void swap_v2_v2(float a[2], float b[2]) { SWAP(float, a[0], b[0]); @@ -255,8 +254,8 @@ MINLINE void add_v2_v2(float r[2], const float a[2]) MINLINE void add_v2_v2v2(float r[2], const float a[2], const float b[2]) { - r[0]= a[0] + b[0]; - r[1]= a[1] + b[1]; + r[0] = a[0] + b[0]; + r[1] = a[1] + b[1]; } MINLINE void add_v3_v3(float r[3], const float a[3]) @@ -268,9 +267,9 @@ MINLINE void add_v3_v3(float r[3], const float a[3]) MINLINE void add_v3_v3v3(float r[3], const float a[3], const float b[3]) { - r[0]= a[0] + b[0]; - r[1]= a[1] + b[1]; - r[2]= a[2] + b[2]; + r[0] = a[0] + b[0]; + r[1] = a[1] + b[1]; + r[2] = a[2] + b[2]; } MINLINE void sub_v2_v2(float r[2], const float a[2]) @@ -281,8 +280,8 @@ MINLINE void sub_v2_v2(float r[2], const float a[2]) MINLINE void sub_v2_v2v2(float r[2], const float a[2], const float b[2]) { - r[0]= a[0] - b[0]; - r[1]= a[1] - b[1]; + r[0] = a[0] - b[0]; + r[1] = a[1] - b[1]; } MINLINE void sub_v3_v3(float r[3], const float a[3]) @@ -294,9 +293,9 @@ MINLINE void sub_v3_v3(float r[3], const float a[3]) MINLINE void sub_v3_v3v3(float r[3], const float a[3], const float b[3]) { - r[0]= a[0] - b[0]; - r[1]= a[1] - b[1]; - r[2]= a[2] - b[2]; + r[0] = a[0] - b[0]; + r[1] = a[1] - b[1]; + r[2] = a[2] - b[2]; } MINLINE void sub_v4_v4(float r[4], const float a[4]) @@ -309,23 +308,22 @@ MINLINE void sub_v4_v4(float r[4], const float a[4]) MINLINE void sub_v4_v4v4(float r[4], const float a[4], const float b[4]) { - r[0]= a[0] - b[0]; - r[1]= a[1] - b[1]; - r[2]= a[2] - b[2]; - r[3]= a[3] - b[3]; + r[0] = a[0] - b[0]; + r[1] = a[1] - b[1]; + r[2] = a[2] - b[2]; + r[3] = a[3] - b[3]; } - MINLINE void mul_v2_fl(float r[2], float f) { - r[0]*= f; - r[1]*= f; + r[0] *= f; + r[1] *= f; } MINLINE void mul_v2_v2fl(float r[2], const float a[2], float f) { - r[0]= a[0]*f; - r[1]= a[1]*f; + r[0] = a[0] * f; + r[1] = a[1] * f; } MINLINE void mul_v3_fl(float r[3], float f) @@ -337,9 +335,9 @@ MINLINE void mul_v3_fl(float r[3], float f) MINLINE void mul_v3_v3fl(float r[3], const float a[3], float f) { - r[0]= a[0]*f; - r[1]= a[1]*f; - r[2]= a[2]*f; + r[0] = a[0] * f; + r[1] = a[1] * f; + r[2] = a[2] * f; } MINLINE void mul_v2_v2(float r[2], const float a[2]) @@ -357,58 +355,58 @@ MINLINE void mul_v3_v3(float r[3], const float a[3]) MINLINE void mul_v4_fl(float r[4], float f) { - r[0]*= f; - r[1]*= f; - r[2]*= f; - r[3]*= f; + r[0] *= f; + r[1] *= f; + r[2] *= f; + r[3] *= f; } MINLINE void madd_v2_v2fl(float r[2], const float a[2], float f) { - r[0] += a[0]*f; - r[1] += a[1]*f; + r[0] += a[0] * f; + r[1] += a[1] * f; } MINLINE void madd_v3_v3fl(float r[3], const float a[3], float f) { - r[0] += a[0]*f; - r[1] += a[1]*f; - r[2] += a[2]*f; + r[0] += a[0] * f; + r[1] += a[1] * f; + r[2] += a[2] * f; } MINLINE void madd_v3_v3v3(float r[3], const float a[3], const float b[3]) { - r[0] += a[0]*b[0]; - r[1] += a[1]*b[1]; - r[2] += a[2]*b[2]; + r[0] += a[0] * b[0]; + r[1] += a[1] * b[1]; + r[2] += a[2] * b[2]; } MINLINE void madd_v2_v2v2fl(float r[2], const float a[2], const float b[2], float f) { - r[0] = a[0] + b[0]*f; - r[1] = a[1] + b[1]*f; + r[0] = a[0] + b[0] * f; + r[1] = a[1] + b[1] * f; } MINLINE void madd_v3_v3v3fl(float r[3], const float a[3], const float b[3], float f) { - r[0] = a[0] + b[0]*f; - r[1] = a[1] + b[1]*f; - r[2] = a[2] + b[2]*f; + r[0] = a[0] + b[0] * f; + r[1] = a[1] + b[1] * f; + r[2] = a[2] + b[2] * f; } MINLINE void madd_v3_v3v3v3(float r[3], const float a[3], const float b[3], const float c[3]) { - r[0] = a[0] + b[0]*c[0]; - r[1] = a[1] + b[1]*c[1]; - r[2] = a[2] + b[2]*c[2]; + r[0] = a[0] + b[0] * c[0]; + r[1] = a[1] + b[1] * c[1]; + r[2] = a[2] + b[2] * c[2]; } MINLINE void madd_v4_v4fl(float r[4], const float a[4], float f) { - r[0] += a[0]*f; - r[1] += a[1]*f; - r[2] += a[2]*f; - r[3] += a[3]*f; + r[0] += a[0] * f; + r[1] += a[1] * f; + r[2] += a[2] * f; + r[3] += a[3] * f; } MINLINE void mul_v3_v3v3(float r[3], const float v1[3], const float v2[3]) @@ -420,98 +418,103 @@ MINLINE void mul_v3_v3v3(float r[3], const float v1[3], const float v2[3]) MINLINE void negate_v2(float r[3]) { - r[0]= -r[0]; - r[1]= -r[1]; + r[0] = -r[0]; + r[1] = -r[1]; } MINLINE void negate_v2_v2(float r[2], const float a[2]) { - r[0]= -a[0]; - r[1]= -a[1]; + r[0] = -a[0]; + r[1] = -a[1]; } MINLINE void negate_v3(float r[3]) { - r[0]= -r[0]; - r[1]= -r[1]; - r[2]= -r[2]; + r[0] = -r[0]; + r[1] = -r[1]; + r[2] = -r[2]; } MINLINE void negate_v3_v3(float r[3], const float a[3]) { - r[0]= -a[0]; - r[1]= -a[1]; - r[2]= -a[2]; + r[0] = -a[0]; + r[1] = -a[1]; + r[2] = -a[2]; } MINLINE void negate_v4(float r[4]) { - r[0]= -r[0]; - r[1]= -r[1]; - r[2]= -r[2]; - r[3]= -r[3]; + r[0] = -r[0]; + r[1] = -r[1]; + r[2] = -r[2]; + r[3] = -r[3]; } MINLINE void negate_v4_v4(float r[4], const float a[4]) { - r[0]= -a[0]; - r[1]= -a[1]; - r[2]= -a[2]; - r[3]= -a[3]; + r[0] = -a[0]; + r[1] = -a[1]; + r[2] = -a[2]; + r[3] = -a[3]; } MINLINE float dot_v2v2(const float a[2], const float b[2]) { - return a[0]*b[0] + a[1]*b[1]; + return a[0] * b[0] + a[1] * b[1]; } MINLINE float dot_v3v3(const float a[3], const float b[3]) { - return a[0]*b[0] + a[1]*b[1] + a[2]*b[2]; + return a[0] * b[0] + a[1] * b[1] + a[2] * b[2]; } MINLINE float cross_v2v2(const float a[2], const float b[2]) { - return a[0]*b[1] - a[1]*b[0]; + return a[0] * b[1] - a[1] * b[0]; } MINLINE void cross_v3_v3v3(float r[3], const float a[3], const float b[3]) { - r[0]= a[1]*b[2] - a[2]*b[1]; - r[1]= a[2]*b[0] - a[0]*b[2]; - r[2]= a[0]*b[1] - a[1]*b[0]; + r[0] = a[1] * b[2] - a[2] * b[1]; + r[1] = a[2] * b[0] - a[0] * b[2]; + r[2] = a[0] * b[1] - a[1] * b[0]; } MINLINE void star_m3_v3(float rmat[][3], float a[3]) { - rmat[0][0]= rmat[1][1]= rmat[2][2]= 0.0; - rmat[0][1]= -a[2]; - rmat[0][2]= a[1]; - rmat[1][0]= a[2]; - rmat[1][2]= -a[0]; - rmat[2][0]= -a[1]; - rmat[2][1]= a[0]; + rmat[0][0] = rmat[1][1] = rmat[2][2] = 0.0; + rmat[0][1] = -a[2]; + rmat[0][2] = a[1]; + rmat[1][0] = a[2]; + rmat[1][2] = -a[0]; + rmat[2][0] = -a[1]; + rmat[2][1] = a[0]; } /*********************************** Length **********************************/ MINLINE float len_squared_v2(const float v[2]) { - return v[0]*v[0] + v[1]*v[1]; + return v[0] * v[0] + v[1] * v[1]; +} + +MINLINE float len_squared_v3(const float v[3]) +{ + return v[0] * v[0] + v[1] * v[1] + v[2] * v[2]; } MINLINE float len_v2(const float v[2]) { - return (float)sqrtf(v[0]*v[0] + v[1]*v[1]); + return (float)sqrtf(v[0] * v[0] + v[1] * v[1]); } MINLINE float len_v2v2(const float v1[2], const float v2[2]) { float x, y; - x = v1[0]-v2[0]; - y = v1[1]-v2[1]; - return (float)sqrtf(x*x+y*y); + x = v1[0] - v2[0]; + y = v1[1] - v2[1]; + return (float)sqrtf(x * x + y * y); } MINLINE float len_v3(const float a[3]) @@ -545,15 +548,15 @@ MINLINE float len_squared_v3v3(const float a[3], const float b[3]) MINLINE float normalize_v2_v2(float r[2], const float a[2]) { - float d= dot_v2v2(a, a); + float d = dot_v2v2(a, a); if (d > 1.0e-35f) { - d= sqrtf(d); - mul_v2_v2fl(r, a, 1.0f/d); + d = sqrtf(d); + mul_v2_v2fl(r, a, 1.0f / d); } else { zero_v2(r); - d= 0.0f; + d = 0.0f; } return d; @@ -566,17 +569,17 @@ MINLINE float normalize_v2(float n[2]) MINLINE float normalize_v3_v3(float r[3], const float a[3]) { - float d= dot_v3v3(a, a); + float d = dot_v3v3(a, a); /* a larger value causes normalize errors in a * scaled down models with camera xtreme close */ if (d > 1.0e-35f) { - d= sqrtf(d); - mul_v3_v3fl(r, a, 1.0f/d); + d = sqrtf(d); + mul_v3_v3fl(r, a, 1.0f / d); } else { zero_v3(r); - d= 0.0f; + d = 0.0f; } return d; @@ -584,14 +587,14 @@ MINLINE float normalize_v3_v3(float r[3], const float a[3]) MINLINE double normalize_v3_d(double n[3]) { - double d= n[0]*n[0] + n[1]*n[1] + n[2]*n[2]; + double d = n[0] * n[0] + n[1] * n[1] + n[2] * n[2]; /* a larger value causes normalize errors in a * scaled down models with camera xtreme close */ if (d > 1.0e-35) { double mul; - d= sqrt(d); + d = sqrt(d); mul = 1.0 / d; n[0] *= mul; @@ -600,7 +603,7 @@ MINLINE double normalize_v3_d(double n[3]) } else { n[0] = n[1] = n[2] = 0; - d= 0.0; + d = 0.0; } return d; @@ -613,16 +616,16 @@ MINLINE float normalize_v3(float n[3]) MINLINE void normal_short_to_float_v3(float out[3], const short in[3]) { - out[0] = in[0]*(1.0f/32767.0f); - out[1] = in[1]*(1.0f/32767.0f); - out[2] = in[2]*(1.0f/32767.0f); + out[0] = in[0] * (1.0f / 32767.0f); + out[1] = in[1] * (1.0f / 32767.0f); + out[2] = in[2] * (1.0f / 32767.0f); } MINLINE void normal_float_to_short_v3(short out[3], const float in[3]) { - out[0] = (short)(in[0]*32767.0f); - out[1] = (short)(in[1]*32767.0f); - out[2] = (short)(in[2]*32767.0f); + out[0] = (short) (in[0] * 32767.0f); + out[1] = (short) (in[1] * 32767.0f); + out[2] = (short) (in[2] * 32767.0f); } /********************************* Comparison ********************************/ @@ -650,24 +653,24 @@ MINLINE int is_one_v3(const float v[3]) MINLINE int equals_v2v2(const float v1[2], const float v2[2]) { - return ((v1[0]==v2[0]) && (v1[1]==v2[1])); + return ((v1[0] == v2[0]) && (v1[1] == v2[1])); } MINLINE int equals_v3v3(const float v1[3], const float v2[3]) { - return ((v1[0]==v2[0]) && (v1[1]==v2[1]) && (v1[2]==v2[2])); + return ((v1[0] == v2[0]) && (v1[1] == v2[1]) && (v1[2] == v2[2])); } MINLINE int equals_v4v4(const float v1[4], const float v2[4]) { - return ((v1[0]==v2[0]) && (v1[1]==v2[1]) && (v1[2]==v2[2]) && (v1[3]==v2[3])); + return ((v1[0] == v2[0]) && (v1[1] == v2[1]) && (v1[2] == v2[2]) && (v1[3] == v2[3])); } MINLINE int compare_v3v3(const float v1[3], const float v2[3], const float limit) { - if (fabsf(v1[0]-v2[0])<limit) - if (fabsf(v1[1]-v2[1])<limit) - if (fabsf(v1[2]-v2[2])<limit) + if (fabsf(v1[0] - v2[0]) < limit) + if (fabsf(v1[1] - v2[1]) < limit) + if (fabsf(v1[2] - v2[2]) < limit) return 1; return 0; @@ -675,21 +678,21 @@ MINLINE int compare_v3v3(const float v1[3], const float v2[3], const float limit MINLINE int compare_len_v3v3(const float v1[3], const float v2[3], const float limit) { - float x,y,z; + float x, y, z; - x=v1[0]-v2[0]; - y=v1[1]-v2[1]; - z=v1[2]-v2[2]; + x = v1[0] - v2[0]; + y = v1[1] - v2[1]; + z = v1[2] - v2[2]; - return ((x*x + y*y + z*z) < (limit*limit)); + return ((x * x + y * y + z * z) < (limit * limit)); } MINLINE int compare_v4v4(const float v1[4], const float v2[4], const float limit) { - if (fabsf(v1[0]-v2[0])<limit) - if (fabsf(v1[1]-v2[1])<limit) - if (fabsf(v1[2]-v2[2])<limit) - if (fabsf(v1[3]-v2[3])<limit) + if (fabsf(v1[0] - v2[0]) < limit) + if (fabsf(v1[1] - v2[1]) < limit) + if (fabsf(v1[2] - v2[2]) < limit) + if (fabsf(v1[3] - v2[3]) < limit) return 1; return 0; @@ -697,8 +700,8 @@ MINLINE int compare_v4v4(const float v1[4], const float v2[4], const float limit MINLINE float line_point_side_v2(const float l1[2], const float l2[2], const float pt[2]) { - return ((l1[0]-pt[0]) * (l2[1]-pt[1])) - - ((l2[0]-pt[0]) * (l1[1]-pt[1])); + return (((l1[0] - pt[0]) * (l2[1] - pt[1])) - + ((l2[0] - pt[0]) * (l1[1] - pt[1]))); } #endif /* __MATH_VECTOR_INLINE_C__ */ |