1、tf的实际应用

1)在机器人的配置中

从上面可以看出激光雷达中心距离机器人底座的中心有20cm,激光雷达的中心距机器人底座中心有10cm,如果激光雷达在障碍物前面0.3米,那么机器人底座离障碍物多远呢?

1、新建一个包,如下

catkin_create_pkg robot_setup_tf roscpp tf geometry_msgs

2、catkin_make一下

3、新建两个源文件tf_publisher.cpp,tf_listener.cpp

下面按照base_link和base_laser的位置来编写publisher

#include<ros/ros.h>

#include<tf/transform_broadcaster.h>

int main(int argc,char **argv)

{

  ros::init(argc,argv,"tf_publisher");

  ros::NodeHandle n;

  //发布频率

  ros::Rate r(100);

  //创建一个transform_broadcaster

  tf::TransformBroadcaster broadcaster;

  //创建一个transform对象

  tf::Transform transform;

  //下面设置其位置以及旋转信息

  transform.setOrigin(tf::Vector3(0.1,0.0,0.2));

  //再创建一个四元组

  tf::Quaternion q;

  q.setRPY(0.0,0.0,0.0);//没有旋转

  transform.setRotation(q);//以上已经把位置描述设定好了

  while(ros::ok())

  {

    broadcaster.sendTransform(tf::StampedTransform(transform,ros::Time::now(),"base_link","base_laser"));//父框架叫base_link,子框架叫base_laser

    r.sleep();

  }

  return 0;

}

下面再tf_listener.cpp当中来编写

在其中使用了一个新的类型叫做geometry_msgs/PointStamped

在命令行当中查看该类型rosmsg show geometry_msgs/PointStamped

#include<ros/ros.h>

#include<geometry_msgs/PointStamped.h>

#include<tf/transform_listener.h>

void transformPoint(const tf::TransformListener &listener)

{

  //实例化一个消息

  geometry_msgs::PointStamped laser_point;

  //指定header的frame_id,表示最新的可用的变换

  laser_point.header.framer_id="base_laser";

  laser_point.header.stamp = ros::Time();

  laser_point.point.x= rand()%5;;//赋予一个随机值

  laser_point.point.y= rand()%5;;//赋予一个随机值

  laser_point.point.z= rand()%5;;//赋予一个随机值

  try

  {

    geometry_msgs::PointStamped base_point;//实例化一个geometry_msgs::PointStamped类,表示机器人底座

    //调用transformlistener的transformpoint函数

    listener.transformPoint("base_link",laser_point,base_point);//参数目标框架target_frame,stamped_in以及stamped_out。

    //输出相关信息

    ROS_INFO("base_laser: (%.2f, %.2f. %.2f) -----> base_link: (%.2f, %.2f, %.2f) at time %.2f",
        laser_point.point.x, laser_point.point.y, laser_point.point.z,
        base_point.point.x, base_point.point.y, base_point.point.z, base_point.header.stamp.toSec());

  }

  catch(tf::TransformException& ex){
    ROS_ERROR("Received an exception trying to transform a point from \"base_laser\" to \"base_link\": %s", ex.what());
  }

}

int main(int argc,char **argv)

{

  ros::init(argc,argv,"tf_listener");

  ros::NodeHandle n;

  //定义一个transformlistener对象

  tf::TransformListener listener(ros::Duration(10))//等待10s,如果10s之后都还没收到消息,那么之前的消息就被丢弃掉。

  //创建一个timer对象,绑定了一个transformpoint的地址,后面是该函数transformpoint的参数

  ros::Timer timer=n.createrTimer(ros::Duration(1.0),boost::bind(&transformPoint,boost::ref(listener)));

  //在上面去实现transformPoint这个函数

ros::spin();

}

对上面代码总结一下:

在main函数实例化一个listener对象,然后创建一个定时器1s钟调用上面函数一次,......。

下面把CMakeLists.txt修改一下

add_executable(tf_listener src/tf_listener.cpp);

add_executable(tf_publisher src/tf_publisher.cpp);

target_link_libraries(tf_listener ${catkin_LIBRARIES})

target_link_libraries(tf_publisher ${catkin_LIBRARIES})

再写一个launch文件:

<launch>

//再添加一个frame称为camera把它固定在base_link上,用static_transform_publisher来指定base_link(父框架)和camera(子框架)的关系,

//位置信息0.1 0.0 0.2,方向信息为0 0 0 1

<node pkg="tf" type="static_transform_publisher" name="broadcaster" args="0.1 0.0 0.2 0 0 0 1 base_link camera 100">

//我们要启动的node

<node pkg="robot_setup_tf" type="tf_publisher" name="publisher"/>

<node pkg="robot_setup_tf" type="tf_listener" name="listener"/>

</launch>

下面去编译

catkin_make

运行之

roscore

rosrun robot_setup_tf tf_listener

rosrun robot_setup_tf tf_publisher

然后进入rviz中去观察。

然后再看看launch文件

roslaunch robot_setup_tf demo.launch,在launch文件中我们又指定了一个坐标系框架叫做camera

下面去看一下

rosrun tf view_frames,生成一个PDF文件,可以看到

