Motion Planning Around Obstacles with Graphs of Convex Sets - Robotics Institute Carnegie Mellon University