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

URDF 发布者

news 来源：原创 2025/4/19 5:52:39

URDF 发布者

#! /usr/bin/env python3
import rclpy
from rclpy.node import Node
import rclpy.parameter
from sensor_msgs.msg import JointState
from rcl_interfaces.msg import SetParametersResultimport threading
import timeclass RotateWheelNode(Node):def __init__(self,name):super().__init__(name)self.get_logger().info(f"node {name} init")self.joint_states_publisher_ = self.create_publisher(JointState,"joint_states",10)# 初始化数据self._init_joint_states()self.pub_rate = self.create_rate(30) self.thread_ = threading.Thread(target=self._thread_pub)self.thread_.start()# 速度参数化self.declare_parameter("left_wheel_speed",0.0)self.declare_parameter("right_wheel_speed",0.0)self.add_on_set_parameters_callback(self._parameter_callback)def _init_joint_states(self):# 初始左右轮的速度self.joint_speeds = [0.0,0.0]self.joint_states = JointState()self.joint_states.header.stamp = self.get_clock().now().to_msg()self.joint_states.header.frame_id = ""  #??# 关节名称self.joint_states.name = ['left_wheel_joint','right_wheel_joint']# 关节位置self.joint_states.position = [0.0,0.0]# 关节速度self.joint_states.velocity = self.joint_speeds# 力self.joint_states.effort = []def _parameter_callback(self,params):for param in params:if param.name =="left_wheel_speed":self.joint_speeds[0]=param.valueself.get_logger().info(f"updated left_wheel_speed to {param.value}")elif param.name =="right_wheel_speed":self.joint_speeds[1]=param.valueself.get_logger().info(f"updated right_wheel_speed to {param.value}")# 返回参数更新成功结果return SetParametersResult(successful=True)#return rclpy.parameter.ParameterDescriptor(successful=True)# def update_speed(self,speeds):#     self.joint_speeds = speedsdef _thread_pub(self):last_update_date = time.time()while rclpy.ok():delta_time = time.time()-last_update_datelast_update_date = time.time()# 更新位置self.joint_states.position[0] += delta_time*self.joint_states.velocity[0]self.joint_states.position[1] += delta_time*self.joint_states.velocity[1]# 更新速度self.joint_states.velocity = self.joint_speeds# 更新headerself.joint_states.header.stamp = self.get_clock().now().to_msg()# 发布关节数据self.joint_states_publisher_.publish(self.joint_states)self.pub_rate.sleep()def main(args=None):rclpy.init(args=args)node = RotateWheelNode("rotate_fishbot_wheel")#node.update_speed([15.0,-15.0])rclpy.spin(node)rclpy.shutdown()

参数化实现

动态参数的声明

使用 declare_parameter 方法声明动态参数，并提供默认值：

self.declare_parameter("left_wheel_speed", 0.0)
self.declare_parameter("right_wheel_speed", 0.0)

left_wheel_speed 和 right_wheel_speed 分别表示左右轮的速度。
默认值为 0.0。

注册参数回调

通过 add_on_set_parameters_callback 注册一个回调函数，用于监听参数的变化：

self.add_on_set_parameters_callback(self._parameter_callback)

参数回调函数

回调函数 _parameter_callback 用于响应参数更新，修改节点的内部速度变量，并返回更新结果。

代码实现：

def _parameter_callback(self, params):for param in params:if param.name == "left_wheel_speed":self.joint_speeds[0] = param.valueself.get_logger().info(f"updated left_wheel_speed to {param.value}")elif param.name == "right_wheel_speed":self.joint_speeds[1] = param.valueself.get_logger().info(f"updated right_wheel_speed to {param.value}")# 返回参数更新成功结果return SetParametersResult(successful=True)

关键点：

遍历所有参数,然后分情况讨论
更新对应的速度值（joint_speeds）。
使用 self.get_logger().info() 打印更新日志，便于调试。
返回 SetParametersResult(successful=True) 表示参数更新成功。

动态参数的应用

参数的值被实时更新到 self.joint_speeds 中。发布线程每次都会读取 self.joint_speeds，并将其作为速度发布到 /joint_states。

发布逻辑

初始化关节状态

关节状态初始化方法 _init_joint_states：

