ROS第 13 课 TF 坐标系广播与监听的编程 实现

文章目录

  • 第 13 课 TF 坐标系广播与监听的编程 实现
    • 1.机器人的坐标变换
    • 2.创建功能包
    • 3.编程方法
      • 3.1 编写广播和监听程序
      • 3.2 运行程序

第 13 课 TF 坐标系广播与监听的编程 实现

1.机器人的坐标变换

在进行编程前,先需要了解机器人的坐标变换。这里以运行海龟案例来进行解说,步骤如下:

  1. 输入指令“sudo apt-get install ros-melodic-turtle-tf”,安装功能包。
    在这里插入图片描述
    其中“melodic”对应的是ROS版本。
  2. 输入指令“roslaunch turtle_tf turtle_tf_demo.launch”,启动launch文件。
    在这里插入图片描述
  3. 输入指令“rosrun turtlesim turtle_teleop_key”,运行海龟键盘控制节点。
    在这里插入图片描述
    在这里插入图片描述
  4. 输入指令“rosrun tf view_frames”,可视化框架。
    在这里插入图片描述
    在主目录下可以找到“frames.pdf”文件,如下图:
    在这里插入图片描述
    打开“frames.pdf”文件,可以看到当前系统TF坐标之间的位置关系,如下图:
    在这里插入图片描述

2.创建功能包

下面,就开始创建功能包,步骤如下:

  1. 输入指令“cd catkin_ws/src/”,回车,进入工作空间。
    在这里插入图片描述
  2. 输入指令“catkin_create_pkg tf_hiwonder rospy std_msgs”,回车,创建功能包。
    在这里插入图片描述

3.编程方法

3.1 编写广播和监听程序

  1. 打开Linux命令行终端。
  2. 输入进入功能包所在目录的指令“roscd tf_hiwonder”,并按下回车。
    在这里插入图片描述
  3. 输入指令“mkdir scripts”,并按下回车,新建用于存放Python脚本的文件夹“scripts”。
    在这里插入图片描述
  4. 输入指令“cd scripts/”,并按下回车,进入用于存放Python脚本的文件夹“scripts”。
    在这里插入图片描述
  5. 输入指令“vi turtle_tf_broadcaster.py”编辑程序,复制下面程序。如需修改,再按下“i”即可修改。修改完成,按下“Esc”,输入“:wq”保存并退出。
    在这里插入图片描述
#!/usr/bin/env python
# -*- coding: utf-8 -*-
# 该例程监听turtlesim节点发布的乌龟位姿,并将其转换为tf转换消息广播出去# 导入tf模块,这是ROS中用于处理转换的库
import tf
# 导入rospy,这是Python编写ROS节点的主要库
import rospy
# 导入turtlesim包的Pose消息类型
import turtlesim.msg# 定义处理乌龟位姿消息的函数
def handle_turtle_pose(msg, turtlename):# 创建一个TransformBroadcaster对象,用于发送转换br = tf.TransformBroadcaster()# 发送转换,包括:# - 位置:根据乌龟的x、y坐标和固定的z坐标(0,因为turtlesim是2D的)# - 方向:将乌龟的角度转换成四元数,因为转换需要使用四元数来表示旋转# - 时间戳:当前的ROS时间# - 子坐标系:乌龟的名称# - 父坐标系:世界坐标系(通常称为"world")br.sendTransform((msg.x, msg.y, 0),tf.transformations.quaternion_from_euler(0, 0, msg.theta),rospy.Time.now(),turtlename,"world")# 程序的主入口
if __name__ == '__main__':# 初始化ROS节点,名为'turtle_tf_broadcaster'rospy.init_node('turtle_tf_broadcaster')# 获取私有命名空间下的'turtle'参数,这将确定我们关注的是哪个乌龟turtlename = rospy.get_param('~turtle')# 订阅乌龟的位姿话题,这个话题名称是通过拼接乌龟的名字动态确定的rospy.Subscriber('/%s/pose' % turtlename,turtlesim.msg.Pose,handle_turtle_pose,turtlename)# ROS的spin循环,这将保持你的程序不会退出直到节点被明确关闭rospy.spin()

