Waypoint Cylinders

Added in red, green, and blue waypoint markers.