First commit
Added path_finder.py, updated comments
Merge https://github.com/aklampinen/path_finder