ROS——坐标系管理、监听与广播、常用可视化工具

news2025/2/26 2:04:39

坐标系管理

在这里插入图片描述
x

TF功能包

在这里插入图片描述

小海龟追踪实验

  • ros版本(20.04)的tf安装命令: sudo apt-get install ros-noetic-turtle-tf

  • 解决因python版本出现的无法生成跟随海龟: sudo ln -s /usr/bin/python3 /usr/bin/python ( -s 软链接,符号链接)

  • ln命令(英文全拼:link files)命令是一个非常重要命令,它的功能是为某一个文件在另外一个位置建立一个同步的链接。
    当我们需要在不同的目录,用到相同的文件时,我们不需要在每一个需要的目录下都放一个必须相同的文件,我们只要在某个固定的目录,放上该文件,然后在 其它的目录下用ln命令链接(link)它就可以,不必重复的占用磁盘空间。

  • Linux文件系统中,有所谓的链接(link),我们可以将其视为档案的别名,而链接又可分为两种 : 硬链接(hard link)与软链接(symbolic link),硬链接的意思是一个档案可以有多个名称,而软链接的方式则是产生一个特殊的档案,该档案的内容是指向另一个档案的位置。硬链接是存在同一个文件系统中,而软链接却可以跨越不同的文件系统。
    不论是硬链接或软链接都不会将原本的档案复制一份,只会占用非常少量的磁碟空间。

  • 在执行view_frames出现错误: cannot use a string pattern on a bytes-like object

  • 解决方案: 将/opt/ros/noetic/lib/tf/view_frames文件第89行由 m = r.search(vstr) 修改为 m = r.search(str(vstr))(用str将vstr转化为string)。
    在这里插入图片描述

可视化工具

  • rviz: noetic 版本,直接在终端执行 rviz即可
    在这里插入图片描述
  • Fixed Frame: 选择world
  • Add选项:添加TF
    在这里插入图片描述

tf监听和广播

创建功能包

在这里插入图片描述

四元数

Quaternion(四元数)是一种扩展了复数概念的数学系统,由爱尔兰数学家威廉·罗文·汉密尔顿在1843年首次描述。四元数在三维空间的力学中被广泛应用。

一个四元数可以表示为:

q = a + bi + cj + dk

其中:

q 是四元数,
a, b, c, 和 d 是实数,
i, j, 和 k 是四元数的基本单位。
四元数的关键特性是乘法不满足交换律,也就是说 pq 并不一定等于 qp。

四元数在多个领域中都有应用,尤其是在计算机图形学、控制理论、信号处理、姿态控制、物理学和轨道力学中,因为它们提供了一种有效的方式去表示三维空间中的旋转或方向。

在电脑游戏和3D动画中,四元数常用于避免万向锁问题(Gimbal Lock),以及进行平滑的旋转插值(例如SLERP)。

RPY

在坐标系中,RPY代表“Roll(横滚)、Pitch(俯仰)和Yaw(偏航)”,这是描述一个刚体在三维空间中旋转的三个基本角度。这些术语最初源自航空和航海领域,用来描述飞行器或船只相对于地球的定向。

Roll(横滚):绕着物体自身的 x 轴旋转。如果考虑的是一个飞机,横滚是指机翼的上下翻转。
Pitch(俯仰):绕着物体自身的 y 轴旋转。俯仰是指飞机机头的上下移动。
Yaw(偏航):绕着物体自身的 z 轴旋转。偏航是指飞机机头向左或向右的转动。
在机器人学、计算机图形学和导航系统中,RPY 角也被称为欧拉角的一种特定序列。当描述物体的旋转时,通常会按照一个固定的顺序应用这三个旋转,这个顺序可以是 XYZ 或者 ZYX 等,这取决于具体的应用场景和坐标系约定。

