Compute Sum of Squares in C++