make asserts that check for unit length vectors into a macro.
this was really not nice logic to try to fit into an assert.
This commit is contained in:
@@ -217,5 +217,25 @@ extern double round(double x);
|
||||
|
||||
double double_round(double x, int ndigits);
|
||||
|
||||
#endif /* __BLI_MATH_BASE_H__ */
|
||||
/* asserts, some math functions expect normalized inputs
|
||||
* check the vector is unit length, or zero length (which can't be helped in some cases).
|
||||
*/
|
||||
#ifdef DEBUG
|
||||
# define BLI_ASSERT_UNIT_EPSILON 0.0001f
|
||||
# define BLI_ASSERT_UNIT_V3(v) { \
|
||||
const float _test_unit = len_squared_v3(v); \
|
||||
BLI_assert((fabsf(_test_unit - 1.0f) < BLI_ASSERT_UNIT_EPSILON) || \
|
||||
(fabsf(_test_unit) < BLI_ASSERT_UNIT_EPSILON)); \
|
||||
} (void)0
|
||||
|
||||
# define BLI_ASSERT_UNIT_V2(v) { \
|
||||
const float _test_unit = len_squared_v2(v); \
|
||||
BLI_assert((fabsf(_test_unit - 1.0f) < BLI_ASSERT_UNIT_EPSILON) || \
|
||||
(fabsf(_test_unit) < BLI_ASSERT_UNIT_EPSILON)); \
|
||||
} (void)0
|
||||
#else
|
||||
# define BLI_ASSERT_UNIT_V2(v) (void)0
|
||||
# define BLI_ASSERT_UNIT_V3(v) (void)0
|
||||
#endif
|
||||
|
||||
#endif /* __BLI_MATH_BASE_H__ */
|
||||
|
||||
@@ -2001,10 +2001,7 @@ bool axis_dominant_v3_to_m3(float r_mat[3][3], const float normal[3])
|
||||
float angle;
|
||||
|
||||
/* double check they are normalized */
|
||||
#ifdef DEBUG
|
||||
float test;
|
||||
BLI_assert(fabsf((test = len_squared_v3(normal)) - 1.0f) < 0.0001f || fabsf(test) < 0.0001f);
|
||||
#endif
|
||||
BLI_ASSERT_UNIT_V3(normal);
|
||||
|
||||
cross_v3_v3v3(axis, normal, up);
|
||||
angle = saacos(dot_v3v3(normal, up));
|
||||
|
||||
@@ -235,11 +235,8 @@ float angle_signed_v2v2(const float v1[2], const float v2[2])
|
||||
float angle_normalized_v3v3(const float v1[3], const float v2[3])
|
||||
{
|
||||
/* double check they are normalized */
|
||||
#ifdef DEBUG
|
||||
float test;
|
||||
BLI_assert(fabsf((test = len_squared_v3(v1)) - 1.0f) < 0.0001f || fabsf(test) < 0.0001f);
|
||||
BLI_assert(fabsf((test = len_squared_v3(v2)) - 1.0f) < 0.0001f || fabsf(test) < 0.0001f);
|
||||
#endif
|
||||
BLI_ASSERT_UNIT_V3(v1);
|
||||
BLI_ASSERT_UNIT_V3(v2);
|
||||
|
||||
/* this is the same as acos(dot_v3v3(v1, v2)), but more accurate */
|
||||
if (dot_v3v3(v1, v2) < 0.0f) {
|
||||
@@ -258,11 +255,8 @@ float angle_normalized_v3v3(const float v1[3], const float v2[3])
|
||||
float angle_normalized_v2v2(const float v1[2], const float v2[2])
|
||||
{
|
||||
/* double check they are normalized */
|
||||
#ifdef DEBUG
|
||||
float test;
|
||||
BLI_assert(fabsf((test = len_squared_v2(v1)) - 1.0f) < 0.0001f || fabsf(test) < 0.0001f);
|
||||
BLI_assert(fabsf((test = len_squared_v2(v2)) - 1.0f) < 0.0001f || fabsf(test) < 0.0001f);
|
||||
#endif
|
||||
BLI_ASSERT_UNIT_V2(v1);
|
||||
BLI_ASSERT_UNIT_V2(v2);
|
||||
|
||||
/* this is the same as acos(dot_v3v3(v1, v2)), but more accurate */
|
||||
if (dot_v2v2(v1, v2) < 0.0f) {
|
||||
@@ -449,10 +443,7 @@ void rotate_normalized_v3_v3v3fl(float r[3], const float p[3], const float axis[
|
||||
const float sintheta = sin(angle);
|
||||
|
||||
/* double check they are normalized */
|
||||
#ifdef DEBUG
|
||||
float test;
|
||||
BLI_assert(fabsf((test = len_squared_v3(axis)) - 1.0f) < 0.0001f || fabsf(test) < 0.0001f);
|
||||
#endif
|
||||
BLI_ASSERT_UNIT_V3(axis);
|
||||
|
||||
r[0] = ((costheta + (1 - costheta) * axis[0] * axis[0]) * p[0]) +
|
||||
(((1 - costheta) * axis[0] * axis[1] - axis[2] * sintheta) * p[1]) +
|
||||
|
||||
Reference in New Issue
Block a user