Distance between two robots in gazebo?
Is there an easy way to calculate the distance between two robots in gazebo?
If you have, for instance, the names of both robots, I would then like to be able to have a function which would allow me to easily calculate the minimum euclidean distance plus distance vector between the visual meshes of the two robots.
Is there something like that already implemented?
The distance between a point and a robot would be even better.
I've looked online and was not able to find anything useful, except the pointer to the fcl library. Is that really the only way to go?