ROS——RPY角转四元数（python）

https://blog.csdn.net/qq_45779334/article/details/115520925

#!/usr/bin/python
#coding=utf-8
from math import pi
from tf.transformations import quaternion_from_euler
from geometry_msgs.msg import Pose

# 创建位姿实例
pos = Pose()
# 角度转弧度
DE2RA = pi / 180
# RPY的单位是角度值
roll = 0
pitch = 0.0
yaw = 1
# RPY转四元素
q = quaternion_from_euler(roll * DE2RA, pitch * DE2RA, yaw * DE2RA)

print q
©著作权归作者所有,转载或内容合作请联系作者
平台声明：文章内容（如有图片或视频亦包括在内）由作者上传并发布，文章内容仅代表作者本人观点，简书系信息发布平台，仅提供信息存储服务。

推荐阅读更多精彩内容