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

protect against assertions

Browse Source
This commit is contained in:
David Rose 2007-09-25 17:08:43 +00:00
parent 087eab8a17
commit 593c24dcbd
1 changed files with 6 additions and 20 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

26
panda/src/physics/linearEulerIntegrator.cxx
View File

@ -126,19 +126,14 @@ child_integrate(Physical *physical,
} }
// now we go from force space to our object's space. // now we go from force space to our object's space.
nassertv(!matrices[index].is_nan());
nassertv(!cur_force->get_vector(current_object).is_nan());
f = cur_force->get_vector(current_object) * matrices[index++]; f = cur_force->get_vector(current_object) * matrices[index++];
nassertv(!f.is_nan());
physics_spam("child_integrate "<<f); physics_spam("child_integrate "<<f);
// tally it into the accum vectors. // tally it into the accum vectors.
if (cur_force->get_mass_dependent() == true) { if (cur_force->get_mass_dependent() == true) {
md_accum_vec += f; md_accum_vec += f;
nassertv(!md_accum_vec.is_nan());
} else { } else {
non_md_accum_vec += f; non_md_accum_vec += f;
nassertv(!non_md_accum_vec.is_nan());
} }
} }
@ -154,35 +149,26 @@ child_integrate(Physical *physical,
// go from force space to object space // go from force space to object space
f = cur_force->get_vector(current_object) * matrices[index++]; f = cur_force->get_vector(current_object) * matrices[index++];
nassertv(!f.is_nan());
physics_spam("child_integrate "<<f); physics_spam("child_integrate "<<f);
// tally it into the accum vectors // tally it into the accum vectors
if (cur_force->get_mass_dependent() == true) { if (cur_force->get_mass_dependent() == true) {
md_accum_vec += f; md_accum_vec += f;
nassertv(!md_accum_vec.is_nan());
} else { } else {
non_md_accum_vec += f; non_md_accum_vec += f;
nassertv(!non_md_accum_vec.is_nan());
} }
} }
// get this object's physical info // get this object's physical info
LPoint3f pos = current_object->get_position(); LPoint3f pos = current_object->get_position();
nassertv(!pos.is_nan());
vel_vec = current_object->get_velocity(); vel_vec = current_object->get_velocity();
nassertv(!vel_vec.is_nan());
float mass = current_object->get_mass(); float mass = current_object->get_mass();
// we want 'a' in F = ma // we want 'a' in F = ma
// get it by computing F / m // get it by computing F / m
nassertv(mass != 0.0f); nassertv(mass != 0.0f);
nassertv(!md_accum_vec.is_nan());
accel_vec = md_accum_vec / mass; accel_vec = md_accum_vec / mass;
nassertv(!accel_vec.is_nan());
nassertv(!non_md_accum_vec.is_nan());
accel_vec += non_md_accum_vec; accel_vec += non_md_accum_vec;
nassertv(!accel_vec.is_nan());
#if 0 //[ #if 0 //[
// step the position and velocity // step the position and velocity
@ -201,8 +187,6 @@ child_integrate(Physical *physical,
assert(current_object->get_position()==current_object->get_last_position()); assert(current_object->get_position()==current_object->get_last_position());
accel_vec*=viscosityDamper; accel_vec*=viscosityDamper;
nassertv(!accel_vec.is_nan());
nassertv(!vel_vec.is_nan());
// x = x + v * t + 0.5 * a * t * t // x = x + v * t + 0.5 * a * t * t
pos += vel_vec * dt + 0.5 * accel_vec * dt * dt; pos += vel_vec * dt + 0.5 * accel_vec * dt * dt;
@ -211,10 +195,12 @@ child_integrate(Physical *physical,
#endif //] #endif //]
// and store them back. // and store them back.
nassertv(!pos.is_nan()); if (!pos.is_nan()) {
current_object->set_position(pos); current_object->set_position(pos);
nassertv(!vel_vec.is_nan()); }
current_object->set_velocity(vel_vec); if (!vel_vec.is_nan()) {
current_object->set_velocity(vel_vec);
}
} }
} }