当前位置: 首页 > news >正文

ROS2 入门应用 请求和应答(Python)

ROS2 入门应用 请求和应答(Python)

  • 1. 创建功能包
  • 1. 创建功能包
  • 2. 创建源文件
    • 2.1. 服务端
    • 2.2. 客户端
  • 3. 添加依赖关系
  • 4. 添加入口点
  • 5. 编译和运行


1. 创建功能包

1. 创建功能包

在《ROS2 入门应用 工作空间》中已创建和加载了ros2_ws工作空间
在《ROS2 入门应用 元功能包(C++)》中已创建和加载了my_package功能包
那么就创建一个独立的py_srvcli功能包来做服务的请求和应答的功能

cd ~/ros2_ws/src
ros2 pkg create --build-type ament_python py_srvcli --dependencies rclpy example_interfaces

--dependencies可选参数将会自动在package.xmlCMakeLists.txt中添加必要的依赖行

依赖example_interfaces包,将会使用到example_interfacessrv文件,两位整数求和服务:

int64 a
int64 b
---
int64 sum

2. 创建源文件

进入py_srvcli功能包的py_srvcli文件夹

cd ~/ros2_ws/src/py_srvcli/py_srvcli

2.1. 服务端

新建service_member_function.py服务端源文件

nano service_member_function.py

复制以下内容到文件中:

from example_interfaces.srv import AddTwoIntsimport rclpy
from rclpy.node import Nodeclass MinimalService(Node):'''服务端节点类'''def __init__(self):# 初始化节点super().__init__('minimal_service')# 初始化服务端,服务类型AddTwoInts,服务add_two_ints,回调函数add_two_ints_callbackself.srv = self.create_service(AddTwoInts, 'add_two_ints', self.add_two_ints_callback)def add_two_ints_callback(self, request, response):'''服务端回调函数'''# 从请求request中添加两个整数,并将总和提供给响应responseresponse.sum = request.a + request.bself.get_logger().info('Incoming request\na: %d b: %d' % (request.a, request.b))return responsedef main():# 初始化ROS2rclpy.init()# 创建服务端节点minimal_service = MinimalService()# 运行服务端节点rclpy.spin(minimal_service)# 退出ROS2rclpy.shutdown()if __name__ == '__main__':main()

2.2. 客户端

新建client_member_function.py客户端源文件

nano client_member_function.py

复制以下内容到文件中:

import sysfrom example_interfaces.srv import AddTwoInts
import rclpy
from rclpy.node import Nodeclass MinimalClientAsync(Node):'''客户端节点类'''def __init__(self):# 初始化节点super().__init__('minimal_client_async')# 初始化客户端,服务类型AddTwoInts,服务add_two_intsself.cli = self.create_client(AddTwoInts, 'add_two_ints')# 搜索服务节点,间隔1swhile not self.cli.wait_for_service(timeout_sec=1.0):self.get_logger().info('service not available, waiting again...')# 定义请求self.req = AddTwoInts.Request()def send_request(self, a, b):'''请求发送函数'''self.req.a = aself.req.b = b# 发送请求self.future = self.cli.call_async(self.req)# 等待至发送请求得到应答rclpy.spin_until_future_complete(self, self.future)# 返回应答结果return self.future.result()def main():# 初始化ROS2rclpy.init()# 创建客户端节点minimal_client = MinimalClientAsync()# 请求发送response = minimal_client.send_request(int(sys.argv[1]), int(sys.argv[2]))# 显示请求-应答状态minimal_client.get_logger().info('Result of add_two_ints: for %d + %d = %d' %(int(sys.argv[1]), int(sys.argv[2]), response.sum))# 销毁节点,退出ROS2minimal_client.destroy_node()rclpy.shutdown()if __name__ == '__main__':main()

3. 添加依赖关系

创建功能包时,已通过--dependencies可选参数自动在package.xml中添加必要的依赖行

<depend>rclpy</depend>
<depend>example_interfaces</depend>

4. 添加入口点

打开 setup.py 文件
entry_points入口字段的console_scripts控制台脚本的括号中添加以下两行:

entry_points={'console_scripts': ['service = py_srvcli.service_member_function:main','client = py_srvcli.client_member_function:main',],
},

添加一个入口点py_srvcli功能包的service_member_function源文件的main函数,并命名为service
添加一个入口点py_srvcli功能包的client_member_function源文件的main函数,并命名为client


5. 编译和运行

进入工作空间根目录

cd ~/ros2_ws

在编译之前检查缺失的依赖项(可跳过):

rosdep install -i --from-path src --rosdistro humble -y

编译:

colcon build --packages-select py_srvcli

打开一个新终端,运行服务端节点准备应答:

ros2 run py_srvcli service

打开一个新终端,运行客户端节点发送请求:

ros2 run py_srvcli client 1 2# [INFO] [minimal_client_async]: Result of add_two_ints: for 1 + 2 = 3

谢谢

http://www.lryc.cn/news/11470.html

相关文章:

  • 是德Keysight E4991A/e4991B射频阻抗/材料分析仪
  • 这才是计算机科学_人工智能
  • DFS深度优先搜索—Java版
  • RAY - 小记
  • 金三银四软件测试工程师面试题(含答案)
  • Python 连接数据源与邮件功能(九)
  • 网站如何锁定用户,超级浏览器有办法解决吗?
  • Ubuntu下使用Wine运行HBuilderX
  • 如何高效远程维护分布在海外的中大型智能设备?
  • 【双指针问题】LeetCode 925. 长按键入
  • APP测试中IOS和Android的区别,有哪些注意点?
  • 2019蓝桥杯真题平方序列(填空题) C语言/C++
  • vue中,给一个URL地址,利用FileSaver.js插件下载文件到本地
  • 从0开始学python -34
  • 瑞典军事研究:从认知心理学的视角探讨军事创新进程
  • 【MySQL进阶-08】深入理解innodb存储格式,双写机制,buffer pool底层结构和淘汰策略
  • 5. AOP
  • ubuntu上尝试libpqxx库链接人大金仓
  • 【Python入门第十二天】Python 列表
  • Android 异步操作库 RxJava
  • 2021-12-05青少年软件编程(C语言)等级考试试卷(六级)解析
  • github 使用
  • Kubernetes集群维护—备份恢复与升级
  • 前端开发常用案例(二)
  • 基于springboot+vue的儿科保健计划免疫系统
  • 1.两数之和
  • 字符串匹配 - 模式预处理:KMP 算法(Knuth-Morris-Pratt)
  • 工程师手册:电源设计中的电容选用规则
  • 【安全开发】专栏文章汇总
  • 视频监控流程图4