Last active
September 9, 2024 17:33
-
-
Save mstevenson/4958837 to your computer and use it in GitHub Desktop.
Unity extension methods for computing a ConfigurableJoint.TargetRotation value from a given local or world rotation.
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
using UnityEngine; | |
public static class ConfigurableJointExtensions { | |
/// <summary> | |
/// Sets a joint's targetRotation to match a given local rotation. | |
/// The joint transform's local rotation must be cached on Start and passed into this method. | |
/// </summary> | |
public static void SetTargetRotationLocal (this ConfigurableJoint joint, Quaternion targetLocalRotation, Quaternion startLocalRotation) | |
{ | |
if (joint.configuredInWorldSpace) { | |
Debug.LogError ("SetTargetRotationLocal should not be used with joints that are configured in world space. For world space joints, use SetTargetRotation.", joint); | |
} | |
SetTargetRotationInternal (joint, targetLocalRotation, startLocalRotation, Space.Self); | |
} | |
/// <summary> | |
/// Sets a joint's targetRotation to match a given world rotation. | |
/// The joint transform's world rotation must be cached on Start and passed into this method. | |
/// </summary> | |
public static void SetTargetRotation (this ConfigurableJoint joint, Quaternion targetWorldRotation, Quaternion startWorldRotation) | |
{ | |
if (!joint.configuredInWorldSpace) { | |
Debug.LogError ("SetTargetRotation must be used with joints that are configured in world space. For local space joints, use SetTargetRotationLocal.", joint); | |
} | |
SetTargetRotationInternal (joint, targetWorldRotation, startWorldRotation, Space.World); | |
} | |
static void SetTargetRotationInternal (ConfigurableJoint joint, Quaternion targetRotation, Quaternion startRotation, Space space) | |
{ | |
// Calculate the rotation expressed by the joint's axis and secondary axis | |
var right = joint.axis; | |
var forward = Vector3.Cross (joint.axis, joint.secondaryAxis).normalized; | |
var up = Vector3.Cross (forward, right).normalized; | |
Quaternion worldToJointSpace = Quaternion.LookRotation (forward, up); | |
// Transform into world space | |
Quaternion resultRotation = Quaternion.Inverse (worldToJointSpace); | |
// Counter-rotate and apply the new local rotation. | |
// Joint space is the inverse of world space, so we need to invert our value | |
if (space == Space.World) { | |
resultRotation *= startRotation * Quaternion.Inverse (targetRotation); | |
} else { | |
resultRotation *= Quaternion.Inverse (targetRotation) * startRotation; | |
} | |
// Transform back into joint space | |
resultRotation *= worldToJointSpace; | |
// Set target rotation to our newly calculated rotation | |
joint.targetRotation = resultRotation; | |
} | |
} |
Sign up for free
to join this conversation on GitHub.
Already have an account?
Sign in to comment
Thank you very much! You saved my day