ROS运动控制——跟踪控制乌龟仿真（2）

最新推荐文章于 2024-01-28 14:31:02 发布
最新推荐文章于 2024-01-28 14:31:02 发布
阅读量1.2k 收藏 18
点赞数
分类专栏： ros 运动控制 跟踪控制 文章标签： c++
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/LW_12345/article/details/119706709
版权

ROS运动控制——跟踪控制乌龟仿真（2）

问题描述

在ros仿真平台（ros_tutorials）上做《考虑运动受限的履带式移动机器人轨迹跟踪控制》的仿真实验

跟踪控制公式：
①角速度有限时间控制律和线速度滑模变结构控制律跟踪函数：
不限速度
在这里插入图片描述
在这里插入图片描述

受限速度
在这里插入图片描述

② 原跟踪函数：
v p  =  1 2 e x 2 + e y 2 {{\text{v}}_p}{\text{ = }}\frac{1}{2}\sqrt {{e_x}^2 + {e_y}^2} vp​ = 21​ex​2+ey​2 ​
ω p  =  4 × arctan ⁡ ( e y e x ) {\omega _p}{\text{ = }}4 \times \arctan (\frac{{{e_y}}}{{{e_x}}}) ωp​ = 4×arctan(ex​ey​​)

关键词：ros、滑模控制、运动受限、跟踪控制、多话题发布与订阅

方法

这里以ros自带的乌龟案例为基础，进行改写。首先，生成第一只乌龟让其做圆周运动或直线运动，作为跟踪的目标；再生成第二只乌龟，用案例中的跟踪控制方法，作为对比实验；最后，生成第三只乌龟，用上文中设计的跟踪控制，进行实验。

代码下载运行

代码下载
在放置文件的路径下打开终端，运行

git clone https://gitee.com/Luweizhiyuan2020/demo02_ws.git

编译文件

cd demo02_ws
catkin_make

运行文件

roscore

source demo02_ws/devel/setup.bash
roslaunch learning_tf  start_tf_demo_restricted_movement.launch

注：速度不受限与受限是两个实验只需改动start_tf_demo_restricted_movement.launch中的注释部分，不受限用；受限用；默认受限

代码

1速度不受限


/**
 * 底盘控制基于利亚普洛夫控制律
 */

#include <ros/ros.h>
#include <tf/transform_listener.h>
#include <geometry_msgs/Twist.h>
#include <turtlesim/Spawn.h>
#include "turtlesim/Pose.h"
#include <math.h>


static double x1,yl,yaw1,pitch1,roll1,     x2,y2,yaw2,pitch2,roll2,
         	                dx,dy,dyaw       ,dpitch,droll, yaw, pitch, roll,
						    ex,ey,eyaw,         ex_t,ey_t,eyaw_t,
          	                v1,omega1,v2,omega2,
         	                K1,K2,K3,
							t,ts,A,P,Q,K,dyaw0=0,d,flag0;


static ros::Subscriber sub1;
static ros::Subscriber sub2;
static ros::Publisher turtle_vel;

void doPose1(const turtlesim::Pose::ConstPtr    & p){
	x1=p->x;
	yl=p->y;
	yaw1=p->theta;
	v1=p->linear_velocity;
	omega1=p->angular_velocity;
}

void doPose2(const turtlesim::Pose::ConstPtr& p){
	x2=p->x;
	y2=p->y;
	yaw2=p->theta;
	v2=p->linear_velocity;
	omega2=p->angular_velocity;
}

// 方法一：订阅在发布中运行