def _init_joint_states(self):self.joint_speeds = [0.0, 0.0]  # 初始左右轮速度self.joint_states = JointState()self.joint_states.header.stamp = self.get_clock().now().to_msg()self.joint_states.header.frame_id = ""  # 可根据需求设置self.joint_states.name = ['left_wheel_joint', 'right_wheel_joint']  # 关节名称self.joint_states.position = [0.0, 0.0]  # 初始位置self.joint_states.velocity = self.joint_speeds  # 初始速度self.joint_states.effort = []  # 空的力矩数据

发布线程

通过 _thread_pub 方法实现关节状态的周期性发布：

def _thread_pub(self):last_update_date = time.time()while rclpy.ok():delta_time = time.time() - last_update_datelast_update_date = time.time()# 更新关节位置self.joint_states.position[0] += delta_time * self.joint_states.velocity[0]self.joint_states.position[1] += delta_time * self.joint_states.velocity[1]# 更新速度self.joint_states.velocity = self.joint_speeds# 更新时间戳self.joint_states.header.stamp = self.get_clock().now().to_msg()# 发布关节状态self.joint_states_publisher_.publish(self.joint_states)self.pub_rate.sleep()

功能说明：

每次循环计算 delta_time（时间增量），根据当前速度更新关节位置。
更新关节的速度和时间戳。
通过 self.joint_states_publisher_.publish 发布更新的关节状态。

使用动态参数的调试步骤

启动节点：

ros2 run fishbot_description rotate_wheel

验证参数：

列出参数：
```
ros2 param list /rotate_fishbot_wheel
```

获取参数值：

ros2 param get /rotate_fishbot_wheel left_wheel_speed

动态调整参数：
- 手动设置参数：
```
ros2 param set /rotate_fishbot_wheel left_wheel_speed 5.0
ros2 param set /rotate_fishbot_wheel right_wheel_speed -5.0
```
- 使用：
```
rqt
```
  - 并且在plugins/configuration中添加parameter reconfigure.选择节点，然后设置
观察输出：
- 看日志输出，一个是rqt的日志，一个是节点的日志。
- 查看关节状态：
```
ros2 topic echo /joint_states
```

URDF 发布者

URDF 发布者 #! /usr/bin/env python3 import rclpy from rclpy.node import Node import rclpy.parameter from sensor_msgs.msg import JointState from rcl_interfaces.msg import SetParametersResultimport threading import timeclass RotateWheelNode(Node):def __init…...

编程日记 2025/4/19 5:52:39

用于目标检测的集中式特征金字塔

摘要 https://arxiv.org/pdf/2210.02093 视觉特征金字塔在多种应用中已展现出其在有效性和效率方面的优越性。然而，现有方法过度关注层间特征交互，却忽略了经验证明有益的层内特征调节。尽管一些方法试图借助注意力机制或视觉变换器来学习紧凑的层内特征表示，但它们忽略了…...

编程日记 2025/4/17 6:19:17

微信小程序购物车全选反选功能以及合计

微信小程序基于Vant Weapp的购物车功能实现 1、单选使用微信小程序原生表单组件checkbox和checkbox-group 注意：checkbox原生不支持bind:change事件，checkbox-group支持 <checkbox-group bindchange"handleCheck"><checkbox val…...

编程日记 2025/4/14 17:42:52

大数据新视界 -- Hive 数据湖集成与数据治理（下）（26 / 30）

💖💖💖亲爱的朋友们，热烈欢迎你们来到青云交的博客！能与你们在此邂逅，我满心欢喜，深感无比荣幸。在这个瞬息万变的时代，我们每个人都在苦苦追寻一处能让心灵安然栖息的港湾。而我的…...

编程日记 2025/4/17 4:23:20

【基础数学二】整除，最大公约数约数，最小公倍数

编程日记 2025/4/14 2:58:21

【lua语言基础(四)】IO模型以及补充知识

💓博主CSDN主页:杭电码农-NEO💓 ⏩专栏分类:lua从入门到精通⏪ 🚚代码仓库:NEO的学习日记🚚 🌹关注我🫵带你学更多lua语言的知识 🔝🔝 lua语言基础 1. 简单的IO模型2…...

