120 lines
3.6 KiB
C#
120 lines
3.6 KiB
C#
//========= Copyright 2016-2023, HTC Corporation. All rights reserved. ===========
|
|
|
|
using HTC.UnityPlugin.Utility;
|
|
using System;
|
|
using UnityEngine;
|
|
|
|
namespace HTC.UnityPlugin.PoseTracker
|
|
{
|
|
public abstract class BasePoseTracker : MonoBehaviour, IPoseTracker
|
|
{
|
|
public Vector3 posOffset;
|
|
public Vector3 rotOffset;
|
|
|
|
private OrderedIndexedSet<IPoseModifier> modifierSet;
|
|
|
|
public void AddModifier(IPoseModifier obj)
|
|
{
|
|
if (obj == null) { return; }
|
|
|
|
if (modifierSet == null)
|
|
{
|
|
modifierSet = new OrderedIndexedSet<IPoseModifier>();
|
|
modifierSet.Add(obj);
|
|
}
|
|
else if (!modifierSet.Contains(obj))
|
|
{
|
|
// insert obj with right priority order
|
|
if (obj.priority > modifierSet[modifierSet.Count - 1].priority)
|
|
{
|
|
modifierSet.Add(obj);
|
|
}
|
|
else
|
|
{
|
|
for (int i = 0, imax = modifierSet.Count; i < imax; ++i)
|
|
{
|
|
if (obj.priority <= modifierSet[i].priority)
|
|
{
|
|
modifierSet.Insert(i, obj);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
public bool RemoveModifier(IPoseModifier obj)
|
|
{
|
|
return modifierSet == null ? false : modifierSet.Remove(obj);
|
|
}
|
|
|
|
[Obsolete]
|
|
protected void TrackPose(Pose pose, Transform origin = null)
|
|
{
|
|
TrackPose((RigidPose)pose, origin);
|
|
}
|
|
|
|
[Obsolete("User TrackPose(RigidPose pose, bool useLocal) instead")]
|
|
protected void TrackPose(RigidPose pose, Transform origin = null)
|
|
{
|
|
if (origin != null && origin != transform.parent)
|
|
{
|
|
pose = new RigidPose(origin, false) * pose;
|
|
TrackPose(pose, false);
|
|
}
|
|
else
|
|
{
|
|
TrackPose(pose, true);
|
|
}
|
|
}
|
|
|
|
protected void TrackPose(RigidPose pose, bool useLocal)
|
|
{
|
|
pose = pose * new RigidPose(posOffset, Quaternion.Euler(rotOffset));
|
|
ModifyPose(ref pose, useLocal);
|
|
if (useLocal)
|
|
{
|
|
transform.localPosition = pose.pos;
|
|
transform.localRotation = pose.rot;
|
|
}
|
|
else
|
|
{
|
|
transform.position = pose.pos;
|
|
transform.rotation = pose.rot;
|
|
}
|
|
}
|
|
|
|
[Obsolete]
|
|
protected void ModifyPose(ref Pose pose, Transform origin)
|
|
{
|
|
var rigidPose = (RigidPose)pose;
|
|
ModifyPose(ref rigidPose, origin);
|
|
pose = rigidPose;
|
|
}
|
|
|
|
[Obsolete("Use ModifyPose(ref RigidPose pose, bool useLocal) instead")]
|
|
protected void ModifyPose(ref RigidPose pose, Transform origin)
|
|
{
|
|
if (origin != null && origin != transform.parent)
|
|
{
|
|
pose = new RigidPose(origin, false) * pose;
|
|
ModifyPose(ref pose, false);
|
|
}
|
|
else
|
|
{
|
|
ModifyPose(ref pose, true);
|
|
}
|
|
}
|
|
|
|
protected void ModifyPose(ref RigidPose pose, bool useLocal)
|
|
{
|
|
if (modifierSet == null) { return; }
|
|
|
|
for (int i = 0, imax = modifierSet.Count; i < imax; ++i)
|
|
{
|
|
if (!modifierSet[i].enabled) { continue; }
|
|
modifierSet[i].ModifyPose(ref pose, useLocal);
|
|
}
|
|
}
|
|
}
|
|
} |