1. 四元数转欧拉角

python 代码

# IMU callback function.
def imu_callback(self, msg):# Convert quaternions to Euler angles.(r, p, y) = tf.transformations.euler_from_quaternion([msg.orientation.x, msg.orientation.y, msg.orientation.z, msg.orientation.w])self.fill_euler_msg(msg, r, p, y)

c++ 代码

void odomCallback(const nav_msgs::Odometry &odom) {tf::Quaternion quat;tf::quaternionMsgToTF(odom.pose.pose.orientation, quat);double roll, pitch, yaw;//定义存储r\p\y的容器tf::Matrix3x3(quat).getRPY(roll, pitch, yaw);//进行转换}

2. 欧拉角转四元数

//RPY欧拉角转四元数
tf::createQuaternionMsgFromRollPitchYaw(double r, double p, double y);//返回四元数//只通过yaw, 即绕z的旋转角度计算四元数，用于平面小车。返回四元数
tf::createQuaternionMsgFromYaw(double y);

参考链接：
[1] 一銤阳光. ROS中四元素欧拉角变换 [EB/OL]. https://blog.csdn.net/CSDNhuaong/article/details/78510436, 2017-11-12/2022-03-24.
[2] 码农教程. ROS中quaternion四元数和RPY欧拉角转换 [EB/OL]. http://www.manongjc.com/article/62731.html, 2019-02-27/2022-03-24.

【ROS学习】ROS中四元数与欧拉角的转换相关推荐

ROS中四元数、欧拉角、旋转矩阵等格式转换
未完- ROS接收到odometry格式消息: nav_msgs::Odometry pos_msg 具有: pos_msg.pose.pose.orientation.x; // xyzw pos_ ...
ROS学习-ROS简介
文章目录 1.ROS 1.1 ROS概念 1.2 ROS特征 1.3 ROS特点 1.4 ROS版本 1.5 ROS程序其他名词介绍 1. 元操作系统 2. IDL 接口定义语言一些网站 1.RO ...
转换矩阵、平移矩阵、旋转矩阵关系以及python实现旋转矩阵、四元数、欧拉角之间转换
文章目录 1. 转换矩阵.平移矩阵.旋转矩阵之间的关系 2. 缩放变换.平移变换和旋转变换 2. python实现旋转矩阵.四元数.欧拉角互相转化由于在平时总是或多或少的遇到平移旋转的问题,每次都是 ...
ros中四元数与欧拉角学习笔记
看了很多关于四元数的理论,但都没有一个人讲到了为什么在ros中引入四元数的概念,后面结合ros wiki上相关资料,有了以下理解. 1 物体自身绕着XYZ三轴转动,有时在外部轴看来只是引入了两个转动轴 ...
（14）ROS学习-ROS工作空间覆盖
所谓工作空间覆盖,是指不同工作空间中,存在重名的功能包的情形,虽然特定工作空间内的功能包不能重名,但是自定义工作空间的功能包与内置的功能包(如ros的小海龟节点)可以重名或者不同的自定义的工作空间中也 ...
四元数转换为欧拉角（多解问题）
车辆行驶状态估计(4)中车辆横摆角信息在顺时针转向时存在明显的错误,进行记录输出 2023-05-25-aft02.txt 四元数: -0.00201210.00115721 -0.000596761 ...
【Unity3D 灵巧小知识点】☀️ | Unity 四元数、欧拉角与方向向量之间转换
Unity 小科普老规矩,先介绍一下 Unity 的科普小知识: Unity是实时3D互动内容创作和运营平台 . 包括游戏开发.美术.建筑.汽车设计.影视在内的所有创作者,借助 Unity 将创意 ...
无人机姿态解算：四元数及其与欧拉角的转换
无人机姿态解算:四元数及其与欧拉角的转换引言:获得无人机飞行时的飞行姿态对于无人机稳定控制来说至关重要.无人机主要通过传感器数据融合来进行状态估计,常用于无人机的传感器包括:MPU(包含了三轴加速度 ...
ROS学习手记 - 5 理解ROS中的基本概念_Services and Parameters
ROS学习手记 - 5 理解ROS中的基本概念_Services and Parameters 上一节完成了对nodes, Topic的理解,再深入一步: Services and Parameter ...
ROS学习笔记十一：ROS中数据的记录与重放
ROS学习笔记十一:ROS中数据的记录与重放本节主要介绍如何记录一个正在运行的ROS系统中的数据,然后在一个运行的系统中根据记录文件重新产生和记录时类似的运动情况.本例子还是以小海龟例程为例. 记录 ...

【ROS学习】ROS中四元数与欧拉角的转换

1. 四元数转欧拉角

2. 欧拉角转四元数

【ROS学习】ROS中四元数与欧拉角的转换相关推荐

最新文章

热门文章