Merge pull request #30382 from simonpuchert/geo-opt
Some small optimizations in core/math/geometry.h.
This commit is contained in:
commit
44db85d6f6
1 changed files with 14 additions and 18 deletions
|
@ -455,16 +455,15 @@ public:
|
||||||
|
|
||||||
Vector3 p = p_point - p_segment[0];
|
Vector3 p = p_point - p_segment[0];
|
||||||
Vector3 n = p_segment[1] - p_segment[0];
|
Vector3 n = p_segment[1] - p_segment[0];
|
||||||
real_t l = n.length();
|
real_t l2 = n.length_squared();
|
||||||
if (l < 1e-10)
|
if (l2 < 1e-20)
|
||||||
return p_segment[0]; // both points are the same, just give any
|
return p_segment[0]; // both points are the same, just give any
|
||||||
n /= l;
|
|
||||||
|
|
||||||
real_t d = n.dot(p);
|
real_t d = n.dot(p) / l2;
|
||||||
|
|
||||||
if (d <= 0.0)
|
if (d <= 0.0)
|
||||||
return p_segment[0]; // before first point
|
return p_segment[0]; // before first point
|
||||||
else if (d >= l)
|
else if (d >= 1.0)
|
||||||
return p_segment[1]; // after first point
|
return p_segment[1]; // after first point
|
||||||
else
|
else
|
||||||
return p_segment[0] + n * d; // inside
|
return p_segment[0] + n * d; // inside
|
||||||
|
@ -474,12 +473,11 @@ public:
|
||||||
|
|
||||||
Vector3 p = p_point - p_segment[0];
|
Vector3 p = p_point - p_segment[0];
|
||||||
Vector3 n = p_segment[1] - p_segment[0];
|
Vector3 n = p_segment[1] - p_segment[0];
|
||||||
real_t l = n.length();
|
real_t l2 = n.length_squared();
|
||||||
if (l < 1e-10)
|
if (l2 < 1e-20)
|
||||||
return p_segment[0]; // both points are the same, just give any
|
return p_segment[0]; // both points are the same, just give any
|
||||||
n /= l;
|
|
||||||
|
|
||||||
real_t d = n.dot(p);
|
real_t d = n.dot(p) / l2;
|
||||||
|
|
||||||
return p_segment[0] + n * d; // inside
|
return p_segment[0] + n * d; // inside
|
||||||
}
|
}
|
||||||
|
@ -488,16 +486,15 @@ public:
|
||||||
|
|
||||||
Vector2 p = p_point - p_segment[0];
|
Vector2 p = p_point - p_segment[0];
|
||||||
Vector2 n = p_segment[1] - p_segment[0];
|
Vector2 n = p_segment[1] - p_segment[0];
|
||||||
real_t l = n.length();
|
real_t l2 = n.length_squared();
|
||||||
if (l < 1e-10)
|
if (l2 < 1e-20)
|
||||||
return p_segment[0]; // both points are the same, just give any
|
return p_segment[0]; // both points are the same, just give any
|
||||||
n /= l;
|
|
||||||
|
|
||||||
real_t d = n.dot(p);
|
real_t d = n.dot(p) / l2;
|
||||||
|
|
||||||
if (d <= 0.0)
|
if (d <= 0.0)
|
||||||
return p_segment[0]; // before first point
|
return p_segment[0]; // before first point
|
||||||
else if (d >= l)
|
else if (d >= 1.0)
|
||||||
return p_segment[1]; // after first point
|
return p_segment[1]; // after first point
|
||||||
else
|
else
|
||||||
return p_segment[0] + n * d; // inside
|
return p_segment[0] + n * d; // inside
|
||||||
|
@ -521,12 +518,11 @@ public:
|
||||||
|
|
||||||
Vector2 p = p_point - p_segment[0];
|
Vector2 p = p_point - p_segment[0];
|
||||||
Vector2 n = p_segment[1] - p_segment[0];
|
Vector2 n = p_segment[1] - p_segment[0];
|
||||||
real_t l = n.length();
|
real_t l2 = n.length_squared();
|
||||||
if (l < 1e-10)
|
if (l2 < 1e-20)
|
||||||
return p_segment[0]; // both points are the same, just give any
|
return p_segment[0]; // both points are the same, just give any
|
||||||
n /= l;
|
|
||||||
|
|
||||||
real_t d = n.dot(p);
|
real_t d = n.dot(p) / l2;
|
||||||
|
|
||||||
return p_segment[0] + n * d; // inside
|
return p_segment[0] + n * d; // inside
|
||||||
}
|
}
|
||||||
|
|
Loading…
Add table
Reference in a new issue