求多个四元数的平均数

最近要对前几帧数据进行平均数采样。所以又造了一个轮子

 

此方法经过一些单数和双数的基本测试,并且解决了无效四元数的问题,基本可用:

复制代码
public static Quaternion Average(Quaternion[] quatArray)
{
    var result = new Quaternion();
    var count = quatArray.Length;
    var error = 0;

    while (count > 1)
    {
        if (error >= 10000) break;
        error++;
        var k = 0;
        for (int i = 0; i + 1 < count; i += 2)
        {
            var a = quatArray[i];
            var b = quatArray[i + 1];

            if (Quaternion.Dot(a, a) < Quaternion.kEpsilon)
                a = Quaternion.identity;

            if (Quaternion.Dot(b, b) < Quaternion.kEpsilon)
                b = Quaternion.identity;

            var avgQuat = Quaternion.LerpUnclamped(a, b, 0.5f);

            quatArray[k] = avgQuat;
            k++;
        }

        var lastCount = count;
        count = k;

        if ((lastCount & 1) == 1)
        {
            k++;
            count++;
            quatArray[k] = quatArray[lastCount - 1];
        }
    }

    result = quatArray[0];

    return result;
}
复制代码

 

posted @   HONT  阅读(2001)  评论(0编辑  收藏  举报
编辑推荐:
· AI与.NET技术实操系列:向量存储与相似性搜索在 .NET 中的实现
· 基于Microsoft.Extensions.AI核心库实现RAG应用
· Linux系列:如何用heaptrack跟踪.NET程序的非托管内存泄露
· 开发者必知的日志记录最佳实践
· SQL Server 2025 AI相关能力初探
阅读排行:
· winform 绘制太阳,地球,月球 运作规律
· 震惊!C++程序真的从main开始吗?99%的程序员都答错了
· AI与.NET技术实操系列(五):向量存储与相似性搜索在 .NET 中的实现
· 超详细:普通电脑也行Windows部署deepseek R1训练数据并当服务器共享给他人
· 【硬核科普】Trae如何「偷看」你的代码?零基础破解AI编程运行原理
点击右上角即可分享
微信分享提示
回到顶部