3D Planning with a Visualizer class