Shortest paths in graphs of convex sets: supporting software - Marcucci, Tobia