Move pathfinder method to a separate class
Fix some namespaces in the tests
Work on windows path issues
Move tests