Added path-finding test
- currently segfaults