在这里插入图片描述
6) 输入指令“vi turtle_tf_listener.py”编辑程序,复制下面程序。如需修改,再按下“i”即可修改。修改完成,按下“Esc”,输入“:wq”保存并退出。
在这里插入图片描述

#!/usr/bin/env python
# -*- coding: utf-8 -*-
# 该例程监听turtle1的tf变换,并使turtle2向turtle1移动# 导入所需要的模块
import roslib
import rospy
import math
import tf  # 用于处理ROS中的坐标变换
import geometry_msgs.msg  # 导入消息类型,用于发布速度
import turtlesim.srv  # 导入服务类型,用于创建新的乌龟# 程序的主入口
if __name__ == '__main__':# 初始化ROS节点,名为'turtle_tf_listener'rospy.init_node('turtle_tf_listener')# 创建一个TransformListener对象,用于接收坐标变换listener = tf.TransformListener()# 等待spawn服务变得可用rospy.wait_for_service('spawn')# 创建一个服务客户端,用于调用spawn服务以生成新的乌龟spawner = rospy.ServiceProxy('spawn', turtlesim.srv.Spawn)# 调用spawn服务,在(4, 2)坐标处生成新的乌龟,角度为0,名为'turtle2'spawner(4, 2, 0, 'turtle2')# 创建一个发布者,用于发布turtle2的速度turtle_vel = rospy.Publisher('turtle2/cmd_vel', geometry_msgs.msg.Twist, queue_size=1)# 设置循环的频率为10Hzrate = rospy.Rate(10.0)while not rospy.is_shutdown():  # 当ROS没有关闭时循环执行try:# 查询turtle2到turtle1的最新变换,返回平移和旋转信息(trans, rot) = listener.lookupTransform('/turtle2', '/turtle1', rospy.Time(0))# 如果在查询变换时发生异常,则继续下一次循环except (tf.LookupException, tf.ConnectivityException, tf.ExtrapolationException):continue# 根据turtle2和turtle1的相对位置计算出需要向turtle1移动的速度angular = 4 * math.atan2(trans[1], trans[0])  # 角速度linear = 0.5 * math.sqrt(trans[0] ** 2 + trans[1] ** 2)  # 线速度cmd = geometry_msgs.msg.Twist()  # 创建速度消息cmd.linear.x = linear  # 设置线速度cmd.angular.z = angular  # 设置角速度turtle_vel.publish(cmd)  # 发布速度消息,使turtle2向turtle1移动rate.sleep()  # 等待一段时间直到达到10Hz的循环频率

在这里插入图片描述
6) 输入指令“chmod +x turtle_tf_broadcaster.py”和“chmod +x turtle_tf_listener.py”,并按下回车,赋予文件可执行权限。
在这里插入图片描述
在这里插入图片描述
7) 输入指令“cd …”和“mkdir launch”,新建用于存放launch脚本的文件夹“launch”。
在这里插入图片描述
在这里插入图片描述
8) 输入指令“cd launch/”,并按下回车,进入用于存放Python脚本的文件夹“launch”。
在这里插入图片描述
9) 输入指令“vi start_tf_demo_py.launch”编辑程序,复制下面程序。如需修改,再按下“i”即可修改。修改完成,按下“Esc”,输入“:wq”保存并退出。
在这里插入图片描述

<launch><!-- Turtlesim Node--><node pkg="turtlesim" type="turtlesim_node" name="sim"/><node pkg="turtlesim" type="turtle_teleop_key" name="teleop" output="screen"/><node name="turtle1_tf_broadcaster" pkg="tf_hiwonder" type="turtle_tf_broadcaster.py" respawn="false" output="screen" ><param name="turtle" type="string" value="turtle1" /></node><node name="turtle2_tf_broadcaster" pkg="tf_hiwonder" type="turtle_tf_broadcaster.py" respawn="false" output="screen" ><param name="turtle" type="string" value="turtle2" /> </node><node pkg="tf_hiwonder" type="turtle_tf_listener.py" name="listener" /></launch>

在这里插入图片描述

