asgardius/virtualx-engine
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

Epsilon check for angular velocity in BodySW

Browse source
This commit is contained in:
LoipesMas 2021-08-16 20:11:46 +02:00
parent 51dd4d0c6c
commit 32965aa0ab
1 changed files with 1 additions and 1 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

2
servers/physics/body_sw.cpp
View file

@ -614,7 +614,7 @@ void BodySW::integrate_velocities(real_t p_step) {
real_t ang_vel = total_angular_velocity.length(); real_t ang_vel = total_angular_velocity.length();
Transform transform = get_transform(); 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; Vector3 ang_vel_axis = total_angular_velocity / ang_vel;
Basis rot(ang_vel_axis, ang_vel * p_step); Basis rot(ang_vel_axis, ang_vel * p_step);
Basis identity3(1, 0, 0, 0, 1, 0, 0, 0, 1); Basis identity3(1, 0, 0, 0, 1, 0, 0, 0, 1);