tuw-robotics / tuw_multi_robot

BSD 3-Clause "New" or "Revised" License
233 stars 113 forks source link

Multi Robot Router: Failed to find Routing Table !!! #14

Closed saikishor closed 2 years ago

saikishor commented 4 years ago

I observed at most of the time with the multi robot simulation, when i give the goals very nearby, I end up having the error : Multi Robot Router: Failed to find Routing Table !!!. For instance, for 3 robots, when I given 3 goals very nearby, it is finding the plan for 2 robots, and it is failing on the 3rd robot step at the computation of the potentials. Any idea?

axelbr commented 4 years ago

could you provide a screenshot of the goal poses?

saikishor commented 4 years ago

image The goal poses are as simple as this.

saikishor commented 4 years ago

@axelbr any idea?. I guess in this case it is finding the successor from the collision resolver and getting into the loop, so thereby not finding the solutions in the given cycles.

axelbr commented 4 years ago

i will have a look at it later. maybe there must be at least one segment between a robot and its goal. @maxbader maybe you know whats the issue here.

saikishor commented 4 years ago

@axelbr I don't think so, this happens always when you give three consecutive goals at a distance of one or two segments, which can happen in real scenario. It will have the plan for first robot, but it messes up when computing the plan for the second or third robot.

saikishor commented 4 years ago

@maxbader can you comment on this issue please?

qzlinqian commented 4 years ago

I also found that when I used segments grid to define the graph, if the start position of some robots is a little close (maybe less than 0.24m for the robots with a radius of 0.04m), the same error also happened. But surprisingly when I use Voronoi graph, that won't happen...

saikishor commented 4 years ago

@qzlinqian so you mean this issue happens for you only with the grid type of graph but not the Voronoi graph?

qzlinqian commented 4 years ago

@qzlinqian so you mean this issue happens for you only with the grid type of graph but not the Voronoi graph?

Yes. After I switched to Voronoi graph, the start/goal points can be close enough. I don't know whether it's because I didn't define the segments correctly or the voronoi-segment-to-graph-node hasn't been fully tested.