Dodany działający insertion sort, trochę posprzątane przy okazji