ros Python 四元数转欧拉角

2021-02-04 01:17

阅读：724

标签：stream euler html ret ofo 参考 ++ http https

Python 版本

def to_euler_angles(w, x, y, z):
    """w、x、y、z to euler angles"""
    angles = {‘pitch‘: 0.0, ‘roll‘: 0.0, ‘yaw‘: 0.0}
    r = math.atan2(2*(w*x+y*z),1-2*(x*x+y*y))
    p = math.asin(2*(w*y-z*z))
    y = math.atan2(2*(w*z+x*y),1-2*(z*z+y*y))

    angles[‘roll‘] = r*180/math.pi
    angles[‘pitch‘] = p*180/math.pi
    angles[‘yaw‘] = y*180/math.pi

    return angles

C++ 版本

ROS中quaternion四元数和RPY欧拉角转换

参考：
ros python 四元数转欧拉角

ros Python 四元数转欧拉角

标签：stream euler html ret ofo 参考 ++ http https

原文地址：https://blog.51cto.com/laok8/2491298

上一篇：4.28 递归数组对象

下一篇：C++之重写运算符练习

文章来自：搜素材网的编程语言模块，转载请注明文章出处。
文章标题：ros Python 四元数转欧拉角
文章链接：http://soscw.com/index.php/essay/50676.html

亲，登录后才可以留言！

ros Python 四元数转欧拉角

C++ 版本

评论

热门文章

推荐文章

最新文章

置顶文章