I think pathfinding works, doing further tests