int main(int argc, char** argv)
{
	setlocale(LC_ALL,"");

	// 初始化ROS节点
	ros::init(argc, argv, "my_tf_listener");

    // 创建节点句柄
	ros::NodeHandle node;

	// 请求产生turtle3
	ros::service::waitForService("/spawn");
	ros::ServiceClient add_turtle = node.serviceClient<turtlesim::Spawn>("/spawn");
	turtlesim::Spawn srv;
	srv.request.x=9.0;
	srv.request.y=9.0;
	srv.request.theta=3.14;
	add_turtle.call(srv);

	sub1 = node.subscribe<turtlesim::Pose>("/turtle1/pose",1000,doPose1);
	sub2 = node.subscribe<turtlesim::Pose>("/turtle3/pose",1000,doPose2);
	// 创建发布turtle2速度控制指令的发布者
	turtle_vel = node.advertise<geometry_msgs::Twist>("/turtle3/cmd_vel", 10);

	// 创建tf的监听器
	tf::TransformListener listener;

	ros::Rate rate(10);
	while (node.ok())
	{

		// 获取turtle1与turtle2坐标系之间的tf数据
		tf::StampedTransform transform;
		try
		{
			listener.waitForTransform("/turtle3", "/turtle1", ros::Time(0), ros::Duration(3.0));
			listener.lookupTransform("/turtle3", "/turtle1", ros::Time(0), transform);
		}

		catch (tf::TransformException &ex) 
		{
			ROS_ERROR("%s",ex.what());
			ros::Duration(1.0).sleep();
			continue;
		}

		dx=x1-x2;
		dy=yl-y2;
		dyaw=yaw1-yaw2;
        ex_t=cos(yaw2)*dx+sin(yaw2)*dy;
        ey_t=-sin(yaw2)*dx+cos(yaw2)*dy;
        eyaw_t=dyaw;

        ex=transform.getOrigin().x();
        ey=transform.getOrigin().y();
		transform.getBasis().getEulerYPR(eyaw, pitch, roll);

		geometry_msgs::Twist vel_msg;

        K1=0.909;
        K2=1.250;
        K3=0.818;

		A=1;
		P=9;
		Q=11;
		K=0.1;
		d=0.02;


		if(yaw1!=0&&yaw2!=0&&dyaw0==0){
			dyaw0=eyaw;
			ts=Q/A/(Q-P)*pow(abs(dyaw0),(Q-P)/Q);
			// ROS_INFO("yaw1=%.2f",yaw1);
			// ROS_INFO("yaw2=%.2f",yaw2);
			t++;
			// ROS_INFO("t=%.2f",t);
		}

		if(t>0){
			t++;
			// ROS_INFO("t=%.2f",t);
		}

		if(eyaw>0){
			flag0=1;
		}
		else{
			flag0=-1;
		}



		if(t==2){
			vel_msg.linear.x =0;
			vel_msg.angular.z =0;
			// ROS_INFO("t1=%.2f",t);
		}else if(t>2&&t<ts*10){
			vel_msg.angular.z = omega1+flag0*A*pow(eyaw,(9/11));//+A*pow(eyaw,(9/11))
			vel_msg.linear.x =v1+omega1*ex+omega1*ey+K*(ex-ey)/(abs(ex-ey)+d);
			// ROS_INFO("t2=%.2f",t);
		}else if(t>ts*10){
			vel_msg.angular.z = omega1+flag0*A*pow(eyaw,(9/11));//+A*pow(eyaw,(9/11))
			vel_msg.linear.x =v1+omega1*ex+omega1*ey+K*(ex-ey)/(abs(ex-ey)+d);
			// ROS_INFO("t3=%.2f",t);
		}

		 ROS_INFO("test=%.2f",pow(-1,1/11));
		//lyapunov
		// vel_msg.linear.x = v1*cos(eyaw)+K2*ex;
		// vel_msg.angular.z = omega1+ey*v1/K1+K3*sin(eyaw)/K1;
		//源函数
		// vel_msg.angular.z = 4.0 * atan2(transform.getOrigin().y(),
		// 		                        transform.getOrigin().x());
		// vel_msg.linear.x = 0.5 * sqrt(pow(transform.getOrigin().x(), 2) +
		// 		                      pow(transform.getOrigin().y(), 2));


		turtle_vel.publish(vel_msg);
		rate.sleep();
		ros::spinOnce();
	}
	return 0;
};

2速度受限

/*
 * 底盘控制基于利亚普洛夫控制律
 */

#include <ros/ros.h>
#include <tf/transform_listener.h>
#include <geometry_msgs/Twist.h>
#include <turtlesim/Spawn.h>
#include "turtlesim/Pose.h"
#include <math.h>


static double x1,yl,yaw1,pitch1,roll1,     x2,y2,yaw2,pitch2,roll2,
         	                dx,dy,dyaw       ,dpitch,droll, yaw, pitch, roll,
						    ex,ey,eyaw,         ex_t,ey_t,eyaw_t,
          	                v1,omega1,v2,omega2,
         	                K1,K2,K3,
							t,ts,A,P,Q,K,dyaw0=0,d,flag0,
							v3_pre,omega3_pre,v3_max,omega3_max,
							a3,beita3,a3_pre,beita3_pre,a3_max,beita3_max,dt,
							v3,omega3;


