Add insert sort algorithm implementation