Path Planning in Complex Environments with Superquadrics and Voronoi-Based Orientation