54 lines
2 KiB
C#
54 lines
2 KiB
C#
|
using UnityEngine;
|
||
|
|
using System.Collections;
|
||
|
|
|
||
|
|
namespace RootMotion.FinalIK {
|
||
|
|
|
||
|
|
/// <summary>
|
||
|
|
/// Definition of FBBIK Offset pose.
|
||
|
|
/// </summary>
|
||
|
|
public class OffsetPose: MonoBehaviour {
|
||
|
|
|
||
|
|
/// <summary>
|
||
|
|
/// State of an effector in this pose
|
||
|
|
/// </summary>
|
||
|
|
[System.Serializable]
|
||
|
|
public class EffectorLink {
|
||
|
|
|
||
|
|
public FullBodyBipedEffector effector; // The effector type (this is just an enum)
|
||
|
|
public Vector3 offset; // Offset of the effector in this pose
|
||
|
|
public Vector3 pin; // Pin position relative to the solver root Transform
|
||
|
|
public Vector3 pinWeight; // Pin weight vector
|
||
|
|
|
||
|
|
// Apply positionOffset to the effector
|
||
|
|
public void Apply(IKSolverFullBodyBiped solver, float weight, Quaternion rotation) {
|
||
|
|
// Offset
|
||
|
|
solver.GetEffector(effector).positionOffset += rotation * offset * weight;
|
||
|
|
|
||
|
|
// Calculating pinned position
|
||
|
|
Vector3 pinPosition = solver.GetRoot().position + rotation * pin;
|
||
|
|
Vector3 pinPositionOffset = pinPosition - solver.GetEffector(effector).bone.position;
|
||
|
|
|
||
|
|
Vector3 pinWeightVector = pinWeight * Mathf.Abs(weight);
|
||
|
|
|
||
|
|
// Lerping to pinned position
|
||
|
|
solver.GetEffector(effector).positionOffset = new Vector3(
|
||
|
|
Mathf.Lerp(solver.GetEffector(effector).positionOffset.x, pinPositionOffset.x, pinWeightVector.x),
|
||
|
|
Mathf.Lerp(solver.GetEffector(effector).positionOffset.y, pinPositionOffset.y, pinWeightVector.y),
|
||
|
|
Mathf.Lerp(solver.GetEffector(effector).positionOffset.z, pinPositionOffset.z, pinWeightVector.z)
|
||
|
|
);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
public EffectorLink[] effectorLinks = new EffectorLink[0];
|
||
|
|
|
||
|
|
// Apply positionOffsets of all the EffectorLinks
|
||
|
|
public void Apply(IKSolverFullBodyBiped solver, float weight) {
|
||
|
|
for (int i = 0; i < effectorLinks.Length; i++) effectorLinks[i].Apply(solver, weight, solver.GetRoot().rotation);
|
||
|
|
}
|
||
|
|
|
||
|
|
public void Apply(IKSolverFullBodyBiped solver, float weight, Quaternion rotation) {
|
||
|
|
for (int i = 0; i < effectorLinks.Length; i++) effectorLinks[i].Apply(solver, weight, rotation);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|