diff options
Diffstat (limited to 'src/dynamics/solver/joint_constraint/ball_velocity_constraint.rs')
| -rw-r--r-- | src/dynamics/solver/joint_constraint/ball_velocity_constraint.rs | 9 |
1 files changed, 4 insertions, 5 deletions
diff --git a/src/dynamics/solver/joint_constraint/ball_velocity_constraint.rs b/src/dynamics/solver/joint_constraint/ball_velocity_constraint.rs index 33dc5ba..508ac65 100644 --- a/src/dynamics/solver/joint_constraint/ball_velocity_constraint.rs +++ b/src/dynamics/solver/joint_constraint/ball_velocity_constraint.rs @@ -50,9 +50,8 @@ impl BallVelocityConstraint { let im1 = rb1.effective_inv_mass; let im2 = rb2.effective_inv_mass; - let mut rhs = params.velocity_solve_fraction * (vel2 - vel1); - - rhs += params.velocity_based_erp * params.inv_dt() * (anchor_world2 - anchor_world1); + let rhs = (vel2 - vel1) * params.velocity_solve_fraction + + (anchor_world2 - anchor_world1) * params.velocity_based_erp_inv_dt(); let lhs; let cmat1 = anchor1.gcross_matrix(); @@ -293,9 +292,9 @@ impl BallVelocityGroundConstraint { let im2 = rb2.effective_inv_mass; let vel1 = rb1.linvel + rb1.angvel.gcross(anchor1); let vel2 = rb2.linvel + rb2.angvel.gcross(anchor2); - let mut rhs = params.velocity_solve_fraction * (vel2 - vel1); - rhs += params.velocity_based_erp * params.inv_dt() * (anchor_world2 - anchor_world1); + let rhs = (vel2 - vel1) * params.velocity_solve_fraction + + (anchor_world2 - anchor_world1) * params.velocity_based_erp_inv_dt(); let cmat2 = anchor2.gcross_matrix(); |
