Insertion Sort C++ Template