Implemented the visualization waypoints tool