static ros::Subscriber sub1;
static ros::Subscriber sub2;
static ros::Publisher turtle_vel;

void doPose1(const turtlesim::Pose::ConstPtr    & p){
	x1=p->x;
	yl=p->y;
	yaw1=p->theta;
	v1=p->linear_velocity;
	omega1=p->angular_velocity;
}

void doPose2(const turtlesim::Pose::ConstPtr& p){
	x2=p->x;
	y2=p->y;
	yaw2=p->theta;
	v2=p->linear_velocity;
	omega2=p->angular_velocity;
}

int sgn(double para)
{
	if (para> 0) return 1;
	if (para <0) return -1;
	return 0;
}

// 方法一：订阅在发布中运行

int main(int argc, char** argv)
{
	setlocale(LC_ALL,"");

	// 初始化ROS节点
	ros::init(argc, argv, "my_tf_listener");

    // 创建节点句柄
	ros::NodeHandle node;

	// 请求产生turtle3
	ros::service::waitForService("/spawn");
	ros::ServiceClient add_turtle = node.serviceClient<turtlesim::Spawn>("/spawn");
	turtlesim::Spawn srv;
	srv.request.x=9.0;
	srv.request.y=9.0;
	srv.request.theta=3.14;
	add_turtle.call(srv);

	sub1 = node.subscribe<turtlesim::Pose>("/turtle1/pose",1000,doPose1);
	sub2 = node.subscribe<turtlesim::Pose>("/turtle3/pose",1000,doPose2);
	// 创建发布turtle2速度控制指令的发布者
	turtle_vel = node.advertise<geometry_msgs::Twist>("/turtle3/cmd_vel", 10);

	// 创建tf的监听器
	tf::TransformListener listener;

	ros::Rate rate(10);
	while (node.ok())
	{

		// 获取turtle1与turtle2坐标系之间的tf数据
		tf::StampedTransform transform;
		try
		{
			listener.waitForTransform("/turtle3", "/turtle1", ros::Time(0), ros::Duration(3.0));
			listener.lookupTransform("/turtle3", "/turtle1", ros::Time(0), transform);
		}

		catch (tf::TransformException &ex) 
		{
			ROS_ERROR("%s",ex.what());
			ros::Duration(1.0).sleep();
			continue;
		}

		dx=x1-x2;
		dy=yl-y2;
		dyaw=yaw1-yaw2;
        ex_t=cos(yaw2)*dx+sin(yaw2)*dy;
        ey_t=-sin(yaw2)*dx+cos(yaw2)*dy;
        eyaw_t=dyaw;

        ex=transform.getOrigin().x();
        ey=transform.getOrigin().y();
		transform.getBasis().getEulerYPR(eyaw, pitch, roll);

		geometry_msgs::Twist vel_msg;

        // K1=0.909;
        // K2=1.250;
        // K3=0.818;

		A=1;
		P=9;
		Q=11;
		K=0.1;
		d=0.02;
		dt=0.1;

		if(yaw1!=0&&yaw2!=0&&dyaw0==0){
			dyaw0=eyaw;
			ts=Q/A/(Q-P)*pow(abs(dyaw0),(Q-P)/Q);
			// ROS_INFO("yaw1=%.2f",yaw1);
			// ROS_INFO("yaw2=%.2f",yaw2);
			t++;
			// ROS_INFO("t=%.2f",t);
		}

		if(t>0){
			t++;
			omega3= omega1+sgn(eyaw)*A*pow(eyaw,(9/11));//+A*pow(eyaw,(9/11))
			v3 =v1+omega1*ex+omega1*ey+K*(ex-ey)/(abs(ex-ey)+d);
		}

		v3_max=2.0;
		omega3_max=1.0;
		a3_max=20;
		beita3_max=15;

		a3=(v3-v3_pre)/dt;
		beita3=(omega3-omega3_pre)/dt;

		//测最大加速度
		// if(abs(a3)>a3_max)a3_max=abs(a3);
		// 	ROS_INFO("a3_max=%.2f",a3_max);
		// if(abs(beita3)>beita3_max)beita3_max=abs(beita3);
		// 	ROS_INFO("beita3_max=%.2f",beita3_max);

		if(beita3>beita3_max){
			vel_msg.angular.z =omega3_pre+sgn(omega3-omega3_pre)*beita3_max*dt;
			// ROS_INFO("t1=%.2f",t);
		}else if(omega3>omega3_max){
			vel_msg.angular.z = omega3_max*sgn(omega3);
			// ROS_INFO("t2=%.2f",t);
		}else{
			vel_msg.angular.z = omega3;
			// ROS_INFO("t3=%.2f",t);
		}

		if(a3>a3_max){
			vel_msg.linear.x =v3_pre+sgn(v3-v3_pre)*a3_max*dt;
			// ROS_INFO("t1=%.2f",t);
		}else if(v3>v3_max){
			vel_msg.linear.x =v3_max*sgn(v3);	
			// ROS_INFO("t2=%.2f",t);
		}else{
			vel_msg.linear.x =v3;
			// ROS_INFO("t3=%.2f",t);
		}

		v3_pre=v3;
		omega3_pre=omega3;
		a3_pre=a3;
		beita3_pre=beita3;

		//角度控制律，速度滑膜
		// if(t==2){
		// 	vel_msg.linear.x =0;
		// 	vel_msg.angular.z =0;
		// 	// ROS_INFO("t1=%.2f",t);
		// }else if(t>2&&t<ts*10){
		// 	vel_msg.angular.z = omega1+flag0*A*pow(eyaw,(9/11));//+A*pow(eyaw,(9/11))
		// 	vel_msg.linear.x =v1+omega1*ex+omega1*ey+K*(ex-ey)/(abs(ex-ey)+d);
		// 	// ROS_INFO("t2=%.2f",t);
		// }else if(t>ts*10){
		// 	vel_msg.angular.z = omega1+flag0*A*pow(eyaw,(9/11));//+A*pow(eyaw,(9/11))
		// 	vel_msg.linear.x =v1+omega1*ex+omega1*ey+K*(ex-ey)/(abs(ex-ey)+d);
		// 	// ROS_INFO("t3=%.2f",t);
		// }

		//lyapunov控制律
		// vel_msg.linear.x = v1*cos(eyaw)+K2*ex;
		// vel_msg.angular.z = omega1+ey*v1/K1+K3*sin(eyaw)/K1;
		//源函数
		// vel_msg.angular.z = 4.0 * atan2(transform.getOrigin().y(),
		// 		                        transform.getOrigin().x());
		// vel_msg.linear.x = 0.5 * sqrt(pow(transform.getOrigin().x(), 2) +
		// 		                      pow(transform.getOrigin().y(), 2));


		turtle_vel.publish(vel_msg);
		rate.sleep();
		ros::spinOnce();
	}
	return 0;
};