编程日记 2025/4/18 9:44:56

Python知识分享第十九天-网络编程

网络编程概述用来实现网络互联不同计算机上运行的程序间可以进行数据交互也叫Socket编程套接字编程三要素IP地址概述设备在网络中的唯一标识分类IPV4城域网13广域网22局域网31IPV6八字节十六进制相关dos命令查看ipwindows: ipconfigmac和linux: ifconfig测试网络ping 域…...

编程日记 2025/4/16 3:00:32

【JuMP.jl】非线性规划

[JuMP] 03 非线性规划非线性规划模型非线性规划问题是线性规划问题的自然推广， 在实际的工程问题中，优化问题中的目标函数与约束不会总是线性函数，因此非线性规划的求解功能是必要的。 min ⁡ x ∈ R n f 0 ( x ) s.t. l j ≤ f j ( x ) ≤…...

编程日记 2025/4/16 21:03:15

网络（TCP）

目录 TCP socket API 详解套接字有哪些类型？socket有哪些类型？ 图解TCP四次握手断开连接图解TCP数据报结构以及三次握手（非常详细） socket缓冲区以及阻塞模式详解再谈UDP和TCP bind(): 我们的程序中对myaddr参数是这样…...

编程日记 2025/4/16 17:18:29

40分钟学 Go 语言高并发：服务性能调优实战

服务性能调优实战一、性能优化实战概述优化阶段主要内容关键指标重要程度瓶颈定位收集性能指标，确定瓶颈位置CPU、内存、延迟、吞吐量⭐⭐⭐⭐⭐代码优化优化算法、并发、内存使用代码执行时间、内存分配⭐⭐⭐⭐⭐系统调优调整系统参数、资源配置系统资源利用率…...

编程日记 2025/4/14 15:05:29

5092 星际争霸

逆序对排序； 字符串遍历； pair 特点： 两个值，第一个是字符串，第二个是逆序对数。而且没有重复的字符串。 #include<bits/stdc.h>using namespace std; typedef long long ll; const int N1e35; #define x f…...

编程日记 2025/4/7 22:20:09

AUTOSAR AP 汽车API知识点总结（Automotive API ）R24-11

汽车API知识点总结一、背景与目标背景：智能互联汽车正逐步依赖远程诊断、软件更新等功能以确保行驶安全，并且用户已习惯于通过智能设备中的应用程序控制连接设备。虽然AUTOSAR标准支持车辆软件的可更新性，但尚未提供将AUTOSAR应用产生的数据和功能安全可靠地暴露给非AUTO…...

编程日记 2025/4/16 15:14:27

vue2：Cascader 级联选择器中加载两种不同的数据结构

前言因UI调整，需要将el-tree控件更换为级联选择器，而在原树形控件中，加载了两种不同的数据结构，（参见vue2：树形控件el-tree中加载两种不同结构的数据_vue2 树形插件-CSDN博客）所以现在级联选择器中也需要加载这两种不同的数据结构。问题原本以为处理方式差不多，在…...

编程日记 2025/4/14 5:59:30

【xLSTM-Transformer序列分类】Pytorch使用xLSTM-Transformer对序列进行分类源代码

Python, Pytorch使用xLSTM-Transformer对序列进行分类源代码。xLSTM是不久前LSTM团队提出来的新模型，将xLSTM融入Transformer的Encoder中，创新型较强。另外，Transformer是完整的，即使用了Encoder、Decoder和Embedding所有模块。 …...

编程日记 2025/4/5 2:57:17

TDengine 签约安徽智质，助力海螺水泥智慧工厂升级

在当前制造业数字化转型的浪潮中，如何实现智能化、自动化与数据驱动的高效生产，成为企业提升竞争力的关键。尤其是在水泥、钢铁等传统行业，随着技术的不断进步，如何打破数据孤岛、提升生产管理效率，已经成为许多工厂亟…...

编程日记 2025/4/16 17:41:43

Hbase整合Mapreduce案例2 hbase数据下载至hdfs中——wordcount

目录整合结构准备数据下载pom.xmlMain.javaReduce.javaMap.java操作总结整合结构和案例1的结构差不多，Hbase移动到开头，后面跟随MR程序。因此对于输入的K1 V1会进行一定的修改准备在HBASE中创建表，并写入数据 create "wunaii…...

