TopologicalRouteSearch with start and goal as the same node

[gpdas]

TopologicalRouteSearch in strands_navigation/topological_navigation/src/topological_navigation/route_search.py

If we search route from a node A to the same node using search_route method of this class, it will return a loop A -> B -> A (assuming bi-directional edges exist between A and another node B).

[marc-hanheide]

Really?? @Jailander ? I don't think this used to be the case.

[Jailander]

No I am sure it wasn't like that, will check as soon as I can

[gpdas]

A fix is in #376. Returns None if origin and target are the same.
This was not a problem in topological_navigation or execute_policy_mode as the nodes are checked in navigate.py before routes are searched.