仿真机器人-深度学习CV和激光雷达感知(项目2)day5【作业1与答案1】

文章目录

  • 前言
  • 作业1
  • 答案1

前言

💫你好，我是辰chen，本文旨在准备考研复试或就业
💫本文内容是我为复试准备的第二个项目
💫欢迎大家的关注，我的博客主要关注于考研408以及AIoT的内容
🌟 预置知识：基本Python语法，基本linux命令行使用

以下的几个专栏是本人比较满意的专栏(大部分专栏仍在持续更新)，欢迎大家的关注：

💥ACM-ICPC算法汇总【基础篇】
💥ACM-ICPC算法汇总【提高篇】
💥AIoT(人工智能+物联网)
💥考研
💥CSP认证考试历年题解

作业1

  1. 用 rostopic 命令，让第二只小海龟也动起来
  2. 创建功能包，实现 ROS 节点: 在随机位置生成一个小海龟，生成后，以随机速度、半径、方向(顺时针or逆时针)持续转圈。并使用 rgt_graph,rgt_topic 等工具查看，确保与自己的理解一致。
    • 提示1:生成一个小海龟需要调用 turtlesim 功能包的服务，可以用 roscd turtlesim 进入该功能包，查看服务的定义。写代码时，用 from turtlesim.srv import Spawn, SpawnRequest, SpawnResponse 导入该服务。
    • 提示2:创建功能包时，也要在依赖中加入 turtlesim，如 catkin_create_pkg homework std_msgsorospy turtlesim
    • 提示3:生成小海龟后，要往哪个Topic 发送控制指令? Topic 的数据类型是什么? rostopic 命令可以查看当前有的 Topic 的数据类型，用 -h 参数自己探索一下吧😘
  3. 将上述节点运行多个，生成多个小海龟。你遇到了什么问题?什么原因导致?能否想到解决方法?

答案1

1.操作命令行如下：

# 创建第一只小海龟
roscore
rosrun turtlesim turtlesim_node# 让第一只小海龟一直转圈
rostopic pub -r 1 /turtle1/cmd_vel geometry_msgs/Twist "linear:x: 1.0y: 0.0z: 0.0
angular:x: 0.0y: 0.0z: 1.0"# 创建第二只小海龟
rosservice call /spawn "x: 5.0
y: 3.0
theta: 0.0
name: ''" # 用 rostopic 命令让第二只小海龟一直转圈
rostopic pub -r 1 /turtle2/cmd_vel geometry_msgs/Twist "linear:x: 2.0y: 0.0z: 0.0
angular:x: 0.0y: 0.0z: 1.0"

在这里插入图片描述

2.分析问题要求：在随机位置生成一个小海龟，生成后，以随机速度、半径、方向(顺时针or逆时针)持续转圈。

两个关键：生成海龟，控制持续运动。

我们来思考一下这两个操作应该使用 Service 还是 Topic：
决定使用服务（Service）还是主题（Topic）通常取决于你想要进行的操作的性质和通信模式。在ROS中，服务和主题用于不同的通信模式：

使用服务（Service）:
当操作是请求-响应模式，即发送一个请求并期待一个响应，而这个操作不是连续进行的，应该使用服务。
服务适用于一次性的、离散的操作。比如，需要“生成一只小海龟”，这是一个一次性的操作，发送请求，服务完成操作并给出一个响应（比如成功或失败的消息，或者生成的海龟的ID）。
服务是同步的，客户端会在服务处理请求并返回响应之前阻塞（等待）。

使用主题（Topic）:
如果你的操作涉及连续的数据流或状态更新，你应该使用主题。
主题适用于发布/订阅模型，当信息源（发布者）有新的数据时，它会不断地发布消息，而感兴趣的接收方（订阅者）会接收这些消息。比如，传感器数据的发布，或者机器人位置的持续更新。
主题是异步的，数据的发布和接收是独立进行的，订阅者不会阻塞等待发布者发布消息。
例子中，“生成一只小海龟”是一个一次性的操作：请求生成海龟，然后操作完成。这种情况下，使用服务是合适的，因为发送一个请求并期待一个响应，这与服务的请求-响应模型相匹配。
如果操作是持续监控海龟的位置或状态如第二个需求：持续转圈，并且海龟的信息是持续变化的，那么使用主题会更合适，可以订阅一个主题，并持续接收海龟状态的更新。

