ROS node from Gazebo plugin is not showing in the rosnode list

asked 2020-08-24 06:42:23 -0600

725 ●71 ●87 ●100

updated 2020-08-24 07:24:45 -0600

I want to publish some topics from a Gazebo model plugin to the ROS topic, so I use the C++ ROS node initiation code from some example that I now only copy-paste to all plugins I need.

// Initialize ros, if it has not already been initialized.
std::string node_name = std::string("my_node_name");
if (!ros::isInitialized()) {
  int argc = 0;
  char **argv = nullptr;

  ros::init(argc, argv, node_name. ros::init_options::NoSigintHandler);
}

// Create ROS node.
this->rosNode.reset(new ros::NodeHandle(node_name));

topic_name = "/my_topic";
this->rosPublisher = this->rosNode->advertise<std_msgs::Float64>(topic_name, 1);

The /my_topic topic is registered (I can see it in the rostopic list), I publish to the topic messages on every update (I debugged that the code is being executed, so the messages are being send in the plugin) but when I use rostopic echo /my_node nothing is being printed.

Also using rosnode list shows me no /my_node_name node. I'm thinking the node either isn't created at all, or shuts down. I don't know. How can I check for that, or launch the node correctly, or what else could be going wrong?

answered 2020-08-24 07:55:11 -0600

nlamprian
723 ●1 ●4 ●16

A ros node is initialized by the gazebo_ros_api system plugin. It's the /gazebo you see on the node list. Since the plugins are run in the same process, you can only have 1 node, the /gazebo one.

Having another node for your plugin is not necessary. If you want to keep your plugin independent from everything else, you can just configure the ros backend accordingly

ros::NodeHandle nh;
ros::CallbackQueue callback_queue;
ros::AsyncSpinner spinner(1, &callback_queue);
nh.setCallbackQueue(&callback_queue);
spinner.start();

edit flag offensive delete link

Comments

I be damned but this approach actually solved the issue with messages not being printed from the echo. Thank you.

kumpakri ( 2020-08-24 08:13:38 -0600 )edit

I'm having some difficulties using this. Whenever subscriber callback is to be called in a plugin with ros set like this, gazebo falls with segmentation fault. There are also other plugins set up like this, might that be the problem? Everything works fine without nh.setCallbackQueue(&callback_queue). Is setting the callback queue to the node handle neccessary or is it enough to set it for the spinner?

m.bahno ( 2020-08-26 07:35:12 -0600 )edit

Setting the callback in the node handle is necessary. Otherwise, messages you publish will go into the default queue of the node. Just make sure you don't have a thread of your own servicing the same queue.

nlamprian ( 2020-08-26 09:33:50 -0600 )edit

Thank you nlamprian! I just got to it again and my problem was more programatical. I fought with instancing of those classes. In case someone has similar problem, I attach part of my solution for class members:

m.bahno ( 2020-10-20 03:14:08 -0600 )edit

.cc

this->rosNode.reset(new ros::NodeHandle());
this->spinner = new ros::AsyncSpinner(1, this->callback_queue);
this->rosNode->setCallbackQueue(this->callback_queue);
this->spinner->start();

m.bahno ( 2020-10-20 03:14:21 -0600 )edit

.hh

std::unique_ptr<ros::NodeHandle> rosNode;
ros::CallbackQueue *callback_queue;
ros::AsyncSpinner *spinner;

m.bahno ( 2020-10-20 03:14:32 -0600 )edit

add a comment

ROS node from Gazebo plugin is not showing in the rosnode list

1 Answer

Comments

Question Tools

Stats

Related questions

ROS node from Gazebo plugin is not showing in the rosnode list edit

1 Answer

Comments

Question Tools

Stats

Related questions

ROS node from Gazebo plugin is not showing in the rosnode list