ROS机器人————小乌龟画椭圆基于服务通信(C++实现)

该博客介绍了如何使用ROS和C++编程,通过服务通信控制小乌龟节点沿着椭圆路径移动。首先,创建一个ROS节点并订阅小乌龟的位置信息,然后设置速度控制器发布速度指令,利用椭圆参数计算每个时间步长的目标位置,最后更新并发布速度消息使小乌龟按设定轨迹移动。
摘要由CSDN通过智能技术生成

scr文件下创建tur_node文件,添加代码:

#include <ros/ros.h>
#include <geometry_msgs/Twist.h>
#include <turtlesim/Pose.h>

const double PI = 3.14159265359;

// 回调函数,用于获取小乌龟的位置
void poseCallback(const turtlesim::PoseConstPtr& pose_msg)
{
    // 获取小乌龟的坐标
    double x = pose_msg->x;
    double y = pose_msg->y;

    ROS_INFO("Turtle Pose: x = %f, y = %f", x, y);
}

int main(int argc, char** argv)
{
    // 初始化ROS节点
    ros::init(argc, argv, "tur_node");
    ros::NodeHandle nh;

    // 创建一个Publisher,用于发布速度控制指令
    ros::Publisher velocity_pub = nh.advertise<geometry_msgs::Twist>("turtle1/cmd_vel", 10);

    // 创建一个Subscriber,用于接收小乌龟的位置信息
    ros::Subscriber pose_sub = nh.subscribe("turtle1/pose", 10, poseCallback);

    //

评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值