Dodan insertion sort in vse pomožne funkcije.