aboutsummaryrefslogtreecommitdiff
path: root/src/dynamics/joint
diff options
context:
space:
mode:
Diffstat (limited to 'src/dynamics/joint')
-rw-r--r--src/dynamics/joint/generic_joint.rs20
1 files changed, 20 insertions, 0 deletions
diff --git a/src/dynamics/joint/generic_joint.rs b/src/dynamics/joint/generic_joint.rs
index 76a7fe1..98f9311 100644
--- a/src/dynamics/joint/generic_joint.rs
+++ b/src/dynamics/joint/generic_joint.rs
@@ -496,6 +496,26 @@ impl GenericJoint {
self.motors[i].damping = damping;
self
}
+
+ /// Flips the orientation of the joint, including limits and motors.
+ pub fn flip(&mut self) -> &mut Self {
+ std::mem::swap(&mut self.local_frame1, &mut self.local_frame2);
+
+ let coupled_bits = self.coupled_axes.bits();
+
+ for dim in 0..SPATIAL_DIM {
+ if coupled_bits & (1 << dim) == 0 {
+ let limit = self.limits[dim];
+ self.limits[dim].min = -limit.max;
+ self.limits[dim].max = -limit.min;
+ }
+
+ self.motors[dim].target_vel = -self.motors[dim].target_vel;
+ self.motors[dim].target_pos = -self.motors[dim].target_pos;
+ }
+
+ self
+ }
}
macro_rules! joint_conversion_methods(