注：①这里只提供了利亚普洛夫控制律跟踪控制的代码，其他代码请参考古月居的坐标变换：https://www.bilibili.com/video/BV1zt411G7Vn?p=18
②重点多话题订阅和发布

结果展示

不受限
在这里插入图片描述
受限
在这里插入图片描述

参考

链接: https://www.bilibili.com/video/BV1zt411G7Vn?p=18.
链接: https://www.zhangqiaokeyan.com/academic-journal-cn_computer-measurement-control_thesis/0201242108175.html.

大风吹~~~~~
关注
  • 0
    点赞
  • 踩
  • 18
    收藏
    觉得还不错? 一键收藏
  • 2
    评论
专栏目录
ros小海龟定点移动（程序）
10-06
此文件包为控制ros中小海龟的定点移动，其中有两个程序，大同小异。一个需要输入目标点的xy坐标，一个是在程序中固定了xy的坐标。具体情感博客：note-ros-控制小海龟到达指定点 （https://blog.csdn.net/qq_33168256/article/details/82950222）
ros底盘控制器和雷达的串口号别名问题（UDEV规则写串口别名）
自动驾驶行业学习、交流
05-17 983
5月18日 第一次修改 注：本次修改之后对于原来的问题（雷达和控制器插口的先后顺序问题）是解决了，但是对于两个usb口我发现是锁定下来的（就是这个usB口只能插雷达，那个usb口只能插控制器），希望有朋友可以解决这个问题可以评论告诉我一下。 -----------------------------------------------------------------------------...
ros底盘 stm32底盘驱动控制器
yushan210的博客
04-07 1307
之前写了一篇用最低成本搭建ros 底盘的设计博文，基本功能已经实现，奈何DIY成本高，需要较强的动手调适能力，所以，接着又开发设计了一款stm32的ros 底层驱动板。支持rikirobot， 和树莓派的定位孔一致。支持rosserila通信，直接发布raw_vel ，raw_imu,主题，我们自己又添加了raw_gps 的发布主题程序。 下一篇介绍gps实现百度map 定位。 ...
ROS2使用Gazebo控制AGV
mubibaiwhale的博客
07-08 1833
目前国内关于ROS2的教程比较少，我记录一下再ROS2中使用Gazebo进行仿真的过程，也算是总结这一段时间关于ROS2的学习。首先做的项目就是用控制小车运动，
ROS2入门教程—理解动作（Action）
Roar冷颜的博客
09-18 2272
ROS2入门教程—理解动作（Action）1 启动小海龟仿真器2 使用action3 ros2 node info4 ros2 action list5 ros2 action info6 ros2 interface show7 ros2 action send_goal   之前介绍到的话题和服务是ROS中最重要的两种底层通信机制，但也并不是说能解决所有应用层的问题，举一个例子，如果要让机械臂抓取一个物体，我们不仅要发出指令，还需要获取机械臂的实时反馈，如果直接用话题和服务也可以实现，不过一下得上好几个
ROS学习笔记之小乌龟跟随
Bin_0902的博客
08-14 2509
欢迎理性讨论，共同进步
ROS实操入门系列(五）通过Service设置小乌龟的各种功能(位置、行走路线颜色、清除路线、生成新乌龟等Service干货！！)
热门推荐
qq_20550447的博客
09-07 2万+
@[TOC](ROS实操入门系列(五）通过Service设置小乌龟的各种功能(位置、行走路线颜色、清除路线、生成新乌龟等)) 小乌龟功能列表 开启小乌龟节点后，可以使用 rosservice 命令查询当前小乌龟的功能 rosservice list 清除功能(可以清理小乌龟走过的线路) rosservice call /clear 杀死小乌龟,小乌龟默认名称为turtle1 rosservice call /kill "name: 'turtle1'" 重置小乌龟 rosservic
ROS入门(十)——两只小乌龟（乌龟跟随C++实现）
Netceor的博客
07-25 1万+
【奥特学园】ROS机器人入门课程《ROS理论与实践》零基础教程P315- 【以上视频笔记见http://www.autolabor.com.cn/book/ROSTutorials/】 前文参考： ROS入门(九)——机器人导航一（介绍、地图、定位和路径规划） 二、地图相关信息 （1）nav_msgs/MapMetaData 地图元数据，包括地图的宽度、高度、分辨率等。调用rosmsg info nav_msgs/MapMetaData显示消息内容 time map_load_time
ROS通信模式/动作编程（设置收发节点，使小海龟移动到指定位置）以及分布式通信
qq_54347584的博客
03-17 1599
ROS通信模式编程
自动驾驶——两轮差速机器人基于PID模型构建与跟踪控制（针对于ROS工程下的下位机后附linux下c++代码，Github源码链接）
qq_40464599的博客
07-10 1万+
上几次介绍了两轮差速机器人的数学模型参见我的博客https://blog.csdn.net/qq_40464599/article/details/107176589和只做了关于航向角的闭环PID控制https://blog.csdn.net/qq_40464599/article/details/107239274。 今天这篇文章前几篇会更深入、更具有工程性。 首先，有一个问题我一直有些模糊，最近考虑到工程实现，所以想了一下。ROS标准的Twist速度信息会向下......
ROS机器人实例——PR2
02-25
本文于微信，介绍了PR2功能包安装，Gazebo中的PR2，使用PR2实现...在PR2的底部有两台八核电脑作为机器人各硬件的控制和通信中枢，并且都安装了Ubuntu和ROS系统。PR2和ROS有千丝万缕的关系，可以说ROS产生于PR2，也促
ros2键盘控制小车移动包
09-07
通过键盘发/cmd_vel话题 给小车，让小车移动 Moving around: u i o j k l m , . q/z : increase/decrease max speeds by 10% w/x : increase/decrease only linear speed by 10% e/c : increase/decrease only ...
ROS机械臂运动控制（完整项目代码python）
06-06
包括SLAM建图导航算法部署，Moveit2.0机械臂挖掘动作仿真，Matlab-ROS联合通信显示雷达图，并控制Gazebo移动。 pudong: 基础模型，可以rviz中查看。 pudong_gazebo: 可以用于Gazebo中的模型，另包含一些算法。 ...
ros系统中，手势识别控制乌龟运动
06-08
在linux操作系统中，常常会用到ros系统中，这里面会涉及到节点通信和功能包的使用。尤其是opencv的手势识别及其应用。本文件是利用手势识别控制乌龟运动
运动控制卡在ROS上的应用(下)
weixin_57350300的博客
10-08 720
今天，正运动技术为大家分享一下《运动控制卡在ROS上的应用(下)》。本章节在《运动控制卡在ROS上的应用(上)》程序的基础上稍作修改，实现在ROS下正运动技术运动控制卡的开发。 在正式学习之前，我们先了解一下正运动技术的运动控制卡ECI2618和ECI2828。这两款产品分别是6轴，8轴运动控制卡。 ECI2618支持6轴脉冲输入与编码器反馈，板载24点输入，16点输出，2AD，2DA，支持手轮接口，其中特定输出口支持高速PWM控制。 ECI2828支持8轴总线型输入与编码器反馈，板载24点输入
ROS 机器人模型节点的运动控制原理
qq_34911636的博客
12-28 2722
一般我们启动机器人模型是通过以下的.launch文件启动，如下所示： <launch> <param name="robot_description" command="$(find xacro)/xacro --inorder '$(find robot_joint)/urdf/tf_robot.xacro'" /> <arg name="gui" default="true" /> <param name="use_gui" valu
二：ROS中控制机器人运动的实现（在gazebo中显示）
qq_43465233的博客
08-24 2533
二：ROS中控制机器人运动的实现（在gazebo中显示）#注意：报错新的改变功能快捷键合理的创建标题，有助于目录的生成如何改变文本的样式插入链接与图片如何插入一段漂亮的代码片生成一个适合你的列表创建一个表格设定内容居中、居左、居右SmartyPants创建一个自定义列表如何创建一个注脚注释也是必不可少的KaTeX数学公式新的甘特图功能，丰富你的文章UML 图表FLowchart流程图导出与导入导出导入 ROS中控制机器人运动主要流程如下 新建模型—>加载驱动插件—>启动模型和节点->显示
ros机器小车运动控制
qq_50242449的博客
02-24 3540
通过对小车的使用可以知道，在 ROS 中运行程序大多是通过系统启动完成后，使用 ssh 软件或者虚拟机的 ssh 命令连接小车，再通过远程终端输入指令，运行相应的launch 文件才能执行相关程序。我们此次使用的小车使用的是树莓派ros程序，其中EPRobot 使用的路径规划和导航算法为 TEB 算法，该算法针对于阿克曼底盘结构的小车。定义X1方向为小车的正方向，则为机器人的方向角，因此用一个三维向量就完全可以表示机器人的运动路径，机器人在平面上的位姿表述。
ROS机器人运动规划与控制：实现机器人的灵活行动
禅与计算机程序设计艺术
01-28 556
1.背景介绍 1. 背景介绍 机器人运动规划和控制是机器人技术领域中的核心问题，它涉及到机器人的运动规划、运动控制和运动执行等方面。在现实生活中，机器人已经广泛应用于各个领域，如制造业、医疗保健、空间探索等。为了实现机器人的灵活行动，我们需要研究和解决机器人运动规划和控制的相关问题。 在本文中，我们将从以下几个方面进行讨论： 机器人运动规划的基本概念和目标 机器人运动规划的核心算法和方法...
ros2小乌龟tongxun
最新发布
04-26
ROS2小乌龟通讯（turtle communication）是ROS2中的一个示例程序，用于演示ROS2的基本通信功能。它使用了ROS2的Python客户端库来实现小乌龟的移动和通信。 在ROS2中，小乌龟通讯示例程序主要包括两个节点：一个发布者节点和一个订阅者节点。发布者节点负责发布小乌龟的位置信息，而订阅者节点则接收并显示小乌龟的位置信息。 以下是ROS2小乌龟通讯的基本步骤： 1. 创建一个ROS2工作空间，并在该工作空间下创建一个包（package）。 2. 在包中创建一个发布者节点和一个订阅者节点。 3. 在发布者节点中，创建一个发布者对象，并定义一个话题（topic）用于发布小乌龟的位置信息。 4. 在发布者节点中，通过发布者对象将小乌龟的位置信息发布到话题上。 5. 在订阅者节点中，创建一个订阅者对象，并定义一个回调函数用于接收并处理小乌龟的位置信息。 6. 在订阅者节点中，通过订阅者对象订阅话题，并将接收到的位置信息传递给回调函数进行处理。 7. 运行发布者节点和订阅者节点，观察小乌龟的位置信息是否正确地显示在终端上。

“相关推荐”对你有帮助么？

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 2
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值