温馨提示×

温馨提示×

您好,登录后才能下订单哦!

密码登录×
登录注册×
其他方式登录
点击 登录注册 即表示同意《亿速云用户服务条款》

c#如何实现欧拉角与四元数之间的转换

发布时间:2022-01-15 14:42:19 来源:亿速云 阅读:696 作者:小新 栏目:编程语言

小编给大家分享一下c#如何实现欧拉角与四元数之间的转换,相信大部分人都还不怎么了解,因此分享这篇文章给大家参考一下,希望大家阅读完这篇文章后大有收获,下面让我们一起去了解一下吧!

//欧拉角转四元数

void cjx_from_euler(float roll, float pitch, float yaw)

{

    float cr2 = cosf(roll*0.5f);

    float cp2 = cosf(pitch*0.5f);

    float cy2 = cosf(yaw*0.5f);

    float sr2 = sinf(roll*0.5f);

    float sp2 = sinf(pitch*0.5f);

    float sy2 = sinf(yaw*0.5f);

    q1 = cr2*cp2*cy2 + sr2*sp2*sy2;

    q2 = sr2*cp2*cy2 - cr2*sp2*sy2;

    q3 = cr2*sp2*cy2 + sr2*cp2*sy2;

    q4 = cr2*cp2*sy2 - sr2*sp2*cy2;

}

#define RAD_TO_DEG 57.29577951f

//弧度转角度

float degrees(float rad) 

{

return rad * RAD_TO_DEG;

}

//四元数转欧拉角

void cjx_to_euler(float *roll, float *pitch, float *yaw)

{

    if (roll) {

        *roll = degrees(atan2f(2.0f*(q1*q2 + q3*q4),1 - 2.0f*(q2*q2 + q3*q3)));

    }

    if (pitch) {

        // 使用safe_asin()来处理pitch接近90/-90时的奇点

        *pitch = degrees(safe_asin(2.0f*(q1*q3 - q2*q4)));

    }

    if (yaw) {

        *yaw = degrees(atan2f(2.0f*(q2*q3 - q1*q4), 2.0f*(q1*q1 + q2*q2) - 1));

    }

}

以上是“c#如何实现欧拉角与四元数之间的转换”这篇文章的所有内容,感谢各位的阅读!相信大家都有了一定的了解,希望分享的内容对大家有所帮助,如果还想学习更多知识,欢迎关注亿速云行业资讯频道!

向AI问一下细节

免责声明:本站发布的内容(图片、视频和文字)以原创、转载和分享为主,文章观点不代表本网站立场,如果涉及侵权请联系站长邮箱:is@yisu.com进行举报,并提供相关证据,一经查实,将立刻删除涉嫌侵权内容。

AI