forked from bartvdbraak/blender
Fix for error in normalize_vn_vn(), add len_squared_vn
This commit is contained in:
parent
e001b5b33e
commit
6aa75d3b2c
@ -285,6 +285,7 @@ void axis_sort_v3(const float axis_values[3], int r_axis_order[3]);
|
||||
/***************************** Array Functions *******************************/
|
||||
/* attempted to follow fixed length vertex functions. names could be improved*/
|
||||
double dot_vn_vn(const float *array_src_a, const float *array_src_b, const int size) ATTR_WARN_UNUSED_RESULT;
|
||||
double len_squared_vn(const float *array, const int size) ATTR_WARN_UNUSED_RESULT;
|
||||
float normalize_vn_vn(float *array_tar, const float *array_src, const int size);
|
||||
float normalize_vn(float *array_tar, const int size);
|
||||
void range_vn_i(int *array_tar, const int size, const int start);
|
||||
|
@ -665,6 +665,11 @@ void axis_sort_v3(const float axis_values[3], int r_axis_order[3])
|
||||
|
||||
/***************************** Array Functions *******************************/
|
||||
|
||||
MINLINE double sqr_db(double f)
|
||||
{
|
||||
return f * f;
|
||||
}
|
||||
|
||||
double dot_vn_vn(const float *array_src_a, const float *array_src_b, const int size)
|
||||
{
|
||||
double d = 0.0f;
|
||||
@ -677,9 +682,20 @@ double dot_vn_vn(const float *array_src_a, const float *array_src_b, const int s
|
||||
return d;
|
||||
}
|
||||
|
||||
double len_squared_vn(const float *array, const int size)
|
||||
{
|
||||
double d = 0.0f;
|
||||
const float *array_pt = array + (size - 1);
|
||||
int i = size;
|
||||
while (i--) {
|
||||
d += sqr_db((double)(*(array_pt--)));
|
||||
}
|
||||
return d;
|
||||
}
|
||||
|
||||
float normalize_vn_vn(float *array_tar, const float *array_src, const int size)
|
||||
{
|
||||
double d = dot_vn_vn(array_tar, array_src, size);
|
||||
double d = len_squared_vn(array_src, size);
|
||||
float d_sqrt;
|
||||
if (d > 1.0e-35) {
|
||||
d_sqrt = (float)sqrt(d);
|
||||
|
@ -1888,17 +1888,6 @@ static PyObject *Vector_neg(VectorObject *self)
|
||||
return Vector_CreatePyObject_alloc(tvec, self->size, Py_TYPE(self));
|
||||
}
|
||||
|
||||
/*------------------------vec_magnitude_nosqrt (internal) - for comparing only */
|
||||
static double vec_magnitude_nosqrt(const float *data, int size)
|
||||
{
|
||||
/* return (double)sqrt(dot);*/
|
||||
/* warning, line above removed because we are not using the length,
|
||||
* rather the comparing the sizes and for this we do not need the sqrt
|
||||
* for the actual length, the dot must be sqrt'd */
|
||||
return dot_vn_vn(data, data, size);
|
||||
}
|
||||
|
||||
|
||||
/*------------------------tp_richcmpr
|
||||
* returns -1 exception, 0 false, 1 true */
|
||||
static PyObject *Vector_richcmpr(PyObject *objectA, PyObject *objectB, int comparison_type)
|
||||
@ -1933,15 +1922,15 @@ static PyObject *Vector_richcmpr(PyObject *objectA, PyObject *objectB, int compa
|
||||
|
||||
switch (comparison_type) {
|
||||
case Py_LT:
|
||||
lenA = vec_magnitude_nosqrt(vecA->vec, vecA->size);
|
||||
lenB = vec_magnitude_nosqrt(vecB->vec, vecB->size);
|
||||
lenA = len_squared_vn(vecA->vec, vecA->size);
|
||||
lenB = len_squared_vn(vecB->vec, vecB->size);
|
||||
if (lenA < lenB) {
|
||||
result = 1;
|
||||
}
|
||||
break;
|
||||
case Py_LE:
|
||||
lenA = vec_magnitude_nosqrt(vecA->vec, vecA->size);
|
||||
lenB = vec_magnitude_nosqrt(vecB->vec, vecB->size);
|
||||
lenA = len_squared_vn(vecA->vec, vecA->size);
|
||||
lenB = len_squared_vn(vecB->vec, vecB->size);
|
||||
if (lenA < lenB) {
|
||||
result = 1;
|
||||
}
|
||||
@ -1956,15 +1945,15 @@ static PyObject *Vector_richcmpr(PyObject *objectA, PyObject *objectB, int compa
|
||||
result = !EXPP_VectorsAreEqual(vecA->vec, vecB->vec, vecA->size, 1);
|
||||
break;
|
||||
case Py_GT:
|
||||
lenA = vec_magnitude_nosqrt(vecA->vec, vecA->size);
|
||||
lenB = vec_magnitude_nosqrt(vecB->vec, vecB->size);
|
||||
lenA = len_squared_vn(vecA->vec, vecA->size);
|
||||
lenB = len_squared_vn(vecB->vec, vecB->size);
|
||||
if (lenA > lenB) {
|
||||
result = 1;
|
||||
}
|
||||
break;
|
||||
case Py_GE:
|
||||
lenA = vec_magnitude_nosqrt(vecA->vec, vecA->size);
|
||||
lenB = vec_magnitude_nosqrt(vecB->vec, vecB->size);
|
||||
lenA = len_squared_vn(vecA->vec, vecA->size);
|
||||
lenB = len_squared_vn(vecB->vec, vecB->size);
|
||||
if (lenA > lenB) {
|
||||
result = 1;
|
||||
}
|
||||
|
Loading…
Reference in New Issue
Block a user