Utilities for generating and visualizing a configuration space with 3D obstacles to test pathfinding algorithms