ROS中四元数、欧拉角、旋转矩阵等格式转换

未完…
ROS接收到odometry格式消息：

nav_msgs::Odometry pos_msg

具有：

pos_msg.pose.pose.orientation.x; // xyzw
pos_msg.pose.pose.position.x; //xyz

1.1、四元数转欧拉角

tf::Quaternion q;
tf::quaternionMsgToTF(odom.pose.pose.orientation, q);
tf::Matrix3x3(q).getRPY(roll, pitch, yaw); // rpy得是double

1.2、欧拉角转四元数

tf::Quaternion q = tf::createQuaternionFromRPY(roll, pitch, yaw);

2.1、仿射矩阵Affine转xyz roll pitch yaw

pcl::getTranslationAndEulerAngles (Affine, x, y, z, roll, pitch, yaw);

2.2、 xyz roll pitch yaw 转仿射矩阵

Eigen::Affine3f Affine = pcl::getTransformation(x, y, z, roll, pitch, yaw);

3.1、旋转矩阵R和四元数q之间相互转换

Eigen::Matrix3f rotation_R;
Eigen::Quaternionf rotation_q;
rotation_R = rotation_q.toRotationMatrix();

3.2、四元数转旋转矩阵

Eigen::Quaternionf quaternion(rotation_matrix);

4.1、matrix4f和Affine3f之间的相互转换

Eigen::Transform<float, 3, Eigen::Affine> affine (matrix);
Matrix4f matrix = affine.matrix();

这个好像也挺全的

ROS中四元数、欧拉角、旋转矩阵等格式转换相关推荐

ros中四元数与欧拉角学习笔记
看了很多关于四元数的理论,但都没有一个人讲到了为什么在ros中引入四元数的概念,后面结合ros wiki上相关资料,有了以下理解. 1 物体自身绕着XYZ三轴转动,有时在外部轴看来只是引入了两个转动轴 ...
ROS中的tf与Eigen的转换
写ROS程序时会经常遇到tf与Eigen库的转换,即算法中大多会使用Eigen来进行运算和表示机器人的位姿,但是最终需要tf将pose发布出去,所以需要将Eigen表示的pose转换为tf以及相应的m ...
MySQL数据库中时间戳及时间戳的格式转换
一.什么是时间戳时间戳是指格林威治时间自1970年1月1日(00:00:00 GMT)至当前时间的总秒数.通俗的讲,时间戳是一份能够表示一份数据在一个特定时间点已经存在的完整的可验证的数据. 常见有 ...
python时间格式转换为美式日期,Python中time日期、时间格式转换
在我们日常的数据采集中,时间time的重要性毋庸置疑的,因为它是衡量采集到的信息是否具有正确时效性的唯一因素.如果我们采集到的信息对于客户来说已经是过期的信息,这对于客户没有使用的价值,影响客户使用. ...
WM中Rich Text Format (RTF)格式转换 RichBox组件
/* * name:3G牛 * mail:news3g@126.com * url:http://www.cnblogs.com/news3g */ 2008年度企业社会责任报告显示2008年中国移动 ...
ros中有关欧拉角和四元数互转的python写法
1.欧拉角转四元数如:pos = Pose() q = tf.transformations.quaternion_from_euler(0, 0, point.z) pos.orientation ...
ROS开发实践（十三）——ROS中SLAM地图（.pgm格式）编辑软件的安装与使用
一.应用背景在ROS机器人通过SLAM算法构建好场景地图之后,为了保证ROS机器人的运行效果,我们通常会对场景地图进行修改,这里所说的场景地图通常为 .pgm 格式的文件,如下图所示. 二.地图编辑 ...
postgreSQL中含有PM/AM时间格式转换to_timestamp
PostgreSQL帮助文档 9.8. Data Type Formatting Functions The PostgreSQLformatting functionsprovide a power ...
刚体运动中的坐标变换-旋转矩阵、旋转向量、欧拉角及四元数
坐标变换及其方法 1.转化关系图 2 换算关系 3.1 旋转矩阵换算至其他 3.2 四元数换算至其他 3.3 旋转向量转换至旋转矩阵与四元数 3.3 欧拉角转换到旋转矩阵和四元数 3 坐标变换 4 坐 ...

ROS中四元数、欧拉角、旋转矩阵等格式转换

ROS中四元数、欧拉角、旋转矩阵等格式转换相关推荐

最新文章

热门文章