Reset colors in more appropriate spot

Also reduce board size and number of obstacles for easier testing and
experimenting.
Fix coloring of spots after neighbor retrieval
First usage of Pythonic 2D array traversal

This will soon be used everywhere.
Additional Python 2D array traversals
Minor cleanup
Correct came_from checks

This also makes the code much simpler
First path reconstruction! Whoo!