C++ easy understandable solution - Reshape the Matrix