第八课 ROS的空间描述和变换的更多相关文章

  1. 第六课 ROS的空间描述和变换

    1.空间描述与变换 有两个坐标系A和B,B坐标系中有一个点P,如何把B坐标系中的P映射到A坐标系呢,这就涉及到空间描述与变换, 先看一下旋转矩阵: 上面中间的行向量中的元素表示在B坐标系当中的元素用A ...

  2. 第七课 ROS的空间描述和变换

    在命令行工具中也有一个与transformcaster相类似的工具叫做static_transform_publisher,它能够接受命令行参数来接受位置信息.旋转信息.父框架.子框架以及周期信息,通 ...

  3. NeHe OpenGL教程 第三十八课:资源文件

    转自[翻译]NeHe OpenGL 教程 前言 声明,此 NeHe OpenGL教程系列文章由51博客yarin翻译(2010-08-19),本博客为转载并稍加整理与修改.对NeHe的OpenGL管线 ...

  4. NeHe OpenGL教程 第二十八课:贝塞尔曲面

    转自[翻译]NeHe OpenGL 教程 前言 声明,此 NeHe OpenGL教程系列文章由51博客yarin翻译(2010-08-19),本博客为转载并稍加整理与修改.对NeHe的OpenGL管线 ...

  5. NeHe OpenGL教程 第十八课:二次几何体

    转自[翻译]NeHe OpenGL 教程 前言 声明,此 NeHe OpenGL教程系列文章由51博客yarin翻译(2010-08-19),本博客为转载并稍加整理与修改.对NeHe的OpenGL管线 ...

  6. 【C语言探索之旅】 第二部分第八课:动态分配

    内容简介 1.课程大纲 2.第二部分第八课: 动态分配 3.第二部分第九课预告: 实战“悬挂小人”游戏 课程大纲 我们的课程分为四大部分,每一个部分结束后都会有练习题,并会公布答案.还会带大家用C语言 ...

  7. NeHe OpenGL教程 第四十八课:轨迹球

    转自[翻译]NeHe OpenGL 教程 前言 声明,此 NeHe OpenGL教程系列文章由51博客yarin翻译(2010-08-19),本博客为转载并稍加整理与修改.对NeHe的OpenGL管线 ...

  8. Kali Linux Web 渗透测试视频教程— 第八课 nessus

    Kali Linux Web 渗透测试视频教程— 第八课 nessus 文/玄魂 视频课程地址:http://edu.51cto.com/course/course_id-1887.html 目录 n ...

  9. NeHe OpenGL教程 第五课:3D空间

    转自[翻译]NeHe OpenGL 教程 前言 声明,此 NeHe OpenGL教程系列文章由51博客yarin翻译(2010-08-19),本博客为转载并稍加整理与修改.对NeHe的OpenGL管线 ...

随机推荐

  1. CentOS中使用Shell脚本实现每天自动备份网站文件和数据库并上传到FTP中(转)

    http://www.jb51.net/article/58843.htm 一.安装Email发送程序 复制代码 代码如下: yum install sendmail mutt 二.安装FTP客户端程 ...

  2. nginx学习资源

    在了解nginx的时候 看到的一些资源: https://www.cnblogs.com/EdwinChan/p/8350984.html http://tengine.taobao.org/book ...

  3. CAN总线优点

    废除传统的站地址编码,代之以对通信数据块进行编码,可以多主方式工作: 采用非破坏性仲裁技术,当两个节点同时向网络上传送数据时,优先级低的节点主动停止数据发送,而优先级高的节点可不受影响继续传输数据,有 ...

  4. js作用域和作用域链

    作用域 首先要知道一点,js跟python都是一样的,先编译后执行 唯一的区别在于,js对于只声明,未定义的变量,报错是未定义,后面代码会有这个例子 编译的过程只有赋值和开辟空间的过程 只有函数,类才 ...

  5. apk、图片下载工具(1)

    package com.js.ai.modules.pointwall.util; import java.io.BufferedInputStream; import java.io.Buffere ...

  6. 用一两句话说一下你对“盒模型”这个概念的理解,和它都涉及到哪些css属性

    网页设计中常听的属性名:内容(content).填充(padding).边框(border).边界(margin), CSS盒子模式都具备这些属性. 这些属性我们可以用日常生活中的常见事物——盒子作一 ...

  7. c#中{set;get;}使用逻辑

    (先把结论提前)下面两种定义私有变量配合公有变量的方法都没有意义,除非有特殊的逻辑需要在set或get中,其它情况都等效于 public GM_Arc Arc {set;get;} //不进行初始化, ...

  8. vs中的强大的代码段管理

    vs中的代码段管理可以实现大段固定文本的快捷输入,方法: 首先编写.snippet文件如: <?xml version="1.0" encoding="utf-8& ...

  9. table td 实现细边框的样式

    <!DOCTYPE html PUBLIC "-//W3C//DTD XHTML 1.0 Transitional//EN" " http://www.w3.org ...

  10. app端内容播放,web端的玩具,app通过websocket远程遥控玩具播放内容,玩具管理页面

    一.app端内容播放 下载代码 https://github.com/987334176/Intelligent_toy/archive/v1.0.zip 注意:由于涉及到版权问题,此附件没有图片和音 ...