RPY 角可以单独使用,也可以组合起来形成一个旋转矩阵或者四元数,以便更有效地进行计算和表示刚体的完整姿态。在机器人技术中,RPY 常用来描述机械臂末端执行器或相机等传感器相对于世界坐标系的位置和方向。

实现 tf 广播器

// 例程产生 tf 数据,并计算、发布 turtle2的速度指令
#include <ros/ros.h>
#include <tf/transform_broadcaster.h>
#include <turtlesim/Pose.h>

std::string turtle_name;

//pose回调函数
void poseCallback(const turtlesim::PoseConstPtr& msg){
    //创建tf的广播器
    static tf::TransformBroadcaster br;
    
    //初始化tf数据
    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);
    
    //广播world与海龟坐标系之间的tf数据
    br.sendTransform(tf::StampedTransform(transform,ros::Time::now(),"world",turtle_name));
}

int main(int argc,char** argv){
  
  ros::init(argc,argv,"my_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;
}

实现tf监听器

#include <ros/ros.h>
#include <tf/transform_listener.h>
#include <turtlesim/Spawn.h>
#include <geometry_msgs/Twist.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()){
     //获取turtle1与turtle2坐标系之间的tf数据
     tf::StampedTransform transform;
     try{
       // 判断坐标系中是否存在 turtle1 和 turtle2,持续三秒
       listener.waitForTransform("/turtle2","/turtle1",ros::Time(0),ros::Duration(3.0));
       // 获取tutle1 和 turtle2 的实时位置,将四元数存到transform变量中
       listener.lookupTransform("turtle2","/turtle1",ros::Time(0),transform);
     }
     catch(tf::TransformException &ex){
       ROS_ERROR("%s",ex.what());
       ros::Duration(1.0).sleep();
       continue;
     }
     //根据turtle1与turtle2坐标系之间的位置关系,发布turtle2的速度指令
     geometry_msgs::Twist vel_msg;
     vel_msg.angular.z = 4.0 * atan2(transform.getOrigin().y(),transform.getOrigin().x());
     vel_msg.angular.x = 0.5 * sqrt(pow(transform.getOrigin().x(),2) + pow(transform.getOrigin().y(),2));
     turtle_vel.publish(vel_msg);
     
     rate.sleep();
  }
  
  return 0;
}

配置监听规则

1

编译运行

  • 此处的… name:=turtle1_tf_broadcaster /turtle1 … 代表broadcaster__name的重命名
    在这里插入图片描述

launch启动文件

在这里插入图片描述

launch文件语法

在这里插入图片描述

参数设置

在这里插入图片描述

重映射与节点嵌套

在这里插入图片描述

更多方法

在这里插入图片描述

样例

在这里插入图片描述

自定义参数实例

在这里插入图片描述

广播与监听的实例

在这里插入图片描述

启动launch文件指令: roslaunch 功能包名 文件名.launch

常用可视化工具

在这里插入图片描述

通过rqt指令,将多个工具综合在同一界面

在这里插入图片描述

RVIZ:机器人数据可视化工具

在这里插入图片描述
在这里插入图片描述

工作区域

在这里插入图片描述

Gazebo

  • gazebo
    在这里插入图片描述

ROS用途

在这里插入图片描述
在这里插入图片描述

在这里插入图片描述

在这里插入图片描述

相关资源

在这里插入图片描述
在这里插入图片描述

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

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

相关文章

【C++】B树及其实现

写目录 一、B树的基本概念1.引入2.B树的概念 二、B树的实现1.B树的定义2.B树的查找3.B树的插入操作4.B树的删除5.B树的遍历6.B树的高度7.整体代码 三、B树和B*树1.B树2.B*树3.总结 一、B树的基本概念 1.引入 我们已经学习过二叉排序树、AVL树和红黑树三种树形查找结构&#x…

数据库7.4

第二次作业 1.登陆数据库 2.创建数据库zoo 3.修改数据库zoo字符集为gbk 4.选择当前数据库为zoo 5.查看创建数据库zoo信息 6.删除数据库zoo C:\Windows\System32>mysql -uroot -p20040830Nmx mysql> create database zoo; alter database zoo character set gbk; mys…

