Cyclic pose graph freezing

[richard-warren]

When the pose graph is cyclic (e.g. A->B->C->A), the while loop in graph_to_edges is infinite. I solved this in my fork by detecting cycles and giving them all their own edge group label.

It was also necessary to change this:
edge_confidence = edge_confidence[..., 1:]
to this:
edge_confidence = edge_confidence[..., lines>=0].

I believe the former assumes the first confidence map corresponds to the parent of all parents. In cycles no such parent exists, so all the confidence maps should be shown. I'm sure you will have more elegant solutions to this problem. Please let me know if you have some ideas. Thanks!

[stale]

This issue has been automatically marked as stale because it has not had recent activity. It will be closed if no further activity occurs.

[stale]

This issue has been automatically closed because it has not had recent activity.