Insertion sort on C++