Epsilon check for angular velocity in BodySW

(cherry picked from commit 32965aa0ab)
This commit is contained in:
LoipesMas 2021-08-16 20:11:46 +02:00 committed by Rémi Verschelde
parent 62df64fe58
commit c55be95364
No known key found for this signature in database
GPG key ID: C3336907360768E1

View file

@ -629,7 +629,7 @@ void BodySW::integrate_velocities(real_t p_step) {
real_t ang_vel = total_angular_velocity.length();
Transform 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);