Generalized Voronoi Diagram-Guided and Contact-Optimized Motion Planning for Snake Robots

In robot motion planning in a space with obstacles, the goal is to find a collision-free path for robots from the start to the target position. Numerous fundamentally different approaches, and their many variants, address this problem depending on the types of obstacles, the dimensionality of the space and the restrictions on robot movements. We present a hierarchical motion planning framework for snake-like robots navigating cluttered environments. At the global level, a bounded Generalized Voronoi Diagram (GVD) generates a maximal-clearance path through complex terrain. To overcome the limitations of pure avoidance strategies, we incorporate a local trajectory optimization layer that enables Obstacle-Aided Locomotion (OAL). This is realized through a simulation-in-the-loop system in CoppeliaSim, where gait parameters are optimized using Particle Swarm Optimization (PSO) based on contact forces and energy efficiency. By coupling high-level deliberative planning with low-level contact-aware control, our approach enhances both adaptability and locomotion efficiency. Experimental results demonstrate improved motion performance compared to conventional planners that neglect environmental contact.