如何在回调函数中发布消息

使用类实现在回调函数中发布消息

#include <ros/ros.h>
#include "circle/PersonMsg.h"
#include "circle/velCommand.h"
#include <turtlesim/Spawn.h>
#include<geometry_msgs/Twist.h>

using namespace std;

#include <iostream>
using namespace std;
class SubscribeAndPublish
{
public:
   string newName;
  SubscribeAndPublish()
  {
    //Topic you want to publish
    // pub_ = n_.advertise<msg_type>("/published_topic", 1);
    //Topic you want to subscribe
    sub_ = n_.subscribe("/add_turtle", 1, &SubscribeAndPublish::newCallback, this);
    // sub_ = n_.subscribe("/velocity_command", 1, &SubscribeAndPublish::velCallback, this);
  }

    void newCallback(const circle::PersonMsg::ConstPtr& msg){
        newName = msg->name;
        // ROS_INFO("Turtle name: x: %s", msg->name.c_str());

        ros::service::waitForService("/spawn");
        ros::ServiceClient newTurtle_client = n_.serviceClient<turtlesim::Spawn>("/spawn");
        // 初始化请求数据
        turtlesim::Spawn srv;
        srv.request.name = newName;
        srv.request.x = 2.0;
        srv.request.y = 2.0;
        // ROS_INFO("name: %s,  x: %0.2f, y: %0.2f", srv.request.name.c_str(), srv.request.x,srv.request.y);
        newTurtle_client.call(srv);
    }

    // void velCallback(const circle::velCommand::ConstPtr& msg){
    //     if(newName == msg->name&&msg->on == true){
    //         string rest = "/cmd_vel";
    //         string topic = newName+rest;
    //         pub_ = n_.advertise<geometry_msgs::Twist>(topic, 10);
    //         ros::Rate loop_rate(1);
    //             while (ros::ok())
    //         {
    //             // 初始化learning_communication::Person类型的消息
    //             geometry_msgs::Twist vel_msg;
    //             vel_msg.linear.x = 2;
    //             vel_msg.angular.z = 0.5;

    //             // 发布消息
    //             pub_.publish(vel_msg);
    //             // ROS_INFO("vel: %2f, angel: %2f",vel_msg.linear.x,vel_msg.angular.z );


    //             // 按照循环频率延时
    //             loop_rate.sleep();
    //         }   
    //     }
    //     // ROS_INFO("Turtle name: x: %s", msg->name.c_str());
    // }


private:
  ros::NodeHandle n_; 
  ros::Publisher pub_;
  ros::Subscriber sub_;
};


    int main(int argc, char  **argv){
        // 初始化
        ros::init(argc,argv,"newSub");
        SubscribeAndPublish SAPObject;
        // // 创建句柄
        // ros::NodeHandle n;

        // // 创建sub
        // ros::Subscriber newSub = n.subscribe("/add_turtle", 10 ,newCallback);
        

        ros::spin();
        

        // 连接名为spawn的服务,创造client对象
        // while (newName!=nullptr)
        // {
           
        
        // ros::service::waitForService("/spawn");
        // ros::ServiceClient newTurtle_client = n.serviceClient<turtlesim::Spawn>("/spawn");

        // // 初始化请求数据
        // turtlesim::Spawn srv;
        // srv.request.name = newName;
        // srv.request.x = 2.0;
        // srv.request.y = 2.0;

        // // 请求服务调用
        // ROS_INFO("name: %s,  x: %0.2f, y: %0.2f", srv.request.name.c_str(), srv.request.x,srv.request.y);
        // newTurtle_client.call(srv);

        // // 显示服务结果
        // ROS_INFO("Successful Response. Name: %s, x: %0.2f, y: %0.2f", srv.request.name.c_str(), srv.request.x,srv.request.y);

        return 0;
        // }

    }
  • 1
    点赞
  • 5
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
回调函数发布话题,你可以使用一个回调函数来接收其他话题的消息,然后在回调函数发布一个新的话题。下面是一个示例代码: ```cpp #include <ros/ros.h> #include <geometry_msgs/PoseStamped.h> void callback(const geometry_msgs::PoseStamped::ConstPtr& msg) { // 创建一个新的Publisher来发布新的PoseStamped消息 ros::NodeHandle nh; ros::Publisher new_pose_pub = nh.advertise<geometry_msgs::PoseStamped>("new_pose_topic", 10); // 创建一个新的PoseStamped消息 geometry_msgs::PoseStamped new_pose_stamped; // 设置新的PoseStamped消息的header部分 new_pose_stamped.header.stamp = ros::Time::now(); new_pose_stamped.header.frame_id = "new_frame"; // 设置新的PoseStamped消息的位姿信息 new_pose_stamped.pose.position.x = msg->pose.position.x + 1.0; new_pose_stamped.pose.position.y = msg->pose.position.y + 1.0; new_pose_stamped.pose.position.z = msg->pose.position.z + 1.0; new_pose_stamped.pose.orientation = msg->pose.orientation; // 发布新的PoseStamped消息 new_pose_pub.publish(new_pose_stamped); } int main(int argc, char** argv) { // 初始化ROS节点 ros::init(argc, argv, "callback_example"); ros::NodeHandle nh; // 创建一个Subscriber来订阅原始的PoseStamped消息 ros::Subscriber pose_sub = nh.subscribe<geometry_msgs::PoseStamped>("pose_stamped_topic", 10, callback); ros::spin(); return 0; } ``` 在这个例子,我们创建了一个回调函数`callback`来接收原始的PoseStamped消息。在回调函数,我们创建了一个新的Publisher`new_pose_pub`来发布新的PoseStamped消息到`new_pose_topic`。在回调函数,我们可以访问原始消息`msg`的内容,并根据需要进行处理。在这个例子,我们将原始消息的位置坐标加上1,并保持其姿态不变,然后发布新的PoseStamped消息。你可以根据自己的需求修改回调函数的处理逻辑和发布的话题名称。最后,在`main`函数,我们创建了一个Subscriber来订阅原始的PoseStamped消息,并使用`ros::spin()`来保持节点的运行。

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值