Modified SelectBestPath() in PathFinderController

Shorted the code a bit, got ride of the "first" boolean and one of the
if blocks which had basically the same code inside. Also some minor
changes to variable name "backtracking" and some comment edits