Gmapping从开始到放弃—写一个TF 监听

这篇文章主要记录如何监听一个TF广播，通过监听tf，我们可以避免繁琐的旋转矩阵的计算，而直接获取我们需要的相关信息.当然也是接着上一篇文章创建的开发包继续走下去
（1）在my_tf文件下的src下新建一个文件命名turtle_tf_listener.cpp.
添加代码如下

#include <ros/ros.h>
#include <tf/transform_listener.h>  //transformListener是接受tf消息的头文件
#include <geometry_msgs/Twist.h>
#include <turtlesim/Spawn.h>int main(int argc, char** argv){ros::init(argc, argv, "my_tf_listener");  //初始化节点ros::NodeHandle node;//以下的代码是为了在一个界面里可视化两个小乌龟，小乌龟在这里是服务信息ros::service::waitForService("spawn");ros::ServiceClient add_turtle =node.serviceClient<turtlesim::Spawn>("spawn");turtlesim::Spawn srv;add_turtle.call(srv);ros::Publisher turtle_vel =node.advertise<geometry_msgs::Twist>("turtle2/cmd_vel", 10);  //定义发布的消息的类型tf::TransformListener listener; //定义监听器ros::Rate rate(10.0);while (node.ok()){tf::StampedTransform transform;//定义存放变换关系的变量try{listener.waitForTransform("/turtle2", "/turtle1", ros::Time(0), ros::Duration(10.0) );//等待listener.lookupTransform("/turtle2", "/turtle1",ros::Time(0), transform);//参数分别是destination_frame, original_frame,time,transform.我们是想把/turtle1的坐标信息转换位turtle2 。transform 这里是用于存储最后总的结果}catch (tf::TransformException &ex) {   //出现异常的处理ROS_ERROR("%s",ex.what());ros::Duration(1.0).sleep();continue;}
//上面存储在transform中的turtle1的距离和角度的信息，用于计算turtle2De 线速度和角速度，这个新的计算结果发布在“turtle2/cmd_vel”用来更型turtle2的运动geometry_msgs::Twist vel_msg;vel_msg.angular.z = 4.0 * atan2(transform.getOrigin().y(),transform.getOrigin().x());vel_msg.linear.x = 0.5 * sqrt(pow(transform.getOrigin().x(), 2) +pow(transform.getOrigin().y(), 2)); //前面的数字你可以自己修改查看会有什么的效果，这只是用于限定小乌龟的线速度和角速度的参数，turtle_vel.publish(vel_msg);rate.sleep();}return 0;
};

分析：由于tf的会把监听的内容存放到一个缓存中，再读取内容，而这个过程可能会有几毫秒的延迟，所以，tf的监听器并不能立即监听到“现在”的变换，所以如果不使用try,catch函数会导致报错：
不可以把ros::Time(0)改成ros::time::now()，因为监听做不到实时，会有几毫秒的延迟。ros::Time(0)指最近时刻存储的数据，ros::time::now()则指当下，如果非要使用ros::time::now,则需要结合waitForTransform()使用，具体见:
http://wiki.ros.org/tf/Tutorials/tf%20and%20Time%20%28C++%29
实际中ros::Time(0)大多数情况下可以满足要求。

“world” passed to lookupTransform argument target_frame does not exist. ”

（2）在CMakeList.txt中添加我们刚刚新建的文件，需要编译的文件

add_executable(turtle_tf_listener src/turtle_tf_listener.cpp)
target_link_libraries(turtle_tf_listener ${catkin_LIBRARIES})

（3）catkin_make 编译
（4）为了查看效果在之前的.launch文件中添加下面的一行

<node pkg="my_tf" type="turtle_tf_listener"name="listener" />

（5）运行roslaunch my_tf start_demo.launch

具体的解释在代码中也是有给出了，所以我们直接运行结果查看

可以发现我们在按移动turtle1的时候turtle2也会跟在后面走，那是因为turtle2监听了turtle1转换到turtle2的TF 消息了，可以查看下一
rosrun tf tf_echo /turtle1 /turtle2

不过好像并看不出来什么,但是我们可以从代码中可以明白一点什么

Gmapping从开始到放弃—写一个TF 监听相关推荐

Gmapping从开始到放弃—写一个TF 广播
这是一个关于实现把机器人的位姿广播到TF中,这是对ROS 有一定的熟悉之后教程 (1)cd catkin_ws/src 进入我们的ROS 的工作空间 (2)catkin_create_pkg my_t ...
python多进程关闭socket_用Python制作一个多进程UDP服务器，一个进程监听一个p
我想用Python制作一个多进程UDP服务器,从一个类中为每个进程监听一个端口: processListener.py:import multiprocessing import socket cla ...
发布订阅模式仿写Vue事件监听手写js实现
Vue组件中,可以使用 $emit,$on,$off 分别来分发.监听.取消监听事件实现组件通信,比较方便: 最近空闲时间手撸代码实现了发布订阅模式,可以进行组件通信. 话不多说,直接上代码 /*** ...
android rxbus 一个页面监听,Android RxBus的使用
RxBus的核心功能是基于Rxjava的,在RxJava中有个Subject类,它继承Observable类,同时实现了Observer接口,因此Subject可以同时担当订阅者和被订阅者的角色,这里 ...
JavaWeb监听器简单介绍及一个登陆监听案例
版权声明:本文为博主原创文章,未经博主允许不得转载.https://blog.csdn.net/qq_38720976/article/details/84474950 监听器基本概念 JavaWeb ...
什么都没学到，记录一个鼠标监听事件吧
textField.addMouseListener(new MouseAdapter() { //鼠标在textField中时,改变btnNewButton的文本内容貌似我的概念是 ...
自己动手写一个能操作redis的客户端
作者:孤独烟来自:http://rjzheng.cnblogs.com/ 引言 redis大家在项目中经常会使用到.官网也提供了多语言的客户端供大家操作redis,如下图所示但是,大家有思考过,这 ...
深入理解如何不费吹灰之力搭建一个无人驾驶车（四）2D-小车自主部分（从无到有自己写一个无人驾驶框架）（CSDN独创）
四.从无到有自己动手写个slam算法(CSDN独创) 注1:必须先看完前三章再看这一章,如果想看得轻松请看<概率机器人>与<机器人学状态估计>完再看注2:本篇为CSDN独创, ...
手写一个网关服务，理解更透彻！
点击关注公众号,实用技术文章及时了解背景介绍我们在工作中经常会需要处理http请求,通常都是基于SpringBoot应用直接接受外界的http请求,就如同下方的流程图所示: 但是随着后台应用的增加 ...

Gmapping从开始到放弃—写一个TF 监听

Gmapping从开始到放弃—写一个TF 监听相关推荐

最新文章

热门文章