码迷,mamicode.com
首页 > 其他好文 > 详细

求多个四元数的平均数

时间:2017-01-18 01:15:15      阅读:193      评论:0      收藏:0      [点我收藏+]

标签:error   on()   方法   return   nbsp   情况   average   平均数   res   

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

 

此方法经过一些单数和双数的基本测试,除了无效四元数这种特殊情况。 

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 avgQuat = Quaternion.Lerp(quatArray[i], quatArray[i + 1], 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;
}

 

求多个四元数的平均数

标签:error   on()   方法   return   nbsp   情况   average   平均数   res   

原文地址:http://www.cnblogs.com/hont/p/6295311.html

(0)
(0)
   
举报
评论 一句话评论(0
登录后才能评论!
© 2014 mamicode.com 版权所有  联系我们:gaon5@hotmail.com
迷上了代码!