druga, szybsza wersja heurystyki + poprawki