Added waypoint indicator function