Plan Optimal Collision-Free Trajectories With Nonconvex Cost Functions Using Graphs of Convex Sets | IEEE Journals & Magazine | IEEE Xplore