3.2 运行程序

  1. 输入指令“source ./devel/setup.bash”,并按下回车,设置工作环境。
    在这里插入图片描述
  2. 输入指令“roslaunch tf_hiwonder start_tf_demo_py.launch”,并按下回车,运行launch程序。
    在这里插入图片描述
    一只海龟自动行走到另一只海龟位置,显示如下图:
    在这里插入图片描述
  3. 如需终止程序,可按下快捷键“Ctrl+C”。

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.mzph.cn/news/638848.shtml

如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈email:809451989@qq.com,一经查实,立即删除!

相关文章

体验开源香山高性能开源 RISC-V 处理器

整体架构设计 香山处理器是乱序六发射结构设计&#xff0c;目前支持 RV64GCBK 扩展。香山处理器前端流水线包括分支预测单元、取指单元、指令缓冲等单元&#xff0c;顺序取指。后端包括译码、重命名、重定序缓冲、保留站、整型/浮点寄存器堆、整型/浮点运算单元。 doc https…

有关软件测试的,任何时间都可以,软件测试主要服务项目:测试用例 报告 计划

有关软件测试的&#xff0c;任何时间都可以&#xff0c;软件测试主要服务项目&#xff1a; 1. 测试用例 2. 测试报告 3. 测试计划 4. 白盒测试 5. 黑盒测试 6. 接口测试 7.自动…

Vuex的基础使用

在使用之前要先了解Vuex的组成结构&#xff0c;跟对应的使用关系。 在上图的结构图中可以看到四个组成部分&#xff0c;首先是Components&#xff08;组件&#xff09;、Actions&#xff08;行动&#xff09;、Mutations&#xff08;变化&#xff09;、state&#xff08;状态/数…

Vue——计算属性

文章目录 计算属性computed 计算属性 vs methods 方法计算属性完整写法 综合案例&#xff1a;成绩案例 计算属性 概念&#xff1a;基于现有的数据&#xff0c;计算出来的新属性。依赖的数据变化&#xff0c;自动重新计算 语法: ①声明computed配置项中&#xff0c;一个计算属性…

清华大学计算机学科推荐学术会议和期刊列表——网络与信息安全

A类会议 这里仅列出A类会议 会议简称会议全程网址IEEE S&PIEEE Symposium on Security and Privacyhttp://dblp.uni-trier.de/db/conf/sp/NDSSISOC Network and Distributed System Security Symposiumhttp://dblp.uni-trier.de/db/conf/ndss/USENIX SecurityUsenix Secu…

nodejs学习计划--(三)http协议和IP介绍

一、 HTPP协议 1、概念 HTTP&#xff08;hypertext transport protocol&#xff09;协议&#xff1b;中文叫超文本传输协议 是一种基于TCP/IP的应用层通信协议 这个协议详细规定了 浏览器 和万维网 服务器 之间互相通信的规则。 协议中主要规定了两个方面的内容 客户端&…

gin渲染篇

1. 各种数据格式的响应 json、结构体、XML、YAML类似于java的properties、ProtoBuf package mainimport ("github.com/gin-gonic/gin""github.com/gin-gonic/gin/testdata/protoexample" )// 多种响应方式 func main() {// 1.创建路由// 默认使用了2个中…

链表中倒数第k个结点(附带源码)

目录 代码部分&#xff1a; 核心&#xff1a;看图 代码部分&#xff1a; struct ListNode* FindKthToTail(struct ListNode* pListHead, int k ) {// write code here// write code hereif (k 0){return NULL;}else{struct ListNode* slow pListHead, * fast pListHead;//…

C++中函数的默认参数(缺省参数)

一、函数默认参数的概念 在函数声明时&#xff0c;预先对函数参数进行赋值&#xff0c;该参数即为函数的默认参数&#xff0c;也叫缺省参数。 如下函数func1包含默认参数&#xff0c;若调用函数func1时没有给函数传入实参&#xff0c;则默认实参为10086 void func1(int a 1…

【Redis】Ubuntu安装配置