综上，我们将问题分析为：使用 Service 创建一个海龟，使用 Topic 使得海龟持续转圈


之前有过介绍，生成海龟曾调用过 Spawn 这个服务，也就是说，我们不需要像之前介绍的那样建立一个 Service Client 以及一个 Service Server，我们只需要建立一个 Service Client 即可，至于 Service Server 节点，其实就是 turtlesim 这个模拟器（模拟器本身就是一个节点）该节点提供的 Spawn。

生成一个海龟可能遇到的问题：不知道用什么样的数据去调用服务【正确调用一个ROS服务的关键之一是知道该服务期望接收的参数（请求部分）以及它将返回的参数（响应部分）。每个ROS服务都有一个定义好的服务类型，这个服务类型定义了请求和响应的结构。】

解决思路：我们知道是有生成海龟这个服务在的（Spawn），关键在于如何调用：

roscore
rosrun turtlesim turtlesim_node
rossrv list
rossrv show turtlesim/Spawn

rosservice 更侧重于与运行中的服务进行交互和管理，而 rossrv 则更侧重于服务消息类型的查看和管理。

由此可以看到服务类型的定义：
在这里插入图片描述
--- 用来分割服务的请求和返回值

还有一个方法可以看到服务类型的定义：

roscd turtlesim/
ls
cd srv
ls
vim Spawn.srv

在这里插入图片描述
在这里插入图片描述
和第一种方法得到的结果是一样的，这里还有一行注释，意为 name 是可选的，不对 name 操作会自动创建一个无重的命名。

根据提示创建一个功能包：

cd ~/learn_ws/src
catkin_create_pkg turtle_work std_msgs rospy turtlesimcd ..
catkin_make
source devel/setup.bash

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

#! /usr/bin/env python
# coding utf-8
import rospy
import random
import math
from geometry_msgs.msg import Twist
from turtlesim.srv import Spawn, SpawnRequest, SpawnResponseif __name__ == '__main__':rospy.init_node("spawn_by_py")# 给服务传递的参数request = SpawnRequest()request.x = 8 * random.random()request.y = 8 * random.random()request.theta = math.pi * random.uniform(-1, 1)request.name = "own_turtle_1"# 请求服务rospy.loginfo('waitting for serviceL /spawn ...')rospy.wait_for_service('/spawn')try:service = rospy.ServiceProxy("/spawn", Spawn)response: SpawnResponse = service(request)except rospy.ServiceException as e:rospy.logerr(f'Service call failed: {e}')exit(-1)rospy.loginfo(f"spawn new turtle: {response.name}")# 创建速度控制的 Topic 发布者pub = rospy.Publisher(request.name+'/cmd_vel', Twist, queue_size=10)# 发布的信息变量control_msg = Twist()control_msg.linear.x = 5 * random.random()control_msg.angular.z = random.choice([1, -1]) * random.uniform(0.5, 5)rate = rospy.Rate(10)while not rospy.is_shutdown():rospy.loginfo(control_msg)pub.publish(control_msg)rate.sleep()

代码解释：

import rospy
import random
import math
from geometry_msgs.msg import Twist
from turtlesim.srv import Spawn, SpawnRequest, SpawnResponse

rospy: ROS 的 Python 库，用于节点初始化、消息发布等。
random: 生成随机数。
math: 数学函数库，此处用于访问 π π π 值。
geometry_msgs.msg: ROS 标准消息类型，此处用于发送速度控制指令。
turtlesim.srv: Turtlesim 特有的服务类型，用于创建新的乌龟。

if __name__ == '__main__':rospy.init_node("spawn_by_py")

定义 Python 的主执行块。
初始化 ROS 节点，节点名为 “spawn_by_py”。

    request = SpawnRequest()request.x = 8 * random.random()request.y = 8 * random.random()request.theta = math.pi * random.uniform(-1, 1)request.name = "own_turtle_1"

