TheCloud/panda3d
1
0
Fork 0
mirror of https://github.com/panda3d/panda3d.git synced 2025-10-03 10:22:45 -04:00
Code Issues Packages Projects Releases Wiki Activity

support three collinear points

Browse Source
This commit is contained in:
David Rose 2003-06-03 01:06:25 +00:00
parent 1e0d35082d
commit 84ed9bd35b
1 changed files with 29 additions and 9 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

38
panda/src/collide/collisionPolygon.cxx
View File

@ -95,13 +95,9 @@ verify_points(const LPoint3f *begin, const LPoint3f *end) {
return false; return false;
} }
// Create a plane to determine the planarity of the first three bool all_ok = true;
// points.
Planef plane(begin[0], begin[1], begin[2]);
LVector3f normal = plane.get_normal();
float normal_length = normal.length();
bool all_ok = IS_THRESHOLD_EQUAL(normal_length, 1.0f, 0.001f);
// First, check for repeated or invalid points.
const LPoint3f *pi; const LPoint3f *pi;
for (pi = begin; pi != end && all_ok; ++pi) { for (pi = begin; pi != end && all_ok; ++pi) {
if ((*pi).is_nan()) { if ((*pi).is_nan()) {
@ -117,6 +113,23 @@ verify_points(const LPoint3f *begin, const LPoint3f *end) {
} }
} }
if (all_ok) {
// Create a plane to determine the planarity of the first three
// points (or the first two points and the nth point thereafter, in
// case the first three points happen to be collinear).
bool got_normal = false;
for (int i = 2; i < num_points && !got_normal; i++) {
Planef plane(begin[0], begin[1], begin[i]);
LVector3f normal = plane.get_normal();
float normal_length = normal.length();
got_normal = IS_THRESHOLD_EQUAL(normal_length, 1.0f, 0.001f);
}
if (!got_normal) {
all_ok = false;
}
}
return all_ok; return all_ok;
} }
@ -592,9 +605,16 @@ setup_points(const LPoint3f *begin, const LPoint3f *end) {
_points.clear(); _points.clear();
// Tell the base CollisionPlane class what its plane will be. We // Tell the base CollisionPlane class what its plane will be. We
// can determine this from the first three 3-d points. // can determine this from the first three 3-d points (unless these
Planef plane(begin[0], begin[1], begin[2]); // first three points happen to be collinear).
set_plane(plane); bool got_normal = false;
for (int i = 2; i < num_points && !got_normal; i++) {
Planef plane(begin[0], begin[1], begin[2]);
got_normal = (plane.get_normal().length_squared() > 0.1);
if (got_normal) {
set_plane(plane);
}
}
LVector3f normal = get_normal(); LVector3f normal = get_normal();