目录
根据网上的教程,学习理解tf坐标系的运用,同时巩固之前的通信,加深理解
一起实现一下可爱的 海龟跟踪
一、两个工具
首先我们运行这个demo
$ roslaunch turtle_tf turtle_tf_demo.launch
生成了一个frames.pdf文件该文件描述了参考系之间的联系。/world是其他两个乌龟参考系的父参考系。
(一)rosrun tf view_frames
(二)rosrun rviz rviz -d rospack find turtle_tf
/rviz/turtle_rviz.vcg
rviz的图形界面更加形象的看到这三者之间的关系
代码讲解
广播
/**
* 该例程产生tf数据,并计算、发布turtle2的速度指令
*/
#include <ros/ros.h>
#include <tf/transform_broadcaster.h>
#include <turtlesim/Pose.h>
std::string turtle_name;
void poseCallback(const turtlesim::PoseConstPtr& msg)
{
//创建tf广播器
static tf::TransformBroadcaster br;
//初始化tf数据,XYZ的坐标和roll绕x轴 pitch绕y轴 yaw绕z轴三个方向的旋转角度
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)