PathFinder: prevent special-case search expansion when unit is close to goal but goal is blocked