Epsilon check for angular velocity in Body3DSW

This commit is contained in:
LoipesMas 2021-08-16 20:05:11 +02:00
parent d5a30431b9
commit 4e6e25eae7

View file

@ -578,7 +578,7 @@ void Body3DSW::integrate_velocities(real_t p_step) {
real_t ang_vel = total_angular_velocity.length();
Transform3D transform = get_transform();
if (ang_vel != 0.0) {
if (!Math::is_zero_approx(ang_vel)) {
Vector3 ang_vel_axis = total_angular_velocity / ang_vel;
Basis rot(ang_vel_axis, ang_vel * p_step);
Basis identity3(1, 0, 0, 0, 1, 0, 0, 0, 1);