创建 SpawnRequest 对象，并为其属性赋值。这些值用于设定新乌龟的初始位置（x 和 y 坐标，范围是 [0, 8]）和方向（theta，即朝向，范围是 [- π π π, π π π]），以及名称（“own_turtle_1”）。random.random() 用于生成一个随机浮点数。这个数在 0.0 到 1.0 之间（包含 0.0，但不包含 1.0）random.uniform(a, b) 用于生成一个随机浮点数 N，使得 a ≤ N ≤ b。其结果包括区间的两端点 a 和 b。math.pi * random.uniform(-1, 1) 故可以生成 [- π π π, π π π]

    rospy.loginfo('waitting for serviceL /spawn ...')rospy.wait_for_service('/spawn')

rospy.loginfo() 是 ROS 中的一个日志函数，用于打印信息级别的日志。在 ROS 中，日志有不同的级别，如 info, warn, error, 等等，以表示不同严重程度的信息。rospy.loginfo('waitting for serviceL /spawn ...') : rospy.loginfo 表示这是一条信息级别的日志，通常用于提供正常的程序运行信息。waiting for service /spawn … 是要打印的日志内容，通常用于告知用户程序正在等待 /spawn 服务可用。
调用rospy.wait_for_service等待 /spawn 服务可用。这是 Turtlesim 提供的服务，用于生成新的乌龟，

    try:service = rospy.ServiceProxy("/spawn", Spawn)response: SpawnResponse = service(request)except rospy.ServiceException as e:rospy.logerr(f'Service call failed: {e}')exit(-1)

创建一个服务客户端，连接到 /spawn 服务。如果服务调用成功，将返回一个SpawnResponse对象；如果服务调用失败（比如服务不可用），将打印错误信息并退出程序。
rospy.ServiceProxy: 这是一个在 ROS 中创建服务客户端的构造函数。服务客户端用于调用服务。第一个参数 "/spawn" : 这是服务的名称。第二个参数 Spawn: 这是服务的类型。
response: 这是一个变量，用于存储服务调用的响应。SpawnResponse: 这是响应的类型。在这种情况下，它是服务Spawn的响应部分。service(request) : 这是实际调用服务的部分。service是之前声明的服务客户端，request 是发送给服务的请求消息，它是一个 SpawnRequest 类型的对象，包含了创建新乌龟所需的数据（比如位置、方向和名称）。response: SpawnResponse，: 这个冒号在 Python 中用于类型注解，表示变量 response 应该是 SpawnResponse 类型。
rospy.logerr() 是 ROS 中的一个日志函数，用于在节点的日志中记录错误信息。

    rospy.loginfo(f"spawn new turtle: {response.name}")

打印日志，显示新生成的乌龟的名称。

    pub = rospy.Publisher(request.name+'/cmd_vel', Twist, queue_size=10)

创建了一个 ROS 发布者（Publisher），向一个特定的主题（Topic）发布消息（用于向控制乌龟移动的主题发送消息）request.name+'/cmd_vel ：这是打算发布消息的主题名：request.name 是一个字符串，包含了之前创建的乌龟的名称，'/cmd_vel' 是一个常用于控制机器人速度的标准 ROS 主题。它经常用于接收速度指令（如线性速度和角速度）。通过将这两部分连接起来，代码将会向特定乌龟的速度控制主题发送消息。Twist：这指定了将要发布到该主题的消息类型。Twist 是一个标准的 ROS 消息类型，它包含了线性和角速度向量，用于控制机器人的运动。queue_size=10：这个参数设置了发布者的队列大小。队列用于存储在实际发送之前准备发送的消息。queue_size=10 意味着如果出于某种原因消息不能立即发送（例如，订阅者没有迅速接收消息），那么最多可以存储10条消息。如果超过这个数量，最旧的消息将会被丢弃。
总的来说：这行代码创建了一个名为 pub 的新发布者，它会向特定乌龟的 cmd_vel 主题发布 Twist 类型的消息。这允许你的节点控制乌龟的移动，通过指定其线性和角速度。队列大小设置为10，意味着在极端情况下，它会在丢弃最旧消息前缓存最多10条消息。

    control_msg = Twist()control_msg.linear.x = 5 * random.random()control_msg.angular.z = random.choice([1, -1]) * random.uniform(0.5, 5)

