TwoSum c++ solution 1