45 lines
1.3 KiB
C#
45 lines
1.3 KiB
C#
using System;
|
|
using System.Linq;
|
|
using UnityEngine;
|
|
|
|
|
|
namespace UniHumanoid
|
|
{
|
|
public static class BvhExtensions
|
|
{
|
|
public static Func<float, float, float, Quaternion> GetEulerToRotation(this BvhNode bvh)
|
|
{
|
|
var order = bvh.Channels.Where(x => x == Channel.Xrotation || x == Channel.Yrotation || x == Channel.Zrotation).ToArray();
|
|
|
|
return (x, y, z) =>
|
|
{
|
|
var xRot = Quaternion.Euler(x, 0, 0);
|
|
var yRot = Quaternion.Euler(0, y, 0);
|
|
var zRot = Quaternion.Euler(0, 0, z);
|
|
|
|
var r = Quaternion.identity;
|
|
foreach (var ch in order)
|
|
{
|
|
switch (ch)
|
|
{
|
|
case Channel.Xrotation: r = r * xRot; break;
|
|
case Channel.Yrotation: r = r * yRot; break;
|
|
case Channel.Zrotation: r = r * zRot; break;
|
|
default: throw new BvhException("no rotation");
|
|
}
|
|
}
|
|
return r;
|
|
};
|
|
}
|
|
|
|
public static Vector3 ToVector3(this Single3 s3)
|
|
{
|
|
return new Vector3(s3.x, s3.y, s3.z);
|
|
}
|
|
|
|
public static Vector3 ToXReversedVector3(this Single3 s3)
|
|
{
|
|
return new Vector3(-s3.x, s3.y, s3.z);
|
|
}
|
|
}
|
|
}
|