TF坐标
2024-10-21 06:22:39
1.简介
TF是一个让用户随时间跟踪多个坐标系的功能包,它使用树形数据结构,根据时间缓冲并维护多个坐标系之间的坐标变换关系。
2.TF工具
- tf_monitor :查看TF树中所有坐标系的发布状态
- tf_monitor <source_frame> <target_target> :查看指定坐标系之间的发布状态
- tf_echo <source_frame> <target_target> :查看指定坐标系之间的变换关系
- view_frames :可视化工具,生成pdf文件 rosrun tf view_frames
3.实践
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)
{
// tf广播器
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];
// 订阅乌龟的pose信息
ros::NodeHandle node;
ros::Subscriber sub = node.subscribe(turtle_name+"/pose", 10, &poseCallback);
ros::spin();
return 0;
};
turtle_tf_lestener.cpp
#include <ros/ros.h>
#include <tf/transform_listener.h>
#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;
// 通过服务调用,产生第二只乌龟turtle2
ros::service::waitForService("spawn");
ros::ServiceClient add_turtle =
node.serviceClient<turtlesim::Spawn>("spawn");
turtlesim::Spawn srv;
add_turtle.call(srv);
// 定义turtle2的速度控制发布器
ros::Publisher turtle_vel =
node.advertise<geometry_msgs::Twist>("turtle2/cmd_vel", 10);
// tf监听器
tf::TransformListener listener;
ros::Rate rate(10.0);
while (node.ok())
{
tf::StampedTransform transform;
try
{
// 查找turtle2与turtle1的坐标变换
listener.waitForTransform("/turtle2", "/turtle1", ros::Time(0), ros::Duration(3.0));
listener.lookupTransform("/turtle2", "/turtle1", ros::Time(0), transform);
//这里求的transform是turtle2到turtle1的变换
}
catch (tf::TransformException &ex)
{
ROS_ERROR("%s",ex.what());
ros::Duration(1.0).sleep();
continue;
}
// 根据turtle1和turtle2之间的坐标变换,计算turtle2需要运动的线速度和角速度
// 并发布速度控制指令,使turtle2向turtle1移动
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;
};
rosrun rviz rviz -d 'rospack find turtle_tf' /rviz/turtle_rviz.rviz
最新文章
- UDS(ISO14229-2006) 汉译(No.7 应用层协议)【未完,待续】
- [转]不优雅的方式处理 xlrd 中 int/float 的问题
- Q_OBJECT
- NSString几个函数
- 如何在VirtualBox虚拟机软件上安装Win7虚拟系统
- Linux驱动设计—— 驱动调试技术
- 通过Log4j的DEBUG级别来显示mybatis的sql语句
- [转]AIX下调整分区大小
- Python 计算已经过去多少个周末
- UVA 10003 Cutting Sticks 切木棍 dp
- 【足迹C++primer】49、超载,变化,运营商
- [NEUQ-OJ] 1012	SZ斐波拉契数列
- 为UIView添加分类直接改或获取控件的frame值
- 终端管理软件tmux
- 阿里云服务器php环境的搭建
- SpringCloud用户自定义配置信息的定义和查看
- CentOS7+CDH5.14.0安装CDH错误排查:HBase服务出现 该运行状况测试不良,因为 Service Monitor 未找到活动 Master
- BZOJ3862 Little Devil I 树链剖分
- Docker学习笔记之使用 Docker Hub 中的镜像
- php emoji mysql保存和搜索
热门文章
- 使用vite + vue3 + ant-design-vue + vue-router + vuex 创建一个管理应用
- nydusd 源码理解(一)
- Android 按钮自定义背景后点击没有动画效果
- svn 日常使用的错误集锦
- ArcObjects SDK开发 007 自定义App-Command-Tool框架
- elasticsearch 聚合之 date_histogram 聚合
- js-day04-作业
- 大数据-业务数据采集-FlinkCDC
- MySQL可视化软件(Navicat)部署与使用
- 微软出品自动化神器【Playwright+Java】系列(六) 之 字符输入、单元素键盘事件操作、上传文件、聚焦、拖拽、悬浮操作