mirror of
https://github.com/bdunderscore/modular-avatar.git
synced 2025-04-12 15:38:59 +08:00
parent
e6ffd04110
commit
93aa4db3e8
@ -50,7 +50,7 @@ namespace nadena.dev.modular_avatar.core.armature_lock
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
//[BurstCompile]
|
[BurstCompile]
|
||||||
struct ComputePosition : IJobParallelFor
|
struct ComputePosition : IJobParallelFor
|
||||||
{
|
{
|
||||||
[ReadOnly] public NativeArray<BoneStaticData> _boneStatic;
|
[ReadOnly] public NativeArray<BoneStaticData> _boneStatic;
|
||||||
@ -115,51 +115,71 @@ namespace nadena.dev.modular_avatar.core.armature_lock
|
|||||||
_baseParentBones = new Transform[mergeToBase.Count];
|
_baseParentBones = new Transform[mergeToBase.Count];
|
||||||
_mergeParentBones = new Transform[mergeToBase.Count];
|
_mergeParentBones = new Transform[mergeToBase.Count];
|
||||||
|
|
||||||
for (int i = 0; i < mergeToBase.Count; i++)
|
try
|
||||||
{
|
{
|
||||||
var (mergeBone, baseBone) = mergeToBase[i];
|
for (int i = 0; i < mergeToBase.Count; i++)
|
||||||
var mergeParent = mergeBone.parent;
|
|
||||||
var baseParent = baseBone.parent;
|
|
||||||
|
|
||||||
if (mergeParent == null || baseParent == null)
|
|
||||||
{
|
{
|
||||||
throw new Exception("Can't handle root objects");
|
var (mergeBone, baseBone) = mergeToBase[i];
|
||||||
|
var mergeParent = mergeBone.parent;
|
||||||
|
var baseParent = baseBone.parent;
|
||||||
|
|
||||||
|
if (mergeParent == null || baseParent == null)
|
||||||
|
{
|
||||||
|
throw new Exception("Can't handle root objects");
|
||||||
|
}
|
||||||
|
|
||||||
|
if (SmallScale(mergeParent.localScale) || SmallScale(mergeBone.localScale) ||
|
||||||
|
SmallScale(baseBone.localScale))
|
||||||
|
{
|
||||||
|
throw new Exception("Can't handle near-zero scale bones");
|
||||||
|
}
|
||||||
|
|
||||||
|
_baseBones[i] = baseBone;
|
||||||
|
_mergeBones[i] = mergeBone;
|
||||||
|
_baseParentBones[i] = baseParent;
|
||||||
|
_mergeParentBones[i] = mergeParent;
|
||||||
|
|
||||||
|
_baseState[i] = TransformState.FromTransform(baseBone);
|
||||||
|
_mergeSavedState[i] = _mergeState[i] = TransformState.FromTransform(mergeBone);
|
||||||
|
|
||||||
|
// We want to emulate the hierarchy:
|
||||||
|
// baseParent
|
||||||
|
// - baseBone
|
||||||
|
// - v_mergeBone
|
||||||
|
//
|
||||||
|
// However our hierarchy actually is:
|
||||||
|
// mergeParent
|
||||||
|
// - mergeBone
|
||||||
|
//
|
||||||
|
// Our question is: What is the local affine transform of mergeBone -> mergeParent space, given a new
|
||||||
|
// baseBone -> baseParent affine transform?
|
||||||
|
|
||||||
|
// First, relative to baseBone, what is the local affine transform of mergeBone?
|
||||||
|
var mat_l = baseBone.worldToLocalMatrix * mergeBone.localToWorldMatrix;
|
||||||
|
// We also find parent -> mergeParent
|
||||||
|
var mat_r = mergeParent.worldToLocalMatrix * baseParent.localToWorldMatrix;
|
||||||
|
// Now we can multiply:
|
||||||
|
// (baseParent -> mergeParent) * (baseBone -> baseParent) * (mergeBone -> baseBone)
|
||||||
|
// = (baseParent -> mergeParent) * (mergeBone -> baseParent)
|
||||||
|
// = (mergeBone -> mergeParent)
|
||||||
|
|
||||||
|
_boneStaticData[i] = new BoneStaticData()
|
||||||
|
{
|
||||||
|
_mat_l = mat_r,
|
||||||
|
_mat_r = mat_l
|
||||||
|
};
|
||||||
}
|
}
|
||||||
|
}
|
||||||
|
catch (Exception e)
|
||||||
|
{
|
||||||
|
_boneStaticData.Dispose();
|
||||||
|
_mergeSavedState.Dispose();
|
||||||
|
_baseState.Dispose();
|
||||||
|
_mergeState.Dispose();
|
||||||
|
_fault.Dispose();
|
||||||
|
_wroteAny.Dispose();
|
||||||
|
|
||||||
_baseBones[i] = baseBone;
|
throw e;
|
||||||
_mergeBones[i] = mergeBone;
|
|
||||||
_baseParentBones[i] = baseParent;
|
|
||||||
_mergeParentBones[i] = mergeParent;
|
|
||||||
|
|
||||||
_baseState[i] = TransformState.FromTransform(baseBone);
|
|
||||||
_mergeSavedState[i] = _mergeState[i] = TransformState.FromTransform(mergeBone);
|
|
||||||
|
|
||||||
// We want to emulate the hierarchy:
|
|
||||||
// baseParent
|
|
||||||
// - baseBone
|
|
||||||
// - v_mergeBone
|
|
||||||
//
|
|
||||||
// However our hierarchy actually is:
|
|
||||||
// mergeParent
|
|
||||||
// - mergeBone
|
|
||||||
//
|
|
||||||
// Our question is: What is the local affine transform of mergeBone -> mergeParent space, given a new
|
|
||||||
// baseBone -> baseParent affine transform?
|
|
||||||
|
|
||||||
// First, relative to baseBone, what is the local affine transform of mergeBone?
|
|
||||||
var mat_l = baseBone.worldToLocalMatrix * mergeBone.localToWorldMatrix;
|
|
||||||
// We also find parent -> mergeParent
|
|
||||||
var mat_r = mergeParent.worldToLocalMatrix * baseParent.localToWorldMatrix;
|
|
||||||
// Now we can multiply:
|
|
||||||
// (baseParent -> mergeParent) * (baseBone -> baseParent) * (mergeBone -> baseBone)
|
|
||||||
// = (baseParent -> mergeParent) * (mergeBone -> baseParent)
|
|
||||||
// = (mergeBone -> mergeParent)
|
|
||||||
|
|
||||||
_boneStaticData[i] = new BoneStaticData()
|
|
||||||
{
|
|
||||||
_mat_l = mat_r,
|
|
||||||
_mat_r = mat_l
|
|
||||||
};
|
|
||||||
}
|
}
|
||||||
|
|
||||||
_baseBonesAccessor = new TransformAccessArray(_baseBones);
|
_baseBonesAccessor = new TransformAccessArray(_baseBones);
|
||||||
@ -170,6 +190,13 @@ namespace nadena.dev.modular_avatar.core.armature_lock
|
|||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
|
private bool SmallScale(Vector3 scale)
|
||||||
|
{
|
||||||
|
var epsilon = 0.000001f;
|
||||||
|
|
||||||
|
return (scale.x < epsilon || scale.y < epsilon || scale.z < epsilon);
|
||||||
|
}
|
||||||
|
|
||||||
private bool DoCompute(out JobHandle handle)
|
private bool DoCompute(out JobHandle handle)
|
||||||
{
|
{
|
||||||
handle = default;
|
handle = default;
|
||||||
|
Loading…
x
Reference in New Issue
Block a user