End processing once path to goal has been found
Minor cleanup
More Pythonic empty list checking
Better map spot access and manipulation