Added octagon waypoint path