diff options
| author | Sébastien Crozet <developer@crozet.re> | 2020-09-01 18:21:11 +0200 |
|---|---|---|
| committer | GitHub <noreply@github.com> | 2020-09-01 18:21:11 +0200 |
| commit | fef3a367d143bddde94e4f919a341cbf8d205293 (patch) | |
| tree | c66a9aa0f8a4a0b6c54f069e291fa2f12cc16ea3 /src/dynamics/solver/position_constraint_wide.rs | |
| parent | cc05bad0410128b163e81e9f703ccb841f6a9a08 (diff) | |
| parent | 763b9092422fd5677ffd47ec1b081951dc1c63e4 (diff) | |
| download | rapier-fef3a367d143bddde94e4f919a341cbf8d205293.tar.gz rapier-fef3a367d143bddde94e4f919a341cbf8d205293.tar.bz2 rapier-fef3a367d143bddde94e4f919a341cbf8d205293.zip | |
Merge pull request #6 from dimforge/collider_removal
Add collider removal + fix rigid-bodies with multiple colliders
Diffstat (limited to 'src/dynamics/solver/position_constraint_wide.rs')
| -rw-r--r-- | src/dynamics/solver/position_constraint_wide.rs | 7 |
1 files changed, 5 insertions, 2 deletions
diff --git a/src/dynamics/solver/position_constraint_wide.rs b/src/dynamics/solver/position_constraint_wide.rs index 8828c3d..0633926 100644 --- a/src/dynamics/solver/position_constraint_wide.rs +++ b/src/dynamics/solver/position_constraint_wide.rs @@ -51,6 +51,9 @@ impl WPositionConstraint { let radius1 = SimdFloat::from(array![|ii| manifolds[ii].kinematics.radius1; SIMD_WIDTH]); let radius2 = SimdFloat::from(array![|ii| manifolds[ii].kinematics.radius2; SIMD_WIDTH]); + let delta1 = Isometry::from(array![|ii| manifolds[ii].delta1; SIMD_WIDTH]); + let delta2 = Isometry::from(array![|ii| manifolds[ii].delta2; SIMD_WIDTH]); + let rb1 = array![|ii| rbs1[ii].active_set_offset; SIMD_WIDTH]; let rb2 = array![|ii| rbs2[ii].active_set_offset; SIMD_WIDTH]; @@ -85,8 +88,8 @@ impl WPositionConstraint { let local_p2 = Point::from(array![|ii| manifold_points[ii][i].local_p2; SIMD_WIDTH]); - constraint.local_p1[i] = local_p1 + shift1; - constraint.local_p2[i] = local_p2 + shift2; + constraint.local_p1[i] = delta1 * (local_p1 + shift1); + constraint.local_p2[i] = delta2 * (local_p2 + shift2); } if push { |