Any-angle path planning