Merge pull request #51748 from LoipesMas/master

Epsilon check for angular velocity in Body3DSW
This commit is contained in:
Rémi Verschelde 2021-08-16 20:41:35 +02:00 committed by GitHub
commit 84b11fbaa6
No known key found for this signature in database
GPG key ID: 4AEE18F83AFDEB23

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);