InspireFace-商用级的跨平台开源人脸分析SDK

InspireFace-商用级的跨平台开源人脸分析SDK InspireFaceSDK是由insightface开发的⼀款⼈脸识别软件开发⼯具包&#xff08;SDK&#xff09;。它提供了⼀系列功能&#xff0c;可以满⾜各种应⽤场景下的⼈脸识别需求&#xff0c;包括但不限于闸机、⼈脸⻔禁、⼈脸验证等。 该S…

【C++/STL】优先级队列的介绍与模拟实现仿函数

✨ 万物与我皆是自由诗 &#x1f30f; &#x1f4c3;个人主页&#xff1a;island1314 &#x1f525;个人专栏&#xff1a;C学习 &#x1f680; 欢迎关注&#xff1a;&#x1f44d;点赞 &#x1f442;&#x1…

非对称加密算法原理与应用2——RSA私钥加密文件

作者:私语茶馆 1.相关章节 (1)非对称加密算法原理与应用1——秘钥的生成-CSDN博客 第一章节讲述的是创建秘钥对,并将公钥和私钥导出为文件格式存储。 本章节继续讲如何利用私钥加密内容,包括从密钥库或文件中读取私钥,并用RSA算法加密文件和String。 2.私钥加密的概述…

VSCode设置好看清晰的字体!中文用鸿蒙,英文用Jetbrains Mono

一、中文字体——HarmonyOS Sans SC 1、下载字体 官网地址&#xff1a;https://developer.huawei.com/consumer/cn/design/resource/ 直接下载&#xff1a;https://communityfile-drcn.op.dbankcloud.cn/FileServer/getFile/cmtyPub/011/111/111/0000000000011111111.20230517…

[学习笔记]SQL学习笔记(连载中。。。)

学习视频&#xff1a;【数据库】SQL 3小时快速入门 #数据库教程 #SQL教程 #MySQL教程 #database#Python连接数据库 目录 1.SQL的基础知识1.1.表(table)和键(key)1.2.外键、联合主键 2.MySQL安装&#xff08;略&#xff0c;请自行参考视频&#xff09;3.基本的MySQL语法3.1.规…

深度学习模型加密python版本

支持加密的模型: # torch、torch script、onnx、tensorrt 、torch2trt、tensorflow、tensorflow2tensorrt、paddlepaddle、paddle2tensorrt 深度学习推理模型通常以文件的形式进行保存&#xff0c;相应的推理引擎通过读取模型文件并反序列化即可进行推理过程. 这样一来&#…

JDK都出到20多了,你还不会使用JDK8的Stream流写代码吗?

目录 前言 Stream流 是什么&#xff1f; 为什么要用Steam流 常见stream流使用案例 映射 map() & 集合 collect() 单字段映射 多字段映射 映射为其他的对象 映射为 Map 去重 distinct() 过滤 filter() Stream流的其他方法 使用Stream流的弊端 前言 当你某天看…

Windows ipconfig命令详解,Windows查看IP地址信息

「作者简介」&#xff1a;冬奥会网络安全中国代表队&#xff0c;CSDN Top100&#xff0c;就职奇安信多年&#xff0c;以实战工作为基础著作 《网络安全自学教程》&#xff0c;适合基础薄弱的同学系统化的学习网络安全&#xff0c;用最短的时间掌握最核心的技术。 ipconfig 1、基…

【刷题汇总--大数加法、 链表相加(二)、大数乘法】

C日常刷题积累 今日刷题汇总 - day0061、大数加法1.1、题目1.2、思路1.3、程序实现 2、 链表相加(二)2.1、题目2.2、思路2.3、程序实现 3、大数乘法3.1、题目3.2、思路3.3、程序实现 4、题目链接 今日刷题汇总 - day006 1、大数加法 1.1、题目 1.2、思路 读完题,明白大数相加…

