17 auto quat = this->inQuaternion()->getData();
19 Coord vel = this->inVelocity()->getData();
21 Coord omega = this->inAngularVelocity()->getData();
25 Coord vel_prime = rot.transpose() * vel;
26 Coord omega_prime = rot.transpose() * omega;
28 Real strength = this->varStrength()->getValue();
32 vel_prime[2] += strength;
33 vel_prime[2] = vel_prime[2] > 5.0 ? 5.0 : vel_prime[2];
34 vel_prime[2] = vel_prime[2] < -5.0 ? -5.0 : vel_prime[2];
37 vel_prime[2] *= 0.95f;
40 omega_prime.y += strength;
43 omega_prime.y -= strength;
49 this->inVelocity()->setValue(rot * vel_prime);
50 this->inAngularVelocity()->setValue(rot * omega_prime);