Implement waypoint drawing