where does this warning come from in Stage?

asked 2014-09-05 23:15:40 -0500

scopus
279 ●52 ●57 ●65

Hi, all! I am learning a multi-robot collision avoidance algorithm by using simulator Stage.

please see following image: image description

I think the yellow warning( exclamation mark) is saying that two robots crash with each other. I want to know where the code in Stage that this warning comes from, or in other words: what kind of topic is published when a collision is detected and which callback function in Stage is for response when a message( like topic?) about detecting collision is published? Thank you!

answered 2014-09-06 09:15:12 -0500

SL Remy
2022 ●26 ●49 ●67

updated 2014-09-19 08:21:49 -0500

As a general note, the best source for Stage details is github, but it's embedded in model_draw.cc. stageros doesn't publish this information. The condition is identified in model_position.cc.

You could modify stageros.cpp to detect when a model is stalled (collisions) and to publish a message on a topic.

As a final note, you could also just evaluate the /robot_X/odom message and compare the observed velocity to the intended velocity of the robot. (Compare the embedded twist message to the twist command that you issued.)

edit flag offensive delete link

Comments

Thank you very much for your attention. So do you mean the warnning is from /robot_x/stall topic? I don't know how to display /robot_x/odom topic and /robot_x/cmd_vel topic. These two topics can't be displayed in rqt_plot. And It is very hard to watch them in terminals by inputing "rostopic echo..”

scopus ( 2014-09-09 04:47:39 -0500 )edit

Your robot controller could subscribe to the odom topic (it's already publishing to the the cmd_vel topic). Since it knows what the robot should be doing, it can detect that the commanded velocities are not being observed. rostopic list should let you know all the topics that you can use.

SL Remy ( 2014-09-13 18:19:03 -0500 )edit

sorry, I can't understand your guidance. I don't know how to compare the observed velocity to the intended velocity of the robot. I also can't get any signal about the yellow warning by displaying topics /robot_x/odom and /robot_x/cmd_vel or comparing them. Would you like to explain more clearly?

scopus ( 2014-09-19 07:55:19 -0500 )edit

If you issue a Twist message with a non-zero velocity and the observed velocity is zero (your robot isn't moving), then you can infer that you've hit an obstacle. For willow-four-erratics.world, /robot_0/odom provides information about robot_0. Subscribe to it and compare with the desired value.

SL Remy ( 2014-09-19 08:16:23 -0500 )edit

Although the yellow warning indicates a collision, but the speed of robot is not zero. It is very hard to see a collision is happenning if no yellow warning exists. This is why I said I couldn't compare those topics of /robot_x/odom and Twist message to find some inconsisitencies. Thank you

scopus ( 2014-09-23 04:29:41 -0500 )edit

add a comment

where does this warning come from in Stage?

1 Answer

Comments

Question Tools

Stats

Related questions

where does this warning come from in Stage? edit

1 Answer

Comments

Question Tools

Stats

Related questions

where does this warning come from in Stage?