因为题目要求的是转圈，所以它的线速度和角速度是固定的，随意取一次即可。
创建 Twist 类型的消息 control_msg，并为其线性和角速度赋随机值。线性速度（linear.x）范围是[0, 5]，角速度（angular.z）范围是[-5, -0.5] ∪ [0.5, 5]。random.choice([1, -1]) 会随机选择 1 或 -1，这代表一个方向（正向或负向）。random.uniform(0.5, 5) 生成一个随机的大小或强度。将这两个数相乘，结果是一个介于 -5 到 -0.5 或 0.5 到 5 之间的数，具体取决于第一部分选择的是 1 还是 -1。

    rate = rospy.Rate(10)

创建 Rate 对象，以 10Hz 的频率运行循环。

    while not rospy.is_shutdown():rospy.loginfo(control_msg)pub.publish(control_msg)rate.sleep()

主循环。在ROS没有关闭的情况下，不断执行以下操作：
打印 control_msg日志。
通过pub.publish发布control_msg到cmd_vel主题，控制乌龟的移动。
通过rate.sleep等待一段时间，以保持10Hz的循环频率。
pub.publish(control_msg)：
pub: 是之前创建的一个发布者（Publisher）对象。在ROS中，发布者用于发送消息给任何订阅了相应主题的节点。
.publish: .publish 是发布者对象的一个方法。这个方法用于实际发送消息。调用这个方法时，消息会被发送到创建发布者时指定的主题。
(control_msg): control_msg 是要发布的消息。由上述代码中的定义，control_msg 是一个 Twist 类型的消息
总的来说，pub.publish(control_msg) 这行代码是ROS通信机制中的核心操作之一，它允许节点之间通过主题来交换消息，这是实现分布式系统和模块化设计的关键。

此时我们可以再来看一下计算图：

roscore
rosrun turtlesim turtlesim_node
rosrun rqt_graph rqt_graph

在这里插入图片描述
运行一下看看效果：

