nichkara/rapier
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Fix regression causing invalid contacts to be solved.

Browse Source
This commit is contained in:
Crozet Sébastien
2021-03-07 17:34:49 +01:00
parent 0e4393ba9e
commit 152ada67ec
6 changed files with 14 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
src/dynamics/solver/velocity_constraint.rs
View File

@@ -286,7 +286,7 @@ impl VelocityConstraint {
let mut mj_lambda2 = DeltaVel::zero();
VelocityConstraintElement::warmstart_group(
&self.elements,
&self.elements[..self.num_contacts as usize],
&self.dir1,
#[cfg(feature = "dim3")]
&self.tangent1,
@@ -305,7 +305,7 @@ impl VelocityConstraint {
let mut mj_lambda2 = mj_lambdas[self.mj_lambda2 as usize];
VelocityConstraintElement::solve_group(
&mut self.elements,
&mut self.elements[..self.num_contacts as usize],
&self.dir1,
#[cfg(feature = "dim3")]
&self.tangent1,

4
src/dynamics/solver/velocity_constraint_element.rs
View File

@@ -30,6 +30,7 @@ impl<N: SimdRealField> VelocityConstraintTangentPart<N> {
}
}
#[inline]
pub fn warmstart(
&self,
tangents1: [&Vector<N>; DIM - 1],
@@ -50,6 +51,7 @@ impl<N: SimdRealField> VelocityConstraintTangentPart<N> {
}
}
#[inline]
pub fn solve(
&mut self,
tangents1: [&Vector<N>; DIM - 1],
@@ -193,6 +195,7 @@ impl<N: SimdRealField> VelocityConstraintElement<N> {
}
}
#[inline]
pub fn warmstart_group(
elements: &[Self],
dir1: &Vector<N>,
@@ -221,6 +224,7 @@ impl<N: SimdRealField> VelocityConstraintElement<N> {
}
}
#[inline]
pub fn solve_group(
elements: &mut [Self],
dir1: &Vector<N>,

4
src/dynamics/solver/velocity_constraint_wide.rs
View File

@@ -217,7 +217,7 @@ impl WVelocityConstraint {
};
VelocityConstraintElement::warmstart_group(
&self.elements,
&self.elements[..self.num_contacts as usize],
&self.dir1,
#[cfg(feature = "dim3")]
&self.tangent1,
@@ -257,7 +257,7 @@ impl WVelocityConstraint {
};
VelocityConstraintElement::solve_group(
&mut self.elements,
&mut self.elements[..self.num_contacts as usize],
&self.dir1,
#[cfg(feature = "dim3")]
&self.tangent1,

4
src/dynamics/solver/velocity_ground_constraint.rs
View File

@@ -196,7 +196,7 @@ impl VelocityGroundConstraint {
let mut mj_lambda2 = DeltaVel::zero();
VelocityGroundConstraintElement::warmstart_group(
&self.elements,
&self.elements[..self.num_contacts as usize],
&self.dir1,
#[cfg(feature = "dim3")]
&self.tangent1,
@@ -212,7 +212,7 @@ impl VelocityGroundConstraint {
let mut mj_lambda2 = mj_lambdas[self.mj_lambda2 as usize];
VelocityGroundConstraintElement::solve_group(
&mut self.elements,
&mut self.elements[..self.num_contacts as usize],
&self.dir1,
#[cfg(feature = "dim3")]
&self.tangent1,

2
src/dynamics/solver/velocity_ground_constraint_element.rs
View File

@@ -28,6 +28,7 @@ impl<N: SimdRealField> VelocityGroundConstraintTangentPart<N> {
}
}
#[inline]
pub fn warmstart(
&self,
tangents1: [&Vector<N>; DIM - 1],
@@ -40,6 +41,7 @@ impl<N: SimdRealField> VelocityGroundConstraintTangentPart<N> {
}
}
#[inline]
pub fn solve(
&mut self,
tangents1: [&Vector<N>; DIM - 1],

4
src/dynamics/solver/velocity_ground_constraint_wide.rs
View File

@@ -194,7 +194,7 @@ impl WVelocityGroundConstraint {
};
VelocityGroundConstraintElement::warmstart_group(
&self.elements,
&self.elements[..self.num_contacts as usize],
&self.dir1,
#[cfg(feature = "dim3")]
&self.tangent1,
@@ -219,7 +219,7 @@ impl WVelocityGroundConstraint {
};
VelocityGroundConstraintElement::solve_group(
&mut self.elements,
&mut self.elements[..self.num_contacts as usize],
&self.dir1,
#[cfg(feature = "dim3")]
&self.tangent1,