422 lines
15 KiB
C#
422 lines
15 KiB
C#
|
using System.Collections;
|
|||
|
|
using System.Collections.Generic;
|
|||
|
|
using UnityEngine;
|
|||
|
|
|
|||
|
|
|
|||
|
|
namespace BNG {
|
|||
|
|
|
|||
|
|
public class HandPhysics : MonoBehaviour {
|
|||
|
|
|
|||
|
|
/// <summary>
|
|||
|
|
/// This is the object our physical hand should try to follow / match
|
|||
|
|
/// </summary>
|
|||
|
|
[Tooltip("This is the object our physical hand should try to follow / match. Should typically be an object on the controller Transform")]
|
|||
|
|
public Transform AttachTo;
|
|||
|
|
|
|||
|
|
[Tooltip("Amount of Velocity to apply to hands when trying to reach anchor point")]
|
|||
|
|
public float HandVelocity = 1500f;
|
|||
|
|
|
|||
|
|
[Tooltip("If true, Hand COlliders will be disabled while grabbing an object")]
|
|||
|
|
public bool DisableHandCollidersOnGrab = true;
|
|||
|
|
|
|||
|
|
[Tooltip("If the hand exceeds this distance from it's origin it will snap back to the original position. Specified in meters.")]
|
|||
|
|
public float SnapBackDistance = 1f;
|
|||
|
|
|
|||
|
|
[Tooltip("This is the Grabber to use when this hand is active.")]
|
|||
|
|
public Grabber ThisGrabber;
|
|||
|
|
|
|||
|
|
[Tooltip("Disable this Grabber when this hand is active. (Optional)")]
|
|||
|
|
public Grabber DisableGrabber;
|
|||
|
|
|
|||
|
|
[Tooltip("This is the RemoteGrabber to use when this hand is active.")]
|
|||
|
|
public RemoteGrabber ThisRemoteGrabber;
|
|||
|
|
|
|||
|
|
[Tooltip("Disable this RemoteGrabber when this hand is active. (Optional)")]
|
|||
|
|
public RemoteGrabber DisableRemoteGrabber;
|
|||
|
|
|
|||
|
|
[Tooltip("Assign Hand Colliders this material if provided")]
|
|||
|
|
public PhysicMaterial ColliderMaterial;
|
|||
|
|
|
|||
|
|
public Transform HandModel;
|
|||
|
|
public Transform HandModelOffset;
|
|||
|
|
|
|||
|
|
public bool HoldingObject {
|
|||
|
|
get {
|
|||
|
|
return ThisGrabber != null && ThisGrabber.HeldGrabbable != null;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// Colliders that live in the hand model
|
|||
|
|
List<Collider> handColliders;
|
|||
|
|
Rigidbody rigid;
|
|||
|
|
ConfigurableJoint configJoint;
|
|||
|
|
Grabbable heldGrabbable;
|
|||
|
|
|
|||
|
|
List<Collider> collisions = new List<Collider>();
|
|||
|
|
LineRenderer line;
|
|||
|
|
|
|||
|
|
Vector3 localHandOffset;
|
|||
|
|
Vector3 localHandOffsetRotation;
|
|||
|
|
|
|||
|
|
bool wasHoldingObject = false;
|
|||
|
|
|
|||
|
|
void Start() {
|
|||
|
|
|
|||
|
|
rigid = GetComponent<Rigidbody>();
|
|||
|
|
configJoint = GetComponent<ConfigurableJoint>();
|
|||
|
|
line = GetComponent<LineRenderer>();
|
|||
|
|
|
|||
|
|
// Create Attach Point based on current position and rotation
|
|||
|
|
if(AttachTo == null) {
|
|||
|
|
AttachTo = new GameObject("AttachToTransform").transform;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
AttachTo.parent = transform.parent;
|
|||
|
|
AttachTo.SetPositionAndRotation(transform.position, transform.rotation);
|
|||
|
|
|
|||
|
|
// Connect config joint to our AttachPoint's Rigidbody
|
|||
|
|
Rigidbody attachRB = AttachTo.gameObject.AddComponent<Rigidbody>();
|
|||
|
|
attachRB.useGravity = false;
|
|||
|
|
attachRB.isKinematic = true;
|
|||
|
|
attachRB.constraints = RigidbodyConstraints.FreezeAll;
|
|||
|
|
// configJoint.connectedBody = attachRB;
|
|||
|
|
Destroy(configJoint);
|
|||
|
|
|
|||
|
|
localHandOffset = HandModel.localPosition;
|
|||
|
|
localHandOffsetRotation = HandModel.localEulerAngles;
|
|||
|
|
|
|||
|
|
initHandColliders();
|
|||
|
|
|
|||
|
|
_priorParent = transform.parent;
|
|||
|
|
// Physics Hands typically want to have no parent at all
|
|||
|
|
transform.parent = null;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void Update() {
|
|||
|
|
updateHandGraphics();
|
|||
|
|
|
|||
|
|
// Line indicating our object is far away
|
|||
|
|
drawDistanceLine();
|
|||
|
|
|
|||
|
|
// Check if we should ignore collision with an object that is being remotely pulled towards us
|
|||
|
|
checkRemoteCollision();
|
|||
|
|
|
|||
|
|
// Check if hand has gotten too far away
|
|||
|
|
checkBreakDistance();
|
|||
|
|
|
|||
|
|
// Our root object is disabled
|
|||
|
|
if (!AttachTo.gameObject.activeSelf) {
|
|||
|
|
transform.parent = AttachTo;
|
|||
|
|
transform.localPosition = Vector3.zero;
|
|||
|
|
transform.localRotation = Quaternion.identity;
|
|||
|
|
return;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// If we are holding something, move the hands in Update, ignoring physics.
|
|||
|
|
if (HoldingObject) {
|
|||
|
|
|
|||
|
|
// Call On Grabbed Event if our first grab
|
|||
|
|
if (!wasHoldingObject) {
|
|||
|
|
OnGrabbedObject(ThisGrabber.HeldGrabbable);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// If we are holding something, move the hands in Update, ignoring physics.
|
|||
|
|
//transform.position = AttachTo.position;
|
|||
|
|
//transform.rotation = AttachTo.rotation;
|
|||
|
|
}
|
|||
|
|
else {
|
|||
|
|
if (wasHoldingObject) {
|
|||
|
|
OnReleasedObject(heldGrabbable);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
wasHoldingObject = HoldingObject;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void FixedUpdate() {
|
|||
|
|
|
|||
|
|
// Move object directly to our hand since the hand joint is controlling movement now
|
|||
|
|
if (HoldingObject && ThisGrabber.HeldGrabbable.DidParentHands) {
|
|||
|
|
rigid.MovePosition(AttachTo.position);
|
|||
|
|
rigid.MoveRotation(AttachTo.rotation);
|
|||
|
|
}
|
|||
|
|
else {
|
|||
|
|
// Move using Velocity
|
|||
|
|
Vector3 positionDelta = AttachTo.position - transform.position;
|
|||
|
|
rigid.velocity = Vector3.MoveTowards(rigid.velocity, (positionDelta * HandVelocity) * Time.fixedDeltaTime, 5f);
|
|||
|
|
|
|||
|
|
// Rotate using angular velocity
|
|||
|
|
float angle;
|
|||
|
|
Vector3 axis;
|
|||
|
|
Quaternion rotationDelta = AttachTo.rotation * Quaternion.Inverse(transform.rotation);
|
|||
|
|
rotationDelta.ToAngleAxis(out angle, out axis);
|
|||
|
|
|
|||
|
|
// Fix rotation angle
|
|||
|
|
if (angle > 180) {
|
|||
|
|
angle -= 360;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (angle != 0) {
|
|||
|
|
Vector3 angularTarget = angle * axis;
|
|||
|
|
angularTarget = (angularTarget * 60f) * Time.fixedDeltaTime;
|
|||
|
|
rigid.angularVelocity = Vector3.MoveTowards(rigid.angularVelocity, angularTarget, 20f);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// Reset Collisions every physics update
|
|||
|
|
collisions = new List<Collider>();
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void initHandColliders() {
|
|||
|
|
handColliders = new List<Collider>();
|
|||
|
|
|
|||
|
|
// Only accept non-trigger colliders.
|
|||
|
|
var tempColliders = GetComponentsInChildren<Collider>(false);
|
|||
|
|
for (int x = 0; x < tempColliders.Length; x++) {
|
|||
|
|
Collider c = tempColliders[x];
|
|||
|
|
if (!c.isTrigger && c.enabled) {
|
|||
|
|
if (ColliderMaterial) {
|
|||
|
|
c.material = ColliderMaterial;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
handColliders.Add(c);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// Ignore all other hand collider
|
|||
|
|
for (int x = 0; x < handColliders.Count; x++) {
|
|||
|
|
Collider thisCollider = handColliders[x];
|
|||
|
|
|
|||
|
|
for (int y = 0; y < handColliders.Count; y++) {
|
|||
|
|
Physics.IgnoreCollision(thisCollider, handColliders[y], true);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
Grabbable remoteIgnoredGrabbable;
|
|||
|
|
void checkRemoteCollision() {
|
|||
|
|
// Should we unignore this object if we are no longer pulling it towards us?
|
|||
|
|
if(remoteIgnoredGrabbable != null && ThisGrabber.RemoteGrabbingGrabbable != remoteIgnoredGrabbable) {
|
|||
|
|
// If we are holding this object then let the settings take care of it
|
|||
|
|
if(ThisGrabber.HeldGrabbable == remoteIgnoredGrabbable) {
|
|||
|
|
remoteIgnoredGrabbable = null;
|
|||
|
|
}
|
|||
|
|
// Otherwise we dropped it mid flight and should unignore it
|
|||
|
|
else {
|
|||
|
|
IgnoreGrabbableCollisions(remoteIgnoredGrabbable, false);
|
|||
|
|
remoteIgnoredGrabbable = null;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// Ignore collision with object we started pulling towards us
|
|||
|
|
if(ThisGrabber.RemoteGrabbingGrabbable != null && ThisGrabber.RemoteGrabbingGrabbable != remoteIgnoredGrabbable) {
|
|||
|
|
remoteIgnoredGrabbable = ThisGrabber.RemoteGrabbingGrabbable;
|
|||
|
|
IgnoreGrabbableCollisions(remoteIgnoredGrabbable, true);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// Line indicating our object is far away
|
|||
|
|
void drawDistanceLine() {
|
|||
|
|
if (line) {
|
|||
|
|
if (Vector3.Distance(transform.position, AttachTo.position) > 0.05f) {
|
|||
|
|
line.enabled = true;
|
|||
|
|
line.SetPosition(0, transform.position);
|
|||
|
|
line.SetPosition(1, AttachTo.position);
|
|||
|
|
}
|
|||
|
|
else {
|
|||
|
|
line.enabled = false;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void checkBreakDistance() {
|
|||
|
|
if (SnapBackDistance > 0 && Vector3.Distance(transform.position, AttachTo.position) > SnapBackDistance) {
|
|||
|
|
transform.position = AttachTo.position;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void updateHandGraphics() {
|
|||
|
|
|
|||
|
|
bool holdingObject = ThisGrabber.HeldGrabbable != null;
|
|||
|
|
if (!holdingObject) {
|
|||
|
|
if (HandModelOffset) {
|
|||
|
|
HandModelOffset.parent = HandModel;
|
|||
|
|
HandModelOffset.localPosition = Vector3.zero;
|
|||
|
|
HandModelOffset.localEulerAngles = Vector3.zero;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
return;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// Position Hand Model
|
|||
|
|
if (HandModelOffset && ThisGrabber.HandsGraphics) {
|
|||
|
|
HandModelOffset.parent = ThisGrabber.HandsGraphics;
|
|||
|
|
HandModelOffset.localPosition = localHandOffset;
|
|||
|
|
HandModelOffset.localEulerAngles = localHandOffsetRotation;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
IEnumerator UnignoreAllCollisions() {
|
|||
|
|
|
|||
|
|
var thisGrabbable = heldGrabbable;
|
|||
|
|
heldGrabbable = null;
|
|||
|
|
|
|||
|
|
// Delay briefly so any held objects don't automatically clip
|
|||
|
|
yield return new WaitForSeconds(0.1f);
|
|||
|
|
|
|||
|
|
IgnoreGrabbableCollisions(thisGrabbable, false);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public void IgnoreGrabbableCollisions(Grabbable grab, bool ignorePhysics) {
|
|||
|
|
|
|||
|
|
var grabColliders = grab.GetComponentsInChildren<Collider>();
|
|||
|
|
|
|||
|
|
// Ignore all other hand collider
|
|||
|
|
for (int x = 0; x < grabColliders.Length; x++) {
|
|||
|
|
Collider thisGrabCollider = grabColliders[x];
|
|||
|
|
|
|||
|
|
for (int y = 0; y < handColliders.Count; y++) {
|
|||
|
|
Physics.IgnoreCollision(thisGrabCollider, handColliders[y], ignorePhysics);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public void DisableHandColliders() {
|
|||
|
|
for (int x = 0; x < handColliders.Count; x++) {
|
|||
|
|
if(handColliders[x] != null && handColliders[x].enabled) {
|
|||
|
|
handColliders[x].enabled = false;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public void EnableHandColliders() {
|
|||
|
|
for (int x = 0; x < handColliders.Count; x++) {
|
|||
|
|
if (handColliders[x] != null && handColliders[x].enabled == false) {
|
|||
|
|
handColliders[x].enabled = true;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public virtual void OnGrabbedObject(Grabbable grabbedObject) {
|
|||
|
|
heldGrabbable = grabbedObject;
|
|||
|
|
|
|||
|
|
if (DisableHandCollidersOnGrab) {
|
|||
|
|
DisableHandColliders();
|
|||
|
|
}
|
|||
|
|
// Make the hand ignore the grabbable's colliders
|
|||
|
|
else {
|
|||
|
|
|
|||
|
|
IgnoreGrabbableCollisions(heldGrabbable, true);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
Transform _priorParent;
|
|||
|
|
|
|||
|
|
public virtual void LockLocalPosition() {
|
|||
|
|
_priorParent = transform.parent;
|
|||
|
|
transform.parent = AttachTo;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public virtual void UnlockLocalPosition() {
|
|||
|
|
transform.parent = _priorParent;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public virtual void OnReleasedObject(Grabbable grabbedObject) {
|
|||
|
|
|
|||
|
|
if (heldGrabbable != null) {
|
|||
|
|
// Make sure hand colliders come back
|
|||
|
|
if (DisableHandCollidersOnGrab) {
|
|||
|
|
EnableHandColliders();
|
|||
|
|
}
|
|||
|
|
// Unignore the grabbable's colliders
|
|||
|
|
else {
|
|||
|
|
StartCoroutine(UnignoreAllCollisions());
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
heldGrabbable = null;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void OnEnable() {
|
|||
|
|
if(DisableGrabber) {
|
|||
|
|
DisableGrabber.enabled = false;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (ThisGrabber) {
|
|||
|
|
ThisGrabber.enabled = true;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (ThisRemoteGrabber) {
|
|||
|
|
ThisRemoteGrabber.enabled = true;
|
|||
|
|
DisableRemoteGrabber.enabled = false;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// Move events
|
|||
|
|
PlayerTeleport.OnBeforeTeleport += LockLocalPosition;
|
|||
|
|
PlayerTeleport.OnAfterTeleport += UnlockLocalPosition;
|
|||
|
|
|
|||
|
|
PlayerRotation.OnBeforeRotate += LockLocalPosition;
|
|||
|
|
PlayerRotation.OnAfterRotate += UnlockLocalPosition;
|
|||
|
|
|
|||
|
|
SmoothLocomotion.OnBeforeMove += LockOffset;
|
|||
|
|
SmoothLocomotion.OnAfterMove += UnlockOffset;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
Vector3 _priorLocalOffsetPosition;
|
|||
|
|
|
|||
|
|
public virtual void LockOffset() {
|
|||
|
|
_priorLocalOffsetPosition = AttachTo.InverseTransformPoint(transform.position);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public virtual void UnlockOffset() {
|
|||
|
|
Vector3 dest = AttachTo.TransformPoint(_priorLocalOffsetPosition);
|
|||
|
|
float dist = Vector3.Distance(transform.position, dest);
|
|||
|
|
// Only move if gone far enough
|
|||
|
|
if (dist > 0.0005f) {
|
|||
|
|
transform.position = dest;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void OnDisable() {
|
|||
|
|
if (ThisGrabber) {
|
|||
|
|
ThisGrabber.enabled = false;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (DisableGrabber) {
|
|||
|
|
DisableGrabber.enabled = true;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (ThisRemoteGrabber) {
|
|||
|
|
ThisRemoteGrabber.enabled = false;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (DisableRemoteGrabber) {
|
|||
|
|
DisableRemoteGrabber.enabled = true;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// Move events
|
|||
|
|
PlayerTeleport.OnBeforeTeleport -= LockLocalPosition;
|
|||
|
|
PlayerTeleport.OnAfterTeleport -= UnlockLocalPosition;
|
|||
|
|
|
|||
|
|
PlayerRotation.OnBeforeRotate -= LockLocalPosition;
|
|||
|
|
PlayerRotation.OnAfterRotate -= UnlockLocalPosition;
|
|||
|
|
|
|||
|
|
SmoothLocomotion.OnBeforeMove -= LockOffset;
|
|||
|
|
SmoothLocomotion.OnAfterMove -= UnlockOffset;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void OnCollisionStay(Collision collision) {
|
|||
|
|
for (int x = 0; x < collision.contacts.Length; x++) {
|
|||
|
|
ContactPoint contact = collision.contacts[x];
|
|||
|
|
// Keep track of how many objects we are colliding with
|
|||
|
|
if (IsValidCollision(contact.otherCollider) && !collisions.Contains(contact.otherCollider)) {
|
|||
|
|
collisions.Add(contact.otherCollider);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public bool IsValidCollision(Collider col) {
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|