Commit all to git

Has features requested with a couple spots //TODO and a bug in the
findBestPath algorithm.