C++ Insertion Sorting for Data Structures