Text this: Generalized Voronoi Diagram-Guided and Contact-Optimized Motion Planning for Snake Robots.