Allow diagonal steps?
Find new path