ROS tf广播编写
博客参考:https://www.ncnynl.com/archives/201702/1310.html
ROS与C++入门教程-tf-编写tf broadcaster(广播)
说明:
- 介绍如何广播机器人的坐标系到tf。
准备:
- 在我们开始之前,你需要为这个项目创建一个新的ros包。
- 创建一个名为learning_tf的软件包,该软件包依赖于tf,roscpp,rospy和turtlesim:
$ cd ~/catkin_ws/src
$ catkin_create_pkg learning_tf tf roscpp rospy turtlesim $ cd ~/catkin_ws/src
$ catkin_make
$ source ./devel/setup.bash
广播变换
- 新建文件turtle_tf_broadcaster.cpp. 参考源码
$ roscd learning_tf
$ touch src/turtle_tf_broadcaster.cpp
- 代码如下:
#include <ros/ros.h>
#include <tf/transform_broadcaster.h>
#include <turtlesim/Pose.h> std::string turtle_name; void poseCallback(const turtlesim::PoseConstPtr& msg){
static tf::TransformBroadcaster br;
tf::Transform transform;
transform.setOrigin( tf::Vector3(msg->x, msg->y, 0.0) );
tf::Quaternion q;
q.setRPY(0, 0, msg->theta);
transform.setRotation(q);
br.sendTransform(tf::StampedTransform(transform, ros::Time::now(), "world", turtle_name));
} int main(int argc, char** argv){
ros::init(argc, argv, "my_tf_broadcaster");
if (argc != 2){ROS_ERROR("need turtle name as argument"); return -1;};
turtle_name = argv[1]; ros::NodeHandle node;
ros::Subscriber sub = node.subscribe(turtle_name+"/pose", 10, &poseCallback); ros::spin();
return 0;
};
代码解释:
代码:#include <tf/transform_broadcaster.h>
作用:
- tf包提供了TransformBroadcaster的实现,以帮助使发布变换的任务更容易。
- 要使用TransformBroadcaster,我们需要包含tf/transform_broadcaster.h头文件。
代码:static tf::TransformBroadcaster br;
作用:我们创建一个TransformBroadcaster对象,我们稍后将使用它通过线路发送转换。
代码:
tf::Transform transform;
transform.setOrigin( tf::Vector3(msg->x, msg->y, 0.0) );
tf::Quaternion q;
q.setRPY(0, 0, msg->theta);
作用:这里我们创建一个Transform对象,并将信息从2D乌龟姿势复制到3D变换中。
代码:transform.setRotation(q);
作用:这里我们设置旋转。
代码:br.sendTransform(tf::StampedTransform(transform, ros::Time::now(), "world", turtle_name));
作用:
- 这是真正的工作完成的地方。
- 使用TransformBroadcaster发送转换需要四个参数。
- 首先,我们传递转换本身。
- 现在我们需要给被发布的变换一个时间戳,我们只是用当前时间戳它,ros::Time::now().
- 然后,我们需要传递我们创建的链接的父框架的名称,在这种情况下为“world”
- 最后,我们需要传递我们正在创建的链接的子框架的名称,在这种情况下,这是乌龟本身的名称。
注意:sendTransform和StampedTransform具有父对象和子对象的相反顺序。
运行广播
- 编辑CMakeLists.txt文件,增加:
add_executable(turtle_tf_broadcaster src/turtle_tf_broadcaster.cpp)
target_link_libraries(turtle_tf_broadcaster ${catkin_LIBRARIES})
- 编译:
$ cd ~/catkin_ws/src
$ catkin_make
如果编译顺利, 生成二进制的turtle_tf_broadcaster文件,位于devel/lib/learning_tf
创建 start_demo.launch,用于启动节点,内容如下:
<launch>
<!-- Turtlesim Node-->
<node pkg="turtlesim" type="turtlesim_node" name="sim"/> <node pkg="turtlesim" type="turtle_teleop_key" name="teleop" output="screen"/>
<!-- Axes -->
<param name="scale_linear" value="2" type="double"/>
<param name="scale_angular" value="2" type="double"/> <node pkg="learning_tf" type="turtle_tf_broadcaster"
args="/turtle1" name="turtle1_tf_broadcaster" />
<node pkg="learning_tf" type="turtle_tf_broadcaster"
args="/turtle2" name="turtle2_tf_broadcaster" /> </launch>
- 执行launch
$ roslaunch learning_tf start_demo.launch
- 你应该看到乌龟模拟另一个乌龟。
检查结果:
- 现在,使用tf_echo工具检查龟的姿势是否真正得到广播到tf
$ rosrun tf tf_echo /world /turtle1
- 这应该显示第一只乌龟的姿势。 使用箭头键(确保您的终端窗口是活动的,而不是你的模拟器窗口)绕乌龟。
- 如果你运行tf_echo在/world和/turtle2之间的转换,你不应该看到一个变换,因为第二个乌龟还没有。
- 但是,一旦我们在下一个教程中添加第二只乌龟,turtle2的姿势将被广播到tf。
ROS tf广播编写的更多相关文章
- ROS tf
一.节点中使用(cpp,python) 1. ros wiki 提供的tutorials 2. https://blog.csdn.net/start_from_scratch/article/det ...
- ROS Learning-010 beginner_Tutorials 编写简单的启动脚本文件(.launch 文件)
ROS Indigo beginner_Tutorials-09 编写简单的启动脚本文件 我使用的虚拟机软件:VMware Workstation 11 使用的Ubuntu系统:Ubuntu 14.0 ...
- ROS tf监听编写
博客转载自:https://www.ncnynl.com/archives/201702/1311.html ROS与C++入门教程-tf-编写tf listener(监听) 说明: 介绍如何使用tf ...
- ROS TF——learning tf
在机器人的控制中,坐标系统是非常重要的,在ROS使用tf软件库进行坐标转换. 相关链接:http://www.ros.org/wiki/tf/Tutorials#Learning_tf 一.tf简介 ...
- SLAM+语音机器人DIY系列:(二)ROS入门——5.编写简单的消息发布器和订阅器
摘要 ROS机器人操作系统在机器人应用领域很流行,依托代码开源和模块间协作等特性,给机器人开发者带来了很大的方便.我们的机器人“miiboo”中的大部分程序也采用ROS进行开发,所以本文就重点对ROS ...
- SLAM+语音机器人DIY系列:(二)ROS入门——6.编写简单的service和client
摘要 ROS机器人操作系统在机器人应用领域很流行,依托代码开源和模块间协作等特性,给机器人开发者带来了很大的方便.我们的机器人“miiboo”中的大部分程序也采用ROS进行开发,所以本文就重点对ROS ...
- ROS tf基础使用知识
博客参考:https://www.ncnynl.com/archives/201702/1306.html ROS与C++入门教程-tf-坐标变换 说明: 介绍在c++实现TF的坐标变换 概念: Co ...
- ROS tf 两个常用的函数
/** \brief Get the transform between two frames by frame ID. * \param target_frame The frame to wh ...
- ROS tf 编程指南
ROS (Robot Operating System, 机器人操作系统)是最知名的机器人操作系统,广泛应用于无人驾驶和机器人,tf(transforms,坐标系转换)是ROS下的一个常用的工具库.r ...
随机推荐
- Dubbo基础入门
Dubbo概述 Dubbo的背景 随着互联网的发展,网站应用的规模不断扩大,常规的垂直应用架构已无法应对,分布式服务架构以及流动计算架构势在必行,亟需一个治理系统确保架构有条不紊的演进. 单一应用架构 ...
- if __name__ == "__main__",python主程序入口
https://blog.csdn.net/liukai2918/article/details/79465671
- php流程控制 之循环语句的使用
循环语句的使用 王同学需要反复往返于北京和大连,就是典型的循环结构.假设王思总投资这个项目需要往返大连100次,每次往返都王同学都会计数一次.难道我们写一百遍同样的代码?显然对于智商极高的程序员来说不 ...
- CSP 初赛 知识点整理
BIOS: BIOS是英文"Basic Input Output System"的缩略词,直译过来后中文名称就是"基本输入输出系统".其实,它是一组固化到计算机 ...
- 获取当前主题颜色 Flutter
通过context获取当前主题颜色 Theme.of(context).accentColor
- LIO -SCSI target
2010年底,LIO 项目获选成为新的内核态的 SCSI target,取代原有的用户态的 STGT 项目.当时有两个主要的竞争项目(LIO和SCST),都在努力将代码并入主线内核.本文将比较着两个项 ...
- nginx和php整合安装过程记录
1.nginx的配置:必须是指定 www用户 和www用户组访问 groupadd www useradd -g www www daokr@DK:~$ cat /etc/nginx/nginx.co ...
- (21)打鸡儿教你Vue.js
组件化思想: 组件化实现功能模块的复用 高执行效率 开发单页面复杂应用 组件状态管理(vuex) 多组件的混合使用 vue-router 代码规范 vue-router <template> ...
- C++2.0新特性(四)——<decltype、lambda>
一.关键字decltype 引入新关键字decltype可以让编译器找出表达式的类型,为了区别typeof,以下做一个概念区分: typeof 是一个一元运算,放在一个运算数之前,运算数可以是任意类型 ...
- [提权]mysql中的UDF提权
由于udf提权是需要构造UDF函数文件的,涉及到了写文件.所以本次实验已经将mysql的配置做了改动:–secure-file-priv=''. 剧情须知: secure_file_priv 为 NU ...