目录 一、安装Redis 1.1 从APT仓库安装Redis 二、启动&关闭&重启 三、Redis核心配置 3.1 CONFIG命令 3.2 redis.conf文件说明 一、安装Redis 1.1 从APT仓库安装Redis 从APT仓库可以安装最新的Redis稳定版&#xff0c;步骤如下&#xff1a; 【1】安装需要用到的…

Spring 中有哪些方式可以把 Bean 注入到 IOC 容器?

目录 1、xml方式2、CompontScan Component3、使用 Bean方式4、使用Import 注解5、FactoryBean 工厂 bean6、使用 ImportBeanDefinitionRegistrar 向容器中注入Bean7、实现 ImportSelector 接口 1、xml方式 使用 xml 的方式来声明 Bean 的定义&#xff0c;Spring 容器在启动的…

Linux内核pinctrl子系统驱动框架

一. 简介 本文简单了解一下Linux内核代码中&#xff0c; pinctrl子系统的驱动实现。 注意&#xff1a;本文会涉及到 Linux 驱动分层与分离、平台设备驱动等还未讲解的知识 &#xff0c;所以&#xff0c;也不会影响后续的实验。 二. Linux内核pinctrl子系统驱动 1. probe函…

【数学建模】数据处理与可视化

文章目录 数值计算工具NumPy数组的创建、属性和操作数组的运算、通用函数和广播运算Numpy.random模块的随机数生成文本文件和二进制文件存取 文件操作文件基本操作文件管理方法 数据处理工具PandasSeries和DataFrame外部文件存取 Matplotlib可视化基础用法可视化应用可视化综合…

2023年DevOps国际峰会暨 BizDevOps 企业峰会(DOIS北京站):核心内容与学习收获(附大会核心PPT下载)

随着科技的飞速发展&#xff0c;软件开发的模式和流程也在不断地演变。在众多软件开发方法中&#xff0c;DevOps已成为当下热门的软件开发运维一体化模式。特别是在中国&#xff0c;随着越来越多的企业开始认识到DevOps的价值&#xff0c;这一领域的研究与实践活动日益活跃。本…

互联网架构演变过程

互联网架构演变过程 互联网架构经历了几个重要的演变过程&#xff0c;主要包括以下几个阶段&#xff1a; 单一服务器架构&#xff1a;早期的互联网应用通常运行在单一的服务器上&#xff0c;该服务器负责处理所有的请求和数据存储。这种架构简单直接&#xff0c;但容易出现性能…

反序列化字符串逃逸(下篇)

这里承接上篇文章反序列化字符串逃逸&#xff08;上篇&#xff09;-CSDN博客带大家学习反序列化字符串逃逸减少&#xff0c;没有看过的可以先去看看&#xff0c;不会吃亏。 例题&#xff1a; <?php highlight_file(__FILE__); error_reporting(0); function filter($name…

数据结构编程题:Phone List

题目描述 Given a list of phone numbers, determine if it is consistent in the sense that no number is the prefix of another. Let’s say the phone catalogue listed these numbers: 段落大意:给定一组电话号码&#xff0c;判断它们是否一致&#xff0c;即没有一个号码…

Linux_清理docker磁盘占用

文章目录 前言一、docker system 命令1. docker system df&#xff08;本文重点使用&#xff09;2. docker system prune&#xff08;本文重点使用&#xff09;3. docker system info4. docker system events 二、开始清理三、单独清理Build Cache四、单独清理未被使用的网络 前…

nginx虚拟主机

虚拟主机指的就是一个独立的站点配置&#xff0c;是nginx默认支持的一个功能&#xff0c;它能够有自己独立的域名&#xff0c;独立的ip&#xff0c;独立的端口配置&#xff0c;能够配置完整的www服务&#xff0c;列如网站搭建&#xff0c;邮件服务器代理等等。并且nginx支持多虚…

回归预测 | Python基于Encoder-TCN-BIGRU-Decoder多变量回归预测

目录 效果一览基本介绍程序设计参考资料 效果一览 基本介绍 1.支持多输入&#xff0c;单输出&#xff01; 2.使用了多种可视化方法&#xff0c;代码编写过程中也对各段代码进行封装&#xff0c;方便解读和调试&#xff01; 3.适合于风电数据&#xff0c;光伏数据&#xff0c;环…