Fix #53 and remove useless pathfinder tests