0 前言

1 tf::StampedTransform<——>Eigen::Matrix4f

tf::StampedTransform：是ros里代表TF变换的数据类型,一般在机器人上读取雷达坐标系到机器人坐标系的信息就是通过读取tf信息.
Eigen::Matrix4f：是变换矩阵的位姿格式，4*4的矩阵，包括平移和旋转.

1.1 实现代码

函数声明

bool TransformToMatrix(const tf::StampedTransform& transform, Eigen::Matrix4f& transform_matrix);

函数实现

// transform是 child_frame 到 base_frame 的静态变换 tf
//  Eigen::Matrix4f 是4*4的变换矩阵,包括平移和旋转.bool TFListener::TransformToMatrix(const tf::StampedTransform& transform, Eigen::Matrix4f& transform_matrix) {//由transform获取位移矩阵 Eigen::Translation3f  (3 * 3)Eigen::Translation3f tl_btol(transform.getOrigin().getX(), transform.getOrigin().getY(), transform.getOrigin().getZ());// 旋转通过以下形式从TF获得:double roll, pitch, yaw;tf::Matrix3x3(transform.getRotation()).getEulerYPR(yaw, pitch, roll);Eigen::AngleAxisf rot_x_btol(roll, Eigen::Vector3f::UnitX()); //轴角表达形式Eigen::AngleAxisf rot_y_btol(pitch, Eigen::Vector3f::UnitY());Eigen::AngleAxisf rot_z_btol(yaw, Eigen::Vector3f::UnitZ());// 此矩阵为 child_frame 到 base_frame 的转换矩阵// child_frame 到 base_frame 的静态变换矩阵   平移*旋转 transform_matrix = (tl_btol * rot_z_btol * rot_y_btol * rot_x_btol).matrix();return true;
}

2 tf::Quaternion和geometry_msgs/Quaternion的变换，变出roll, pitch, yaw

const sensor_msgs::Imu::ConstPtr& imuIntf::Quaternion orientation;tf::quaternionMsgToTF(imuIn->orientation, orientation);tf::Matrix3x3(orientation).getRPY(roll, pitch, yaw);

N 参考

几种位姿转换表示方式----tf::StampedTransform & Eigen::Matrix4f & Pose, 及其相互转换

【Eigen和tf中位姿表达方式转换】【tf::StampedTransform】【Eigen::Matrix4f】相关推荐

【转】tf中的padding方式SAME和VALID有什么区别?
原文链接:tf中的padding方式SAME和VALID有什么区别? 转载于:https://www.cnblogs.com/exciting/p/11363489.html
求AVEDEV在极星量化中的表达方式
C1=(TYP-talib.MA(TYP,10))/(0.03*AVEDEV(TYP,10))#求AVEDEV在极星的表达方式,python中可以引用MAE绝对平均偏差!在极星中无法引用!求教各位大神 ...
复数3+4i在python中的表达方式是_i(x+yi)=3+4i xy属于R,则复数x+yi的模是为什么xi-y=3+4......
满意答案口袋兔子耳朵长 2015.09.18 已帮助:3147万人已回答:104万条来自:阳光兔(北京)科技有限公司,是学大教育集团与奇虎360成立的合资公司,利用学大教育在内容和教育方面的资源 ...
第三篇：属性_第二节：控件属性在页面及源码中的表示方式
一.属性在页面及源码中的表示方式认真地看看页面中声明控件的代码,你会发现控件属性在页面中的表示千变万化.我们看看下面这些: <%@ Page Language="C#" A ...
tensorflow tf.ConfigProto() （配置tf.Session的运算方式）（allow_soft_placement、inter_op_parallelism_threads等）
tf.ConfigProto()主要的作用是配置tf.Session的运算方式,比如gpu运算或者cpu运算 log_device_placement=True 设置tf.ConfigProto()中 ...
几种位姿转换表示方式----tf::StampedTransform Eigen::Matrix4f Pose, 及其相互转换
一. tf::StampedTransform <-------------> Eigen::Matrix4f tf::StampedTransform是ros里代表TF变换的数据类型, ...
python中字符串的几种表达方式（用什么方式表示字符串）
今天在学习python的基础的内容,学习在python中如何操作字符串,在此记录下. 主要是python中字符串的几种表达,表示方式. python的几种表达方式 1 使用单引号扩起来字符串 > ...
python字符串怎么表示_python中字符串的几种表达方式（用什么方式表示字符串）...
原博文 2018-11-21 18:45 − 说明: 今天在学习python的基础的内容,学习在python中如何操作字符串,在此记录下. 主要是python中字符串的几种表达,表示方式. pytho ...
多媒体计算机技术英文,掌握多媒体计算机技术中各专业语句的英文表达方式.doc...
掌握多媒体计算机技术中各专业语句的英文表达方式 PAGE PAGE 6 第九章教学辅导一.重难点解析㈠一般掌握多媒体计算机技术中各专业语句的英文表达方式1. Windows982. Microsof ...

【Eigen和tf中位姿表达方式转换】【tf::StampedTransform】【Eigen::Matrix4f】

【tf的使用】【Eigen和tf中位姿表达方式转换】【tf::StampedTransform】【Eigen::Matrix4f】

0 前言

1 tf::StampedTransform<——>Eigen::Matrix4f

1.1 实现代码

2 tf::Quaternion和geometry_msgs/Quaternion的变换，变出roll, pitch, yaw

N 参考

【Eigen和tf中位姿表达方式转换】【tf::StampedTransform】【Eigen::Matrix4f】相关推荐

最新文章

热门文章