编程日记 2025/4/15 23:02:37

WHLUG丨deepin、华中科技大学开放原子开源俱乐部、 RustSBI 和清华大学开源操作系统训练营共话开源新生代成长之路

2024年11月30日下午，由 deepin（深度）社区联合华中科技大学开放原子开源俱乐部、 RustSBI 开源社区和清华大学开源操作系统训练营共同举办的WHLUG（武汉Linux用户组）线下沙龙在华中科技大学成功举办。本次活动聚集了50余…...

编程日记 2025/4/16 20:30:03

深入理解AVL树：结构、旋转及C++实现

1. AVL树的概念什么是AVL树？ AVL树是一种自平衡的二叉搜索树，其发明者是Adelson-Velsky和Landis，因此得名“AVL”。AVL树是首个自平衡二叉搜索树，通过对树的平衡因子进行控制，确保任何节点的左右子树高度差最多为1&…...

编程日记 2025/4/16 23:40:41

L15.【LeetCode笔记】相同的树

目录 1.题目代码模板 2.分析通过合理的if判断分类讨论两个根节点 1.首先,p和q都为NULL的情况最好排除 2.排除了两个都为NULL的情况,剩下的情况:1.其中一个为NULL;2.两个都不为NULL 写法1 写法2 3.只剩下最后一种情况:p和q都不为NULL 3.代码提交结果 1.题目 https…...

编程日记 2025/4/16 20:30:04

【算法】【优选算法】位运算（下）

目录一、：⾯试题 01.01.判定字符是否唯⼀1.1 位图1.2 hash思路1.3 暴力枚举二、268.丢失的数字2.1 位运算，异或2.2 数学求和三、371.两整数之和四、137.只出现⼀次的数字 II五、⾯试题 17.19.消失的两个数字一、：⾯试题 01.01.判定字符是…...

编程日记 2025/4/12 10:00:14

网络——Socket与WebSocket

Socket与WebSocket都是网络通信中的重要概念，但它们在原理、应用场景及特性上存在显著的差异。以下是对两者的详细比较： 一、Socket 定义：Socket（套接字）是计算机网络中的一个抽象层，它允许应用程序通过网…...

编程日记 2025/4/17 7:28:21

Springboot3整合Redis

书接上篇《Redis 安装篇（阿里云服务器）_阿里云安装redis-CSDN博客》，安装好Redis后，就需要在springboot项目中使用Redis了。一、SpringBoot整合Redis 1.添加坐标  <dependency><groupId>org.sp…...

编程日记 2025/4/16 15:14:42

Java CountDownLatch 用法和源码解析

🧑 博主简介：CSDN博客专家，历代文学网（PC端可以访问：https://literature.sinhy.com/#/literature?__c1000，移动端可微信小程序搜索“历代文学”）总架构师，15年工作经验，…...

编程日记 2025/4/16 20:30:07

微信小程序3-显标记信息和弹框

感谢阅读，初学小白，有错指正。一、实现功能： 在地图上添加标记点后，标记点是可以携带以下基础信息的，如标题、id、经纬度等。但是对于开发来说，这些信息还不足够，而且还要做到点击标记点时&a…...

编程日记 2025/4/16 17:19:28

Android 消息队列之MQTT的使用：物联网通讯，HTTP太重了，使用MQTT；断网重连、注册、订阅、发送数据和接受数据，实现双向通讯。

目录： 问题MQTT是什么以及为什么使用如何使用：第一阶段、基础功能如何使用：第二阶段、增加断网重连如何使用：第三阶段、封装一、问题在开发的时候，我们一般都使用Http和后台进行通讯，比如我们是开发物联…...

编程日记 2025/4/14 13:16:42

详解Java数据库编程之JDBC

目录首先创建一个Java项目在Maven中央仓库下载mysql connector的jar包针对MySQL版本5 针对MySQL版本8 下载之后，在IDEA中创建的项目中建立一个lib目录，然后把刚刚下载好的jar包拷贝进去，然后右键刚刚添加的jar包，点击‘添…...

编程日记 2025/4/13 4:30:51

详解C++类与对象（四）