chmod +x src/turtle_work/src/*
source devel/setup.bash
rosrun turtle_work work.py

在这里插入图片描述

海龟运行

因为是随机生成的位置这些信息，可以再运行一次查看：
在这里插入图片描述

3.我们按照题目要求新建一个窗口再生成一只小海龟，会报错如下：
在这里插入图片描述
报错原因是第一次执行时（创建第二只海龟）创建了代码中 "own_turtle_1" 名字的海龟，再次调用的时候（创建第三只海龟）由于名字是一样的，所以会创建失败，因为是不能有重名的，在计算图中，所有的资源都需要唯一命名，解决方法见下篇博客。

上述所有内容出处如下，博主在此基础上仅为添加个人理解：
本项目为北大团队出品【项目三：深度学习&仿真机器人 - 丘丘老师】原创（部分代码为开源代码）。课程团队：B站ID【M学长的考研top帮】UID【3546580235848566】复试项目班QQ大群：885884619，负责人QQ：674799975

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

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

相关文章

在Rust中编写自定义Error

在Rust中编写自定义Error

前言 之前我们聊过&#xff0c;Result<T, E> 类型可以方便地用于错误传导&#xff0c;Result<T, E>是模板类型&#xff0c;实例化后可以是各种类型&#xff0c;但 Rust 要求传导的 Result 中的 E 是相同类型的&#xff0c;或者能够自动转化为相同类型。比如&#…
阅读更多...
【Jetbrains全家桶】PyCharm专业版学生用户申请（学信网）+Toolbox App安装配置教程（修改系统、配置和日志目录）

【Jetbrains全家桶】PyCharm专业版学生用户申请（学信网）+Toolbox App安装配置教程（修改系统、配置和日志目录）

文章目录 一、Jetbrains学生用户免费使用1. [Jetbrains官网](https://www.jetbrains.com.cn/en-us/)新申请更新资料申请界面 2. [学信网](https://www.chsi.com.cn/xlcx/index.jsp)教育部学籍在线验证报告本人身份核验申请报告 二、安装Toolbox App[Toolbox App](https://www.j…
阅读更多...
Qt 拖拽事件示例

Qt 拖拽事件示例

一、引子 拖拽这个动作，在桌面应用程序中是非常实用和具有很友好的交互体验的。我们常见的譬如有，将文件拖拽到某个窗口打开，或者拖拽文件到指定位置上传；在绘图软件中，选中某个模板、并拖拽到画布上，画布上变回绘制该模板的图像… 诸如此类，数不胜数。 那么，在Qt中我…
阅读更多...
开源项目Git Commit规范与ChangeLog

开源项目Git Commit规范与ChangeLog

一&#xff0c;conventional commit(约定式提交) Conventional Commits 是一种用于给提交信息增加人机可读含义的规范。它提供了一组用于创建清晰的提交历史的简单规则。 1.1 作用 自动化生成 CHANGELOG基于提交类型&#xff0c;自动决定语义化的版本变更向项目相关合作开发…
阅读更多...
shell脚本—循环语句

shell脚本—循环语句

文章目录 循环语句循环含义1、for2、whilewhile循环 3、until4、双重循环及跳出循环 循环语句 echo命令&#xff1a;标准输出或提取shell变量的值 标准输出 [rootlocalhost ~]#echo 123456|passwd --stdin zhangsan 更改用户 zhangsan 的密码 。 passwd&#xff1a;所有的身…
阅读更多...
SWMM模型INP解析

SWMM模型INP解析

.INP文件解析 [OPTIONS]&#xff1a;SWMM软件运行前需要设置的参数 [RAINGAGES]雨水节点&#xff0c;核心设置雨水时间序列&#xff0c;可为INP内部数据也可为外部txt数据&#xff0c;TIMESERIES对应【TIMESERIES】模块&#xff0c;TS_1为时间序列名称 [TIMESERIES]&#xff0…
阅读更多...
部署幻兽帕鲁联机服务器需要怎样配置的云服务器?

部署幻兽帕鲁联机服务器需要怎样配置的云服务器?

随着互联网技术的快速发展&#xff0c;多人在线游戏逐渐成为人们休闲娱乐的重要方式。作为一款备受欢迎的游戏&#xff0c;幻兽帕鲁以其独特的玩法吸引了大量玩家。为了获得更好的游戏体验&#xff0c;许多玩家选择在云服务器上自行部署幻兽帕鲁联机服务器。本文将详细介绍部署…
阅读更多...
设置模式之责任链模式

设置模式之责任链模式

目录 1.概述 2.结构 3.实现 4.总结 1.概述 责任链模式&#xff08;Chain of Responsibility Pattern&#xff09;是一种行为性设计模式&#xff1b;它为请求创建了一个接收者对象的链&#xff0c;允许你将请求沿着处理者链进行发送。 收到请求后&#xff0c; 每个处理者均…
阅读更多...
图像处理python基础

图像处理python基础

array 读取图片 tensor 模型预测 一般过程&#xff1a;读取数据np->tensor->model->result->np->画图 shape确保图像输入输出尺寸正确 读取图片 将在GPU上运行的tensor类型转变成在CPU上运行的np类型 三类计算机视觉任务的输入&#xff1a; 分类&#xff1…
阅读更多...
【软考问题】-- 1 - 知识精讲 - 项目管理理论

【软考问题】-- 1 - 知识精讲 - 项目管理理论

一、基本问题 1&#xff1a;项目的特点是什么&#xff1f; 临时性&#xff1a;是指项目有明确的起点和终点&#xff0c;从项目启动到项目收尾。项目目标实现后&#xff0c;项目收尾工作完成即标志着项目结束。独特性&#xff1a;项目是独特的&#xff0c;之前没有做过的&#x…
阅读更多...
JS高频面试题(上)

JS高频面试题(上)

1. 介绍JS有哪些内置对象&#xff1f; 数据封装类对象&#xff1a;Object、Array、Boolean、Number、String 其他对象&#xff1a;Function、Arguments、Math、Date、RegExp、Error ES6新增对象&#xff1a;Symbol&#xff08;标识唯一性的ID&#xff09;、Map、Set、Promise…
阅读更多...
Python + Selenium —— 网页元素定位之CSS 选择器！

Python + Selenium —— 网页元素定位之CSS 选择器！

CSS(Cascading Style Sheets)是一种语言&#xff0c;用来描述HTML和XML文档的样式。 CSS 选择器用来定位 HTML 上的元素&#xff0c;然后对其进行渲染。通过 CSS 选择器可以定位到页面上的任意元素。这些选择器可以被 WebDriver 用作另外的定位策略。 CSS 可以较为灵活的选择控…
阅读更多...
蓝桥杯准备之路-Java基础复习

蓝桥杯准备之路-Java基础复习

一、基本数据类型 int(32),long(64),float,double,boolean ,char 溢出判断&#xff1a; System.out.println("蓝桥杯练习第一天");Scanner scan new Scanner(System.in);int a scan.nextInt();System.out.println(a);int a1 Integer.MAX_VALUE;System.out.prin…
阅读更多...
Linux管道学习（无名管道）

Linux管道学习（无名管道）

目录 1、概述 2、管道的创建 3、管道读写行为 3.1、管道读 在linux中管道有两种&#xff0c;一是无名管道&#xff08;匿名管道&#xff09;&#xff0c;第二种是有名管道&#xff1b;无名管道主要用于有血缘关系的父子进程间通信&#xff0c;有名管道则不受该限制&#xf…
阅读更多...
字符串匹配（BF KMP）详解 + 刷题

字符串匹配（BF KMP）详解 + 刷题

目录 &#x1f33c;前言 BF 算法 KMP 算法 &#xff08;1&#xff09;前缀函数 -- O(n^3) &#xff08;2&#xff09;前缀函数 -- O(n^2) &#xff08;3&#xff09;前缀函数 -- O(n) &#xff08;4&#xff09;辅助理解 &#x1f40b;P1308 -- 统计单词数 …
阅读更多...
文件包含技术总结

文件包含技术总结

开发人员一般会把重复使用的函数写到单个文件中&#xff0c;需要使用某个函数时直接调用此文件&#xff0c;而无需再次编写&#xff0c;这中文件调用的过程一般被称为文件包含。 allow_url_fopen On&#xff08;是否允许打开远程文件&#xff09; allow_url_include On&…
阅读更多...
机器学习算法(一)

机器学习算法(一)

一、线性回归 线性回归&#xff08;Linear Regression&#xff09;可能是最流行的机器学习算法。线性回归就是要找一条直线&#xff0c;并且让这条直线尽可能地拟合散点图中的数据点。它试图通过将直线方程与该数据拟合来表示自变量&#xff08;x 值&#xff09;和数值结果&am…
阅读更多...
uniapp page宽度设置为750rpx，子元素宽度100%，大小不一致

uniapp page宽度设置为750rpx，子元素宽度100%，大小不一致

uniapp page宽度设置为750rpx&#xff0c;子元素宽度100%&#xff0c;大小不一致。 原因是我在page加了margin: 0 auto;去掉就正常了&#xff08;但是如果在超大屏幕还是会出现&#xff0c;我猜是使用rpx导致的&#xff0c;rpx渲染成页面时会转成精确到一个小数点几位数的rem&a…
阅读更多...
[实战]加密传输数据解密

[实战]加密传输数据解密

前言 下面将分享一些实际的渗透测试经验&#xff0c;帮助你应对在测试中遇到的数据包内容加密的情况。我们将以实战为主&#xff0c;技巧为辅&#xff0c;进入逆向的大门。 技巧 开局先讲一下技巧&#xff0c;掌握好了技巧&#xff0c;方便逆向的时候可以更加快速的找到关键函数…
阅读更多...
arcgis实现截图/截屏功能

arcgis实现截图/截屏功能

arcgis实现截图/截屏功能 文章目录 arcgis实现截图/截屏功能前言效果展示相关代码 前言 本篇将使用arcgis实现截图/截屏功能&#xff0c;类似于qq截图 效果展示 相关代码 <!DOCTYPE html> <html> <head><meta charset"utf-8"><meta nam…
阅读更多...
推荐文章
最新文章

Copyright @ 2022~2023