aboutsummaryrefslogtreecommitdiff
path: root/src/dynamics/solver/joint_constraint/ball_position_constraint.rs
diff options
context:
space:
mode:
authorSébastien Crozet <developer@crozet.re>2021-08-07 21:40:32 +0200
committerSébastien Crozet <sebastien@crozet.re>2021-08-08 18:38:12 +0200
commit16af01da42a5641a342f56f9e1faba619ffe72f5 (patch)
tree8ceed09c2110673fc29a3c6f8b6d9c5463d6f99a /src/dynamics/solver/joint_constraint/ball_position_constraint.rs
parenteb8f6d360dcd59cacf594b30934f183b96595d08 (diff)
downloadrapier-16af01da42a5641a342f56f9e1faba619ffe72f5.tar.gz
rapier-16af01da42a5641a342f56f9e1faba619ffe72f5.tar.bz2
rapier-16af01da42a5641a342f56f9e1faba619ffe72f5.zip
Run cargo fmt
Diffstat (limited to 'src/dynamics/solver/joint_constraint/ball_position_constraint.rs')
-rw-r--r--src/dynamics/solver/joint_constraint/ball_position_constraint.rs27
1 files changed, 13 insertions, 14 deletions
diff --git a/src/dynamics/solver/joint_constraint/ball_position_constraint.rs b/src/dynamics/solver/joint_constraint/ball_position_constraint.rs
index e8760b3..0dfdb86 100644
--- a/src/dynamics/solver/joint_constraint/ball_position_constraint.rs
+++ b/src/dynamics/solver/joint_constraint/ball_position_constraint.rs
@@ -119,19 +119,18 @@ impl BallPositionConstraint {
let axis2 = position2 * self.limits_local_axis2;
#[cfg(feature = "dim2")]
- let axis_angle = Rotation::rotation_between_axis(&axis2, &axis1).axis_angle();
+ let axis_angle = Rotation::rotation_between_axis(&axis2, &axis1).axis_angle();
#[cfg(feature = "dim3")]
- let axis_angle = Rotation::rotation_between_axis(&axis2, &axis1).and_then(|r| r.axis_angle());
+ let axis_angle =
+ Rotation::rotation_between_axis(&axis2, &axis1).and_then(|r| r.axis_angle());
// TODO: handle the case where dot(axis1, axis2) = -1.0
- if let Some((axis, angle)) = axis_angle
- {
-
+ if let Some((axis, angle)) = axis_angle {
if angle >= self.limits_angle {
#[cfg(feature = "dim2")]
- let axis = axis[0];
+ let axis = axis[0];
#[cfg(feature = "dim3")]
- let axis = axis.into_inner();
+ let axis = axis.into_inner();
let ang_error = angle - self.limits_angle;
let ang_impulse = self
.inv_ii1_ii2
@@ -242,19 +241,19 @@ impl BallPositionGroundConstraint {
let axis2 = position2 * self.limits_local_axis2;
#[cfg(feature = "dim2")]
- let axis_angle = Rotation::rotation_between_axis(&axis2, &self.limits_axis1).axis_angle();
+ let axis_angle =
+ Rotation::rotation_between_axis(&axis2, &self.limits_axis1).axis_angle();
#[cfg(feature = "dim3")]
- let axis_angle = Rotation::rotation_between_axis(&axis2, &self.limits_axis1).and_then(|r| r.axis_angle());
+ let axis_angle = Rotation::rotation_between_axis(&axis2, &self.limits_axis1)
+ .and_then(|r| r.axis_angle());
// TODO: handle the case where dot(axis1, axis2) = -1.0
- if let Some((axis, angle)) = axis_angle
- {
-
+ if let Some((axis, angle)) = axis_angle {
if angle >= self.limits_angle {
#[cfg(feature = "dim2")]
- let axis = axis[0];
+ let axis = axis[0];
#[cfg(feature = "dim3")]
- let axis = axis.into_inner();
+ let axis = axis.into_inner();
let ang_error = angle - self.limits_angle;
let ang_correction = axis * ang_error * params.joint_erp;
position2.rotation = Rotation::new(ang_correction) * position2.rotation;