Implement non-linear position stabilization for the generic constraint.

This commit is contained in:
Crozet Sébastien
2021-02-15 11:20:09 +01:00
parent d9b6198fa0
commit de39a41faa
6 changed files with 591 additions and 205 deletions

View File

@@ -242,20 +242,4 @@ impl AnyJointPositionConstraint {
AnyJointPositionConstraint::Empty => unreachable!(),
}
}
pub fn solve2(
&self,
params: &IntegrationParameters,
positions: &mut [Isometry<Real>],
dpos: &mut [DeltaVel<Real>],
) {
match self {
AnyJointPositionConstraint::GenericJoint(c) => c.solve2(params, positions, dpos),
AnyJointPositionConstraint::GenericGroundConstraint(c) => {
c.solve2(params, positions, dpos)
}
_ => {}
AnyJointPositionConstraint::Empty => unreachable!(),
}
}
}