More comments and some rearranging for easier reading.

There isn't actually a fail condition yet for if no path can be found...