Poprawiony algorym wyszukiwania i sprzatanie

Change-Id: I9f0fadc1e9d2c5f1ee418aca1205dcaf272c798b