c++ algorithm1