diff options
| author | Emil Ernerfeldt <emil.ernerfeldt@gmail.com> | 2021-02-17 19:38:57 +0100 |
|---|---|---|
| committer | Emil Ernerfeldt <emil.ernerfeldt@gmail.com> | 2021-02-26 11:06:29 +0100 |
| commit | ede4f0f7703dee4fc6a53e6da7775f7455a0b94e (patch) | |
| tree | 08a85093ff73f0e6899ef1ff1fffd3c6efe5fd9f /src/dynamics/solver/joint_constraint | |
| parent | 3f26b46196531cfca10ae487bb242e8bb3f84f65 (diff) | |
| download | rapier-ede4f0f7703dee4fc6a53e6da7775f7455a0b94e.tar.gz rapier-ede4f0f7703dee4fc6a53e6da7775f7455a0b94e.tar.bz2 rapier-ede4f0f7703dee4fc6a53e6da7775f7455a0b94e.zip | |
cleanup
Diffstat (limited to 'src/dynamics/solver/joint_constraint')
| -rw-r--r-- | src/dynamics/solver/joint_constraint/fixed_velocity_constraint.rs | 18 |
1 files changed, 8 insertions, 10 deletions
diff --git a/src/dynamics/solver/joint_constraint/fixed_velocity_constraint.rs b/src/dynamics/solver/joint_constraint/fixed_velocity_constraint.rs index db33fde..dc7569c 100644 --- a/src/dynamics/solver/joint_constraint/fixed_velocity_constraint.rs +++ b/src/dynamics/solver/joint_constraint/fixed_velocity_constraint.rs @@ -104,13 +104,12 @@ impl FixedVelocityConstraint { #[cfg(feature = "dim2")] let mut rhs = - params.velocity_solve_fraction * Vector3::new(lin_dvel.x, lin_dvel.y, ang_dvel); + Vector3::new(lin_dvel.x, lin_dvel.y, ang_dvel) * params.velocity_solve_fraction; #[cfg(feature = "dim3")] - let mut rhs = params.velocity_solve_fraction - * Vector6::new( - lin_dvel.x, lin_dvel.y, lin_dvel.z, ang_dvel.x, ang_dvel.y, ang_dvel.z, - ); + let mut rhs = Vector6::new( + lin_dvel.x, lin_dvel.y, lin_dvel.z, ang_dvel.x, ang_dvel.y, ang_dvel.z, + ) * params.velocity_solve_fraction; let velocity_based_erp_inv_dt = params.velocity_based_erp_inv_dt(); if velocity_based_erp_inv_dt != 0.0 { @@ -316,12 +315,11 @@ impl FixedVelocityGroundConstraint { #[cfg(feature = "dim2")] let mut rhs = - params.velocity_solve_fraction * Vector3::new(lin_dvel.x, lin_dvel.y, ang_dvel); + Vector3::new(lin_dvel.x, lin_dvel.y, ang_dvel) * params.velocity_solve_fraction; #[cfg(feature = "dim3")] - let mut rhs = params.velocity_solve_fraction - * Vector6::new( - lin_dvel.x, lin_dvel.y, lin_dvel.z, ang_dvel.x, ang_dvel.y, ang_dvel.z, - ); + let mut rhs = Vector6::new( + lin_dvel.x, lin_dvel.y, lin_dvel.z, ang_dvel.x, ang_dvel.y, ang_dvel.z, + ) * params.velocity_solve_fraction; let velocity_based_erp_inv_dt = params.velocity_based_erp_inv_dt(); if velocity_based_erp_inv_dt != 0.0 { |