react 项目中预防xss攻击的插件 dompurify

一、安装 $ yarn add dompurify $ yarn add --dev types/dompurify 二、使用 import DOMPurify from dompurify;// 1、处理&#xff1a; DOMPurify.sanitize(htmlContent)// 2、之后放进 dangerouslySetInnerHTML dangerouslySetInnerHTML{{ __html: cleanHTML }} 如&#…

【IT领域新生必看】 Java编程中的重载(Overloading):初学者轻松掌握的全方位指南

文章目录 引言什么是方法重载&#xff08;Overloading&#xff09;&#xff1f;方法重载的基本示例 方法重载的规则1. 参数列表必须不同示例&#xff1a; 2. 返回类型可以相同也可以不同示例&#xff1a; 3. 访问修饰符可以相同也可以不同示例&#xff1a; 4. 可以抛出不同的异…

经典双运算放大器LM358

前言 LM358双运放有几十年的历史了吧&#xff1f;通用运放&#xff0c;很常用&#xff0c;搞电路的避免不了接触运放&#xff0c;怎么选择运放&#xff0c;是工程师关心的问题吧&#xff1f; 从本文开始&#xff0c;将陆续发一些常用的运放&#xff0c;大家选型可以参考&#…

win10使用小技巧一

1. 查看电脑IP地址 步骤&#xff1a;按WinR打开运行框 → 输入cmd点确定 → 输入ipconfig回车 → 查看IP地址。 2. 解决网页文字不能复制 步骤&#xff1a;按F12 → 调试框里点击设置 → 向下滑找到 禁用 JavaScript → 勾选 → 复制文字。 3. 解决电脑不能上网 方法一&…

第10章 项目总结02:针对当前项目的面试题

1 项目概况 1.1 项目介绍 从以下几个方面进行项目介绍&#xff1a; 1、项目的背景&#xff1a;做什么业务、服务的客户群是谁、谁去运营、自研还是外包等问题。 2、项目的业务流程&#xff1a;课程发布流程、断点续传流程、视频处理流程、认证授权流程、支付流程、CI/CD流程…

SpringBoot新手快速入门系列教程:基于JPA的一个Mysql简单读写例子

现在我们来做一个简单的读写Mysql的项目 1&#xff0c;先新建一个项目&#xff0c;我们叫它“HelloJPA”并且添加依赖 2&#xff0c;引入以下依赖&#xff1a; Spring Boot DevTools (可选&#xff0c;但推荐&#xff0c;用于开发时热部署)Lombok&#xff08;可选&#xff0c…

cs224n作业4

NMT结构图&#xff1a;&#xff08;具体结构图&#xff09; LSTM基础知识 nmt_model.py&#xff1a; 参考文章&#xff1a;LSTM输出结构描述 #!/usr/bin/env python3 # -*- coding: utf-8 -*-""" CS224N 2020-21: Homework 4 nmt_model.py: NMT Model Penchen…

ElasticSearch 如何计算得分及一个不太成熟的使用

1.背景 最近在做 ES 相关东西&#xff0c;只最会在查询的时候给不同的字段设置不同的权重&#xff0c;但是得分具体怎么算的不太明白&#xff0c;花了4-5 天研究和总结了一下。这样不至于被别人问到“这个分数怎么算出来的&#xff1f;”&#xff0c;两眼一抹黑&#xff0c;不…

【C++】模板进阶--保姆级解析(什么是非类型模板参数?什么是模板的特化?模板的特化如何应用?)

目录 一、前言 二、什么是C模板&#xff1f; &#x1f4a6;泛型编程的思想 &#x1f4a6;C模板的分类 三、非类型模板参数 ⚡问题引入⚡ ⚡非类型模板参数的使用⚡ &#x1f525;非类型模板参数的定义 &#x1f525;非类型模板参数的两种类型 &#x1f52…