cleaned up pathfinding - Nik