Add C++ code for Mergesort