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

minor tweaks

Browse Source
This commit is contained in:
David Rose 2002-06-06 21:19:05 +00:00
parent b431099f2f
commit ae0eaf823b
1 changed files with 26 additions and 19 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

41
panda/src/collide/collisionHandlerPusher.cxx
View File

@ -32,9 +32,8 @@ TypeHandle CollisionHandlerPusher::_type_handle;
//////////////////////////////////////////////////////////////////// ////////////////////////////////////////////////////////////////////
class ShoveData { class ShoveData {
public: public:
LVector3f _shove; LVector3f _vector;
float _length; float _length;
LVector3f _normalized_shove;
bool _valid; bool _valid;
}; };
@ -117,29 +116,39 @@ handle_entries() {
if (!entry->has_into_surface_normal() || if (!entry->has_into_surface_normal() ||
!entry->has_into_depth()) { !entry->has_into_depth()) {
#ifndef NDEBUG
if (collide_cat.is_debug()) { if (collide_cat.is_debug()) {
collide_cat.debug() collide_cat.debug()
<< "Cannot shove on " << *from_node << " for collision into " << "Cannot shove on " << *from_node << " for collision into "
<< *entry->get_into_node() << "; no normal/depth information.\n"; << *entry->get_into_node() << "; no normal/depth information.\n";
} }
#endif
} else { } else {
// Shove it just enough to clear the volume. // Shove it just enough to clear the volume.
if (entry->get_into_depth() != 0.0f) { if (entry->get_into_depth() != 0.0f) {
ShoveData sd; LVector3f normal = entry->get_into_surface_normal();
sd._shove = if (_horizontal) {
entry->get_into_surface_normal() * normal[2] = 0.0f;
entry->get_into_depth(); }
// Just to be on the safe size, we normalize the normal
// vector, even though it really out to be unit-length
// already (unless we just forced it horizontal, above).
normal.normalize();
ShoveData sd;
sd._vector = normal;
sd._length = entry->get_into_depth();
sd._valid = true;
#ifndef NDEBUG
if (collide_cat.is_debug()) { if (collide_cat.is_debug()) {
collide_cat.debug() collide_cat.debug()
<< "Shove on " << *from_node << " from " << "Shove on " << *from_node << " from "
<< *entry->get_into_node() << ": " << sd._shove << "\n"; << *entry->get_into_node() << ": " << sd._vector
<< " times " << sd._length << "\n";
} }
#endif
sd._length = sd._shove.length();
sd._normalized_shove = sd._shove / sd._length;
sd._valid = true;
shoves.push_back(sd); shoves.push_back(sd);
} }
@ -158,7 +167,7 @@ handle_entries() {
ShoveData &sd2 = (*sj); ShoveData &sd2 = (*sj);
if (sd2._valid) { if (sd2._valid) {
float d = sd._normalized_shove.dot(sd2._normalized_shove); float d = sd._vector.dot(sd2._vector);
if (collide_cat.is_debug()) { if (collide_cat.is_debug()) {
collide_cat.debug() collide_cat.debug()
<< "Considering dot product " << d << "\n"; << "Considering dot product " << d << "\n";
@ -182,19 +191,17 @@ handle_entries() {
for (si = shoves.begin(); si != shoves.end(); ++si) { for (si = shoves.begin(); si != shoves.end(); ++si) {
const ShoveData &sd = (*si); const ShoveData &sd = (*si);
if (sd._valid) { if (sd._valid) {
net_shove += sd._shove; net_shove += sd._vector * sd._length;
} }
} }
if (_horizontal) { #ifndef NDEBUG
net_shove[2] = 0.0f;
}
if (collide_cat.is_debug()) { if (collide_cat.is_debug()) {
collide_cat.debug() collide_cat.debug()
<< "Net shove on " << *from_node << " is: " << "Net shove on " << *from_node << " is: "
<< net_shove << "\n"; << net_shove << "\n";
} }
#endif
LMatrix4f mat; LMatrix4f mat;
def.get_mat(mat); def.get_mat(mat);