文章目录 1.类型转换1.1 前言1.2 类型转换的性质 2.static成员2.1 前言2.2 static的基本概念 3.友元4.内部类5.匿名对象 1.类型转换 1.1 前言在C中，由于程序员可以自己显示定义一个新的类。这样就会出现一个问题：程序员自己显示定义的类类型与编译器中…...

编程日记 2025/4/16 17:18:26

使用 postman 传递 binary 类型的图片到后端接口遇到的坑

使用 psotman 传 binary 类型图片报错： -2024-12-04 [http-nio-9090-exec-1] WARN org.springframework.web.servlet.mvc.support.DefaultHandlerExceptionResolver Resolved [org.springframework.http.converter.HttpMessageNotReadableException: Required r…...

编程日记 2025/4/11 15:16:33

第9章大模型的有害性（上）

9.1 引言本章将探讨大型语言模型（LLMs）可能带来的有害性，重点讨论以下几个方面： 性能差异社会偏见和刻板印象在后续内容中，还会涉及其他层面的危害，如有害信息、虚假信息、隐私和安全风险、版权问题、…...

编程日记 2025/4/18 12:00:35

计算机视觉——相机标定(Camera Calibration)

文章目录 1. 简介2. 原理3. 相机模型3.1 四大坐标系3.2 坐标系间的转换关系3.2.1 世界坐标系到相机坐标系3.2.2 相机坐标系到图像坐标系3.2.3 像素坐标系转换为图像坐标系3.2.4 世界坐标转换为像素坐标 3.3 畸变3.3.1 畸变类型3.3.1.1 径向畸变（Radial Distortion&a…...

编程日记 2025/4/9 1:15:06

Java爬虫技术全解析：从入门到精通

引言在信息爆炸的今天，数据成为了最宝贵的资源之一。爬虫技术作为获取网络数据的重要手段，广泛应用于数据采集、信息聚合、市场分析等多个领域。Java作为一种强类型、面向对象的编程语言，以其稳健的性能和跨平台的特性，成为了开…...

编程日记 2025/4/14 21:11:26

leetcode hot100【Leetcode 416.分割等和子集】java实现

Leetcode 416.分割等和子集题目描述给定一个非负整数的数组 nums ，你需要将该数组分割成两个子集，使得两个子集的元素和相等。如果可以分割，返回 true ，否则返回 false。示例 1： 输入：nums [1,5,11,…...

编程日记 2025/4/18 14:55:10

位段详解+代码展示

系列文章目录 🎈 🎈 我的CSDN主页:OTWOL的主页，欢迎！！！👋🏼👋🏼 🎉🎉我的C语言初阶合集：C语言初阶合集，希望能…...

编程日记 2025/4/18 7:37:09

python实现c++中so库调用及dbus服务开发

本期介绍主要分两块，一块是python如何调用so库，另一块是dbus服务的注册与调用； python调用so库 1. c++源码 # test.h文件#include<iostream> using namespace std;extern "C"{ int cacl(int a, int b); struct student{char sname[50];int score;}; stud…...

编程日记 2025/4/18 7:01:26

如何进行GC调优

目录 1、GC是什么? 垃圾回收算法、收集器等 2、优化目标 3、优化策略这个属于较为开放题目，可以结合自己项目实战出发，体现JVM调优。 1、GC是什么? 垃圾回收算法、收集器等 2、优化目标 (1) 将进入老年代的对象数量降到最低 (2) 减少FullGC的执行…...

编程日记 2025/4/18 20:24:09

JAVA ｜日常开发中读写TXT文本详解

JAVA ｜日常开发中读写TXT文本详解前言一、读取 TXT 文本1.1 使用BufferedReader读取1.2 使用Scanner读取二、写入 TXT 文本2.1 使用BufferedWriter写入2.2 使用PrintWriter写入2.3 字节流写入（FileOutputStream）后转换为字符流（…...

编程日记 2025/4/16 13:50:33

开源模型应用落地-安全合规篇-用户输入价值观判断（三）

一、前言在深度合规功能中，对用户输入内容的价值观判断具有重要意义。这一功能不仅仅是对信息合法性和合规性的简单审核，更是对信息背后隐含的伦理道德和社会责任的深刻洞察。通过对价值观的判断，系统能够识别可能引发不当影响或冲突的内容，从而为用户提供更安全、更和谐的…...

编程日记 2025/4/18 4:43:56

apache部署若依前后端分离项目（开启SSL）

网站部署之后，大多数需要配置https，所以本章教程，介绍使用apache部署若依前后端项目的时候，如何开启SSL，以及如何配置SSL证书。一、安装ssl模块默认情况下，ssl模块是没有安装的。需要手动安装，否则直接配置SSL模块的时候，会报错。 sudo yum install mod_ssl二、查询s…...

编程日记 2025/4/18 1:54:53

VMware Workstation Pro安装教程（全图文保姆级）

一、前言系统：Windows 11时间：2024/12/04需求：注册：broadcom（邮箱）难点：在官网找到下载链接二、说明建议前往官网（https://www.vmware.com）下载，可能加…...

编程日记 2025/4/16 15:14:37

【机器学习】—Transformers的扩展应用：从NLP到多领域突破

好久不见！喜欢就关注吧~ 云边有个稻草人-CSDN博客目录引言一、Transformer架构解析 （一）、核心组件 （二）、架构图二、领域扩展：从NLP到更多场景 1. 自然语言处理（NLP） 2…...

编程日记 2025/4/17 0:56:21

Linux权限机制深度解读：系统安全的第一道防线

文章目录前言‼️一、Linux权限的概念‼️二、Linux权限管理❕2.1 文件访问者的分类（人）❕2.2 文件类型和访问权限（事物属性）✔️1. 文件类型✔️2. 基本权限✔️3. 权限值的表示方法 ❕2.3 文件访问权限的相关设置方法✔️1. ch…...

编程日记 2025/4/13 6:37:14

【数据集】细胞数据集：肿瘤-胎儿重编程的内皮细胞驱动肝细胞癌中的免疫抑制性巨噬细胞（Sharma等人）

引用此数据集： Sharma, Ankur (2020), “Onco-fetal reprogramming of endothelial cells drives immunosuppressive macrophages in Hepatocellular Carcinoma (Sharma et al)”, Mendeley Data, V1, doi: 10.17632/6wmzcskt6k.1 下载地址：Onco-feta…...

编程日记 2025/4/17 3:47:59

LangChain学习笔记（一）-LangChain简介

LangChain学习笔记（一）-LangChain简介 langChain是一个人工智能大语言模型的开发框架，主要构成为下图。一、核心模块 （一）模型I/O模块负责与现有大模型进行交互，由三部分组成： 提…...

编程日记 2025/4/14 15:38:02

【Dubbo03】消息队列与微服务之dubbo-admin 二进制与编译安装

实战案例：二进制安装 dubbo-admin 新版用Golang重构，提供了二进制包，可以直接部署 #下载二进制包 [rootubuntu2204 ~]#wget https://github.com/apache/dubbo-admin/releases/download/0.5.0/apache-dubbo-admin-0.5.0-bin-release.tar.gz …...

编程日记 2025/4/18 6:43:15

常见问题QA的前端代码

这个的后端代码参见此文使用语言向量建立常见问题的模糊搜索-CSDN博客https://blog.csdn.net/chenchihwen/article/details/144207262?spm1001.2014.3001.5501 这段代码实现了一个简单的问答页面，页面分为左右两部分，左侧用于展示对话记录&#xff0c…...

编程日记 2025/4/17 4:46:38

【Java基础面试题010】Java中的基本数据类型有哪些？

相关知识补充：《Java从入门到精通(JDK17版)》_尚硅谷电子书.pdf Autism_Btkrsr/Blog_md_to_pdf - 码云 - 开源中国 (gitee.com) 回答重点 Java提供了8中基本数据类型整型： byte：占用1字节，取值范围 -128 到 127short&#x…...

编程日记 2025/4/18 22:59:10

记录部署dvwa靶场踩的几个坑

DVWA reCAPTCHA key: Missing 解决方法：网上随便copy一个，粘贴到config.inc.php配置文件里，具体我也是参考这篇文章的：DVWA下载、安装You dont have permission to access this resource.Server unable to read htaccess file, de…...

编程日记 2025/4/16 20:30:19