Dodana optimizacija algoritma

Dodana optimizacija v dodaten file zavoljo testiranja in premerjav