Added size estimates to pathfinding