c#如何实现欧拉角与四元数之间的转换-创新互联

小编给大家分享一下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#如何实现欧拉角与四元数之间的转换”这篇文章的所有内容,感谢各位的阅读!相信大家都有了一定的了解,希望分享的内容对大家有所帮助,如果还想学习更多知识,欢迎关注创新互联行业资讯频道!

另外有需要云服务器可以了解下创新互联scvps.cn,海内外云服务器15元起步,三天无理由+7*72小时售后在线,公司持有idc许可证,提供“云服务器、裸金属服务器、高防服务器、香港服务器、美国服务器、虚拟主机、免备案服务器”等云主机租用服务以及企业上云的综合解决方案,具有“安全稳定、简单易用、服务可用性高、性价比高”等特点与优势,专为企业上云打造定制,能够满足用户丰富、多元化的应用场景需求。


当前题目:c#如何实现欧拉角与四元数之间的转换-创新互联
网站地址:http://abwzjs.com/article/cejohg.html