Insertion Sort implemented in C++