Completed implementation of C++ Stooge Sort