Check